Dmitry Kovalev
/
LG2
fork
Fork of LG by
Diff: Command.c
- Revision:
- 45:cbc955aecebe
- Parent:
- 42:6fc307c4963e
- Child:
- 92:c892f0311aa7
--- a/Command.c Tue Feb 09 07:47:33 2016 +0000 +++ b/Command.c Tue Feb 09 13:47:26 2016 +0000 @@ -78,19 +78,19 @@ F_rasL = ( Gyro.F_ras ) TakeByte; ADC1H = ( Spi.ADC1>>8 ) TakeByte; - ADC1L = ( Spi.ADC1 ) TakeByte; + ADC1L = ( Spi.ADC1 ) TakeByte; ADC2H = ( Spi.ADC2>>8 ) TakeByte; - ADC2L = ( Spi.ADC2 ) TakeByte; + ADC2L = ( Spi.ADC2 ) TakeByte; ADC3H = ( Spi.ADC3>>8 ) TakeByte; - ADC3L = ( Spi.ADC3 ) TakeByte; + ADC3L = ( Spi.ADC3 ) TakeByte; ADC4H = ( Spi.ADC4>>8 ) TakeByte; - ADC4L = ( Spi.ADC4 ) TakeByte; + ADC4L = ( Spi.ADC4 ) TakeByte; ADC5H = ( Spi.ADC5>>8 ) TakeByte; - ADC5L = ( Spi.ADC5 ) TakeByte; + ADC5L = ( Spi.ADC5 ) TakeByte; WP_regH = ( Spi.DAC_B>>8 ) TakeByte; WP_regL = ( Spi.DAC_B ) TakeByte; @@ -367,15 +367,15 @@ void Read_CMD(void) { - - Gyro.SOC_Out=0xDD; //Зачем сдесь делать каждый раз? - Gyro.RsErrLine = (Gyro.RsErrLine)& 0xffff; + + + Gyro.RsErrLine = (Gyro.RsErrLine)& 0xffff;//для сброса ошибки - + CountBuFFIn=ReadChekCon1(BuffTemp); // чтение данных из консоли - if(CountBuFFIn==1) { // если первый байт + if(CountBuFFIn==1) { // если есть первый байт if (BuffTemp[0] != SOC_In) { ReadCon(BuffTemp); Gyro.RsErrLine += 0x100;//WriteCon("\n\r ...Error.... "); @@ -389,7 +389,7 @@ } else if(CountBuFFIn==3) { // если ьоетий байт Gyro.CMD_In=BuffTemp[2]; N=Getlengf(); - } else if(CountBuFFIn==4 && (N==6)) { // Дима, опиши что такое N + } else if(CountBuFFIn==4 && (N==6)) { // N - длина посылки аскглд(для записи параметров). определяется по коду команды в Getlengf(); Param1=BuffTemp[3]; } else if((CountBuFFIn==5)&&(N==7)) { //LoopOn @@ -413,7 +413,7 @@ CMD_M_Control_D9(); break; case 0x0A: - CMD_M_Stymul(Param1,Param2,Param3); + CMD_M_Stymul(); break; case 0xDD: Rate_Flag=1;