Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
Diff: QEI.c
- Revision:
- 210:b02fa166315d
- Parent:
- 209:224e7331a061
- Child:
- 211:ac8251b067d2
--- a/QEI.c Thu Apr 13 14:14:45 2017 +0000 +++ b/QEI.c Mon Apr 24 05:43:54 2017 +0000 @@ -83,8 +83,8 @@ if(Buff_Restored_sin [CountV31] > 0) Gyro.CaunPlusReperAdd += Buff_1Point[(CountV31-Gyro.FrqPhase)&0x1f]; // счетчик положительных импульсов else Gyro.CaunMinReperAdd -= Buff_1Point[(CountV31-Gyro.FrqPhase)&0x1f]; // счетчик отрицательных импульсов // расчет амплитуды **/ - if(Buff_Restored_sin [CountV31]>0) Gyro.CaunPlusReperAdd += Buff_1Point[(CountV255-7)&0xff]; // счетчик положительных импульсов - else Gyro.CaunMinReperAdd -= Buff_1Point[(CountV255-7)&0xff]; // счетчик отрицательных импульсов // расчет амплитуды + if(Buff_Restored_sin [CountV31]>0) Gyro.CaunPlusReperAdd += Buff_1Point[(CountV255 - 8/*Gyro.FrqPhase */)&0xff]; // счетчик положительных импульсов + else Gyro.CaunMinReperAdd -= Buff_1Point[(CountV255 - 8/*Gyro.FrqPhase*/ )&0xff]; // счетчик отрицательных импульсов // расчет амплитуды /*if((Buff_1Point[CountV31]) > 0) Gyro.CaunPlusReperAdd += Buff_1Point[(CountV255-7)&0xff]; // счетчик положительных импульсов else Gyro.CaunMinReperAdd -= Buff_1Point[(CountV255-7)&0xff]; // счетчик отрицательных импульсов // расчет амплитуды*/ @@ -96,17 +96,24 @@ Gyro.CaunMinRateAdd = 0; Gyro.CaunPlusRateAdd = 0; break; - case 10: - Gyro.CaunMinReper = Gyro.CaunMinReperAdd; - Gyro.CaunPlusReper = Gyro.CaunPlusReperAdd; - Gyro.CaunMinReperAdd = 0; - Gyro.CaunPlusReperAdd = 0; - - /* sprintf((Time)," %d %d \r\n", Gyro.CaunMinReper, Gyro.CaunPlusReper); - WriteCon(Time); */ + /* case 10: + + Gyro.CaunMinReper = Gyro.CaunMinReperAdd; + Gyro.CaunPlusReper = Gyro.CaunPlusReperAdd; + Gyro.CaunMinReperAdd = 0; + Gyro.CaunPlusReperAdd = 0; + sprintf((Time)," %d %d \r\n", Gyro.CaunMinReper, Gyro.CaunPlusReper); + WriteCon(Time); */ + break; } - + if(Gyro.FrqPhase==CountV31) + { + Gyro.CaunMinReper = Gyro.CaunMinReperAdd; + Gyro.CaunPlusReper = Gyro.CaunPlusReperAdd; + Gyro.CaunMinReperAdd = 0; + Gyro.CaunPlusReperAdd = 0; + } if(Buff_Restored_sin [CountV31] > 0) { if(Gyro.Reper_Event)tempReper=0; @@ -116,8 +123,14 @@ { if(tempReper) { + + + tempReper=0; Gyro.Reper_Event=1; + + + } }