Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
Diff: vibro.c
- Revision:
- 205:775d54fdf646
- Parent:
- 204:e7e9762bf609
- Child:
- 207:d1ce992f5d17
--- a/vibro.c Fri Nov 25 06:22:37 2016 +0000 +++ b/vibro.c Mon Dec 19 14:08:31 2016 +0000 @@ -8,9 +8,9 @@ __irq void EINT3_IRQHandler() -{ - Gyro.DeltaEXT_Event=1; - Gyro.B_Delta_EventEXT=1; +{ Gyro.EXT_Latch=1; + // Gyro.DeltaEXT_Event=1; + // Gyro.B_Delta_EventEXT=1; LPC_GPIOINT->IO0IntClr |= (1<<1); // CMD_Delta_Bins(); } @@ -43,7 +43,7 @@ } } - +/* void Calc2AmpN(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления. { Gyro.AmpSC=0; @@ -76,8 +76,8 @@ } //8046 LPC_TIM1->MR0 =(unsigned int)(103000000/((Gyro.Frq)>>11));//запись в таймер нового значение частоты вибро -} - +}*/ +/* void CalcAmpN(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления. { Gyro.AmpSC=0; @@ -106,7 +106,7 @@ LPC_TIM1->MR0 =(unsigned int)(103000000/((Gyro.Frq)>>11));//запись в таймер нового значение частоты вибро } - +*/ void CalcAmpD(void) @@ -172,7 +172,7 @@ - +/* void CalcAmpI(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления. { @@ -212,7 +212,7 @@ } //8046 LPC_TIM1->MR0 =(unsigned int)(103000000/((Gyro.Frq)>>11));//запись в таймер нового значение частоты вибро } - +*/ void OLDCalcAmpN(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления. @@ -328,14 +328,13 @@ Gyro.tempdelta2 += (Buff_Restored_sin2[i]) } */ - if(Gyro.LogHZ) + if(Gyro.Log) { sprintf((Time),"%d %d %d\r\n",ADCDIF,(ADCDIF>>5),(ADCDIF>>10)); WriteCon(Time); ADCDIF=0; Gyro.CuruAngle=0; - Gyro.tempdelta=0; - Gyro.tempdelta2=0; + } /* if(Gyro.ModJump==2) { ///прыжок с моды на моду. (-->) Gyro.ModJump=0; @@ -374,13 +373,13 @@ if (Gyro.VibroFrqRegulF == 1) {Gyro.VibroFrqRegulF = 0; VibroFrqRegul(); } // Регулеровка частоты виброподвеса if (Gyro.VibroAMPRegulF == 1) {Gyro.VibroAMPRegulF = 0; VibroAMPRegul(); } // Регулеровка Амплитуды виброподвеса - if (Gyro.VibroNoiseF == 1) - { + if (Gyro.VibroNoiseF == 1) {Gyro.VibroNoiseF = 0; OLDCalcAmpN();} + /* { switch(Gyro.flag) { case 1: Gyro.VibroNoiseF = 0; OLDCalcAmpN(); break; case 2: Gyro.AmpMin =3;Gyro.AmpTD =10;Gyro.VibroNoiseF = 0;Calc2AmpN(); break; case 3: Gyro.AmpMin =1;Gyro.AmpTD =10;Gyro.VibroNoiseF = 0;CalcAmpD(); break; - } - } // регулеровка ошумления, наверно нужно объеденить с регулеровкой ампитуды + } + } */// регулеровка ошумления, наверно нужно объеденить с регулеровкой ампитуды //if (Gyro.VibroOutF == 1) {Gyro.VibroOutF = 0; VibroOut();} // установка ног в регисторе тоже подумать , зачем отделный флаг? наверно }