123
Fork of LG by
Diff: vibro.c
- Revision:
- 190:289514f730ee
- Parent:
- 189:8a16378724c4
- Child:
- 191:40028201ddad
--- a/vibro.c Mon Aug 22 10:39:08 2016 +0000 +++ b/vibro.c Tue Aug 23 14:03:16 2016 +0000 @@ -3,48 +3,37 @@ GyroParam GyroP; volatile unsigned int Cheng_AMP_Flag=0; -int reper=0; +//int reper=0; int Rate2VibFlag; -void Discharg ()//проверка битового поля поджига и установка значения бита поджига -{ - if (Gyro.Discharg) - { - //Проверка здвигового поля(последовательности) поджига - //если последний бит 1 то установить бит поджига в еденицу, иначе в 0; - if (Gyro.Discharg & 0x01) Gyro.PinReg |= PinRegBitD; else Gyro.PinReg &= ~PinRegBitD; - Gyro.Discharg = Gyro.Discharg >> 1; - } -} -void BackLight () -{ - if (Gyro.BackLight) - { - //Проверка здвигового поля(последовательности) подсветки - //если последний бит в битовом поле 1 то установить бит подсветки в еденицу, иначе в 0; - if (Gyro.BackLight & 0x01) Gyro.PinReg |= PinRegBitL; else Gyro.PinReg &= ~PinRegBitL; - Gyro.BackLight = Gyro.BackLight >> 1; - } -} + void VibroOut(void) // выставка ног вибро { - if(CountV31>=16) {//первая нога вибро + if(CountV31>=16) + {//первая нога вибро // левая граница вЫкл вибро 1 > Time_vibro <ПРАВАЯ граница вЫкл вибро 1 - if((Time_vibro>Gyro.AmpN1) && (Time_vibro<Gyro.AmpN2)) { + if((Time_vibro>Gyro.AmpN1) && (Time_vibro<Gyro.AmpN2)) + { Gyro.PinReg &= ~PinRegBit_1V;//установить в регистре PinReg бит "вибро 1" в "0" - } else { + } + else + { Gyro.PinReg |= PinRegBit_1V;//установить в регистре PinReg бит "вибро 1" в "1" } - } else {//вторая нога вибро - if((Time_vibro>Gyro.AmpN1)&&(Time_vibro<Gyro.AmpN2)) { - Gyro.PinReg &= ~PinRegBit_2V; /*LoopOff*////установить в регистре PinReg бит "вибро 2" в "0" - } else { + } + else {//вторая нога вибро + if((Time_vibro>Gyro.AmpN1)&&(Time_vibro<Gyro.AmpN2)) + { + Gyro.PinReg &= ~PinRegBit_2V; //установить в регистре PinReg бит "вибро 2" в "0" + } + else + { Gyro.PinReg |= PinRegBit_2V;//установить в регистре PinReg бит "вибро 2" в "1" } } } -void CalcAmpN(void) +void CalcAmpN(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления. { static int PeriodCount = 0; @@ -71,7 +60,7 @@ Nmax = (unsigned int)((100000/(Gyro.Frq>>16))-1); Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer+Gyro.AmpPerDel))/(Gyro.Frq>>16));//левая граница амплитуды - Gyro.AmpN2=(unsigned int)((Nmax/2)-Gyro.AmpN1); //правая граница амплитуды + Gyro.AmpN2=(unsigned int)((Nmax/2)-Gyro.AmpN1); //правая граница амплитуды Cheng_AMP_Flag=0; } @@ -95,14 +84,13 @@ { Gyro.CaunPlus = CaunAddPlus;//амплитуда по модулю из востановленного синиуса Buff_Restored_sin CaunAddPlus = 0; - Gyro.CaunMin = CaunAddMin;//амплитуда по модулю из востановленного синиуса Buff_Restored_sin + Gyro.CaunMin = CaunAddMin; //амплитуда по модулю из востановленного синиуса Buff_Restored_sin CaunAddMin = 0; - Gyro.MaxAmp = Gyro.CaunPlus + Gyro.CaunMin;//расчет максимальной амплитуды из востановленного синуса р-р. + Gyro.MaxAmp = Gyro.CaunPlus + Gyro.CaunMin; //расчет максимальной амплитуды из востановленного синуса р-р. Gyro.Amp -= (Gyro.MaxAmp - 3000) * Gyro.AmpSpeed; // расчет амплитуды ВП с учетом разници - /* - if((Gyro.Amp>>16) > Gyro.AmpPerMax) {Gyro.Amp = (Gyro.AmpPerMax << 16);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// - if((Gyro.Amp>>16) > Gyro.AmpPerMin) {Gyro.Amp = (Gyro.AmpPerMin << 16);}*/ // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////*/ +/*if((Gyro.Amp>>16) > Gyro.AmpPerMax) {Gyro.Amp = (Gyro.AmpPerMax << 16);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// + if((Gyro.Amp>>16) > Gyro.AmpPerMin) {Gyro.Amp = (Gyro.AmpPerMin << 16);}*/ // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// if(Gyro.RgConA&0x20) {Gyro.AmpPer = Gyro.Amp>>16;} //приведение амплитуды ВП к виду 0%-100% } @@ -119,7 +107,7 @@ } ////////////////////////////////////////////////////////////////////////////// -/////////////////////////функция работы вибропривода////////////////////////// +/////////////////////////основного 32 тактного цикла////////////////////////// ////////////////////////////////////////////////////////////////////////////// void cheng(void) {