123
Fork of LG by
Diff: Command.c
- Revision:
- 190:289514f730ee
- Parent:
- 189:8a16378724c4
- Child:
- 191:40028201ddad
--- a/Command.c Mon Aug 22 10:39:08 2016 +0000 +++ b/Command.c Tue Aug 23 14:03:16 2016 +0000 @@ -304,12 +304,10 @@ case 0: Temp = Gyro.F_ras; BuffTemp[5] = (Temp >> 8) & 0xff; - break; case 1: BuffTemp[5] = (Temp >> 0) & 0xff; - break; @@ -318,13 +316,11 @@ case 2: Temp = 0;//HFO BuffTemp[5] = (Temp >> 8) & 0xff; - break; case 3: Temp = 0;//HFO BuffTemp[5] = (Temp >> 0) & 0xff; - break; @@ -333,12 +329,10 @@ case 4: Temp = (unsigned int)((7680000*16/(Gyro.Frq>>12))); BuffTemp[5] = (Temp >> 8) & 0xff; - break; case 5: BuffTemp[5] = (Temp >> 0) & 0xff; - break; @@ -347,7 +341,6 @@ case 6: Temp = (unsigned int)(((7680000*16/200) *Gyro.AmpPer /(Gyro.Frq>>12))); BuffTemp[5] = (Temp >> 8) & 0xff; - break; case 7: @@ -360,7 +353,6 @@ case 8: Temp = Spi.DAC_B /*- 0x7fff*/; BuffTemp[5] = (Temp >> 8) & 0xff; - break; case 9: @@ -373,7 +365,6 @@ case 10: Temp = 100; BuffTemp[5] = (Temp >> 8) & 0xff; - break; case 11: @@ -386,7 +377,6 @@ case 12: Temp = Gyro.AD_Slow >> 16; BuffTemp[5] = (Temp >> 8) & 0xff; - break; case 13: @@ -399,7 +389,6 @@ case 14: Temp = Gyro.In1; BuffTemp[5] = (Temp >> 8) & 0xff;//in1//2 - break; case 15: @@ -466,8 +455,7 @@ } void CMD_Rate(void) -{ - +{ Gyro.Rate1_Event=0; unsigned int Temp; @@ -831,21 +819,21 @@ CountBuFFIn=ReadChekCon1(BuffTemp); // чтение данных из консоли if(CountBuFFIn==1) { - LoopOn // если есть первый байт + // если есть первый байт if (BuffTemp[0] != SOC_In) { ReadCon1(BuffTemp); Gyro.RsErrLine += 0x100;//WriteCon("\n\r ...Error.... "); BuffTemp[99]=Gyro.RsErrLine; } } - else if(CountBuFFIn==2) //если второй ,fqn + else if(CountBuFFIn==2) //если второй байт { if (BuffTemp[1] != Gyro.My_Addres) { ReadCon1(BuffTemp); Gyro.RsErrLine += 0x1;WriteCon("\n\r ...Error_ADDRES.... "); } } - else if(CountBuFFIn==3) // если ьоетий байт + else if(CountBuFFIn==3) // если третий байт { Gyro.CMD_In=BuffTemp[2]; N=Getlengf(); @@ -903,27 +891,30 @@ case 0xE8://запись параметра CMD_M_Param_W(); - break; + break; + case 0xDA: - switch(Gyro.My_Addres){//смещение поджига и подсветки в зависимости от адреса ГЛД - case 0: - Gyro.Discharg = StartDischarg << ShiftStart0; - Gyro.BackLight = StartBackLight << ShiftStart0; - break; - case 1: - Gyro.Discharg = StartDischarg << ShiftStart1; - Gyro.BackLight = StartBackLight << ShiftStart1; - break; - case 2: - Gyro.Discharg = StartDischarg << ShiftStart2; - Gyro.BackLight = StartBackLight << ShiftStart2; - break; - case 3: - Gyro.Discharg = StartDischarg << ShiftStart3; - Gyro.BackLight = StartBackLight << ShiftStart3; - break; -} -break; + switch(Gyro.My_Addres) + {//смещение поджига и подсветки в зависимости от адреса ГЛД + case 0: + Gyro.Discharg = StartDischarg << ShiftStart0; + Gyro.BackLight = StartBackLight << ShiftStart0; + break; + case 1: + Gyro.Discharg = StartDischarg << ShiftStart1; + Gyro.BackLight = StartBackLight << ShiftStart1; + break; + case 2: + Gyro.Discharg = StartDischarg << ShiftStart2; + Gyro.BackLight = StartBackLight << ShiftStart2; + break; + case 3: + Gyro.Discharg = StartDischarg << ShiftStart3; + Gyro.BackLight = StartBackLight << ShiftStart3; + break; + } + break; + case 0xD9: CMD_M_Control_D9(); break;