123
Fork of LG by
Diff: vibro.c
- Revision:
- 107:4d178bcc9d8a
- Parent:
- 106:250ddd8629c6
- Child:
- 108:030cdde08314
diff -r 250ddd8629c6 -r 4d178bcc9d8a vibro.c --- a/vibro.c Fri Apr 01 10:05:35 2016 +0000 +++ b/vibro.c Fri Apr 01 16:13:55 2016 +0000 @@ -4,7 +4,7 @@ //volatile int Temp = 0 ; volatile unsigned int Flag=0; unsigned int FrecTemp=0; -unsigned int FrecTp=0,ffff=0; +unsigned int FrecTp=0,amp=0; void Discharg ()//проверка битового поля поджига и установка значения бита поджига @@ -71,7 +71,7 @@ Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer))/400); //левая граница амплитуды Gyro.AmpN2=(unsigned int)((Nmax/2)-Gyro.AmpN1); //правая граница амплитуды Flag=1; - Gyro.tau = Gyro.AmpN2-Gyro.AmpN1; + } else { @@ -83,7 +83,7 @@ Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer+Gyro.AmpPerDel))/400);//левая граница амплитуды Gyro.AmpN2=(unsigned int)((Nmax/2)-Gyro.AmpN1); //правая граница амплитуды Flag=0; - Gyro.tau = Gyro.AmpN2-Gyro.AmpN1; + } //Tnoise=55; @@ -103,9 +103,9 @@ void cheng(void) { static int TempFaza, CountFaza; - //if (Buff_Restored_sin [CountV255] > MaxAmp) {MaxAmp=Buff_Restored_sin [CountV255];} // подумать со знаком - - switch(CountV31) { + + if (Buff_Restored_sin [CountV31] > MaxAmp) {MaxAmp = Buff_Restored_sin [CountV31];} // подумать со знаком*/ + switch(CountV31) { case 0: CalcAmpN();//расчет ошумления и амплитуды задание интервалов выставки ножек вибро. //Vib.Frq = ((unsigned int) ((7680000*16/Output.Str.T_Vibro)))*16*16*16; //прием частоты из аск_глд старый протокол @@ -113,17 +113,15 @@ // Output.Str.T_Vibro=(unsigned int)((7680000*16/Gyro.Frq)*4096); //запись частоты для выдачи в аск_глд старый протокол Time_vibro=0; break; - case 20: - MaxAmp = Buff_Restored_sin [CountV31]; - Gyro.Amp -= (MaxAmp - 150)*2; // расчет амплитудв с учетом разници + case 24: + Gyro.Amp -= (MaxAmp - 350)*50; // расчет амплитудв с учетом разници //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// - if(Gyro.Amp>5500000) { - Gyro.Amp=1200000; // временное ограничение роста амплитуды в случае неподоженного гироскопа////////// + if((Gyro.Amp>>16) > 95) {Gyro.Amp= (95 << 16); // временное ограничение роста амплитуды в случае неподоженного гироскопа////////// } //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// Gyro.AmpPer = Gyro.Amp>>16; - ffff=MaxAmp; + amp=MaxAmp; MaxAmp=0; break;