Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
Diff: Command.c
- Revision:
- 103:e96f08947def
- Parent:
- 102:4270092be987
- Child:
- 104:ab1cb4ff56b2
diff -r 4270092be987 -r e96f08947def Command.c --- a/Command.c Wed Mar 30 13:27:39 2016 +0000 +++ b/Command.c Wed Mar 30 14:20:03 2016 +0000 @@ -261,7 +261,7 @@ int HFO; temp=BuffTemp[3]; Consol = temp&0x3; - HFO = temp&0x3; + HFO = temp&0x3;// // (номер (код) ЦАПа 0...3, HFO - 3dac, PLC - 0DAC temp =((BuffTemp[4]<<8) | BuffTemp[5]); // temp=0; temp=temp&0xFFFF; @@ -275,6 +275,13 @@ Spi.DAC_B =(unsigned int)(DACF) /*(unsigned int)(temp*K_DAC+deltaDAC)*/; // K_DAC); } } +void Gph_W() +{ + int Gain_A; + int Gain_B; + Gyro.Gain_A=BuffTemp[4]; + Gyro.Gain_B=BuffTemp[5]; +} void CMD_M_vib() { LoopOn @@ -367,7 +374,12 @@ case 0xE4: lengf=8; break; - + + + case 0xE6: + lengf=8; + break; + } return lengf; @@ -446,7 +458,14 @@ case 0xE4: CMD_M_vib(); break; + case 0xE6: + Gph_W(); + break; + + Gyro.RsErrLine = 0; + + } } }