Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
Diff: vibro.c
- Revision:
- 227:2774b56bfab0
- Parent:
- 226:4a4d5bd5fcd7
- Child:
- 231:079835d508ef
diff -r 4a4d5bd5fcd7 -r 2774b56bfab0 vibro.c --- a/vibro.c Tue Dec 26 05:14:09 2017 +0000 +++ b/vibro.c Fri Jan 05 08:14:38 2018 +0000 @@ -14,54 +14,6 @@ Gyro.EXT_Latch=1; LPC_GPIOINT->IO0IntClr |= (1<<1); - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn - LoopOn } @@ -211,9 +163,9 @@ temp=temp>>6; LowDZ = ((Gyro.AmpSpeed<<3)*(-1)); HiDZ = (Gyro.AmpSpeed<<3); - Gyro.Amp -= temp>>4; // расчет амплитуды ВП с учетом разници - if((Gyro.Amp>>16) > (Gyro.AmpPerMax)) {Gyro.Amp = (Gyro.AmpPerMax << 16);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// - if((Gyro.Amp>>16) < (Gyro.AmpPerMin)) {Gyro.Amp = (Gyro.AmpPerMin << 16);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// + Gyro.Amp -= temp>>4; // расчет амплитуды ВП с учетом разници(Gyro.AmpPer<<17)/100; + if((Gyro.AmpPer) > (Gyro.AmpPerMax)) {Gyro.Amp = ((Gyro.AmpPerMax<<17)/100);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// + if((Gyro.AmpPer) < (Gyro.AmpPerMin)) {Gyro.Amp = ((Gyro.AmpPerMin<<17)/100);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// // Gyro.AmpPer = (Gyro.Amp)>>16; //приведение амплитуды ВП к виду 0%-100% } LPC_MCPWM->MAT1 = T_vib_1;