Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
Command.c@231:079835d508ef, 2018-01-25 (annotated)
- Committer:
- Kovalev_D
- Date:
- Thu Jan 25 13:59:43 2018 +0000
- Revision:
- 231:079835d508ef
- Parent:
- 228:a8195e1b1123
- Child:
- 232:130a2b5003e6
termo
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
igor_v | 0:8ad47e2b6f00 | 1 | #include "stdlib.h" |
Kovalev_D | 197:7a05523bf588 | 2 | //#include "math.h" |
igor_v | 0:8ad47e2b6f00 | 3 | #include "LPC17xx.h" |
igor_v | 0:8ad47e2b6f00 | 4 | #include "Global.h" |
Kovalev_D | 106:250ddd8629c6 | 5 | int tempNH,tempNL; |
igor_v | 0:8ad47e2b6f00 | 6 | unsigned int Rate_Flag; |
igor_v | 0:8ad47e2b6f00 | 7 | unsigned int CountBuFFIn; |
igor_v | 21:bc8c1cec3da6 | 8 | unsigned int N=0,CRC_N; |
Kovalev_D | 214:4c70e452c491 | 9 | unsigned int Rate_7=0; |
Kovalev_D | 214:4c70e452c491 | 10 | int iRate_7=0; |
igor_v | 21:bc8c1cec3da6 | 11 | unsigned int Param1=0; |
igor_v | 21:bc8c1cec3da6 | 12 | unsigned int Param2=0; |
igor_v | 21:bc8c1cec3da6 | 13 | unsigned int Param3=0; |
igor_v | 21:bc8c1cec3da6 | 14 | unsigned int Param4=0; |
Kovalev_D | 209:224e7331a061 | 15 | ///unsigned int Consol=123; |
Kovalev_D | 121:bbae560cdd43 | 16 | unsigned int TempParam=1; |
Kovalev_D | 124:9ae09249f842 | 17 | unsigned int CountParam=0; |
Kovalev_D | 209:224e7331a061 | 18 | unsigned int OldCuruAngle; |
Kovalev_D | 209:224e7331a061 | 19 | unsigned int OldCaunPlus=0; |
Kovalev_D | 209:224e7331a061 | 20 | unsigned int OldCaunMin=0; |
Kovalev_D | 211:ac8251b067d2 | 21 | unsigned int OutDeltaPS; |
Kovalev_D | 211:ac8251b067d2 | 22 | int IntOutDeltaPS; |
Kovalev_D | 209:224e7331a061 | 23 | int ttemp,temp5=1; |
Kovalev_D | 197:7a05523bf588 | 24 | int OLDDAC=0; |
Kovalev_D | 205:775d54fdf646 | 25 | int rr = 123; |
Kovalev_D | 209:224e7331a061 | 26 | unsigned int pDestT; |
Kovalev_D | 136:19b9e6abb86f | 27 | GyroParam *Flash; |
Kovalev_D | 211:ac8251b067d2 | 28 | //int q; |
Kovalev_D | 147:1aed74f19a8f | 29 | ///////////////flah and boot/////////// |
Kovalev_D | 147:1aed74f19a8f | 30 | void GoBoot(void) |
Kovalev_D | 147:1aed74f19a8f | 31 | { |
Kovalev_D | 147:1aed74f19a8f | 32 | /* Prepare Sectors to be flashed */ |
Kovalev_D | 147:1aed74f19a8f | 33 | NVIC_DisableIRQ(TIMER1_IRQn); |
Kovalev_D | 147:1aed74f19a8f | 34 | NVIC_DisableIRQ(TIMER2_IRQn); |
Kovalev_D | 147:1aed74f19a8f | 35 | NVIC_DisableIRQ(TIMER3_IRQn); |
Kovalev_D | 147:1aed74f19a8f | 36 | NVIC_DisableIRQ(EINT3_IRQn); |
Kovalev_D | 147:1aed74f19a8f | 37 | SystemInitDef(); |
Kovalev_D | 147:1aed74f19a8f | 38 | vIAP_ReinvokeISP(); |
Kovalev_D | 147:1aed74f19a8f | 39 | } |
Kovalev_D | 181:0b022246c43c | 40 | |
Kovalev_D | 181:0b022246c43c | 41 | void DropDelay(void) |
Kovalev_D | 225:f8fee6c586cc | 42 | { |
Kovalev_D | 225:f8fee6c586cc | 43 | Gyro.DropDelayGLD = DropDelayGLD_0; |
Kovalev_D | 225:f8fee6c586cc | 44 | switch(Gyro.My_Addres) { |
Kovalev_D | 225:f8fee6c586cc | 45 | case 1: Gyro.DropDelayGLD = DropDelayGLD_1; break; |
Kovalev_D | 225:f8fee6c586cc | 46 | case 2: Gyro.DropDelayGLD = DropDelayGLD_2; break; |
Kovalev_D | 225:f8fee6c586cc | 47 | case 3: Gyro.DropDelayGLD = DropDelayGLD_3; break; |
Kovalev_D | 225:f8fee6c586cc | 48 | } |
Kovalev_D | 194:8f3cb37a5541 | 49 | |
Kovalev_D | 181:0b022246c43c | 50 | } |
Kovalev_D | 231:079835d508ef | 51 | |
Kovalev_D | 205:775d54fdf646 | 52 | void EraseFlash(void) |
Kovalev_D | 205:775d54fdf646 | 53 | { |
Kovalev_D | 207:d1ce992f5d17 | 54 | rr = u32IAP_PrepareSectors(19, 21); |
Kovalev_D | 207:d1ce992f5d17 | 55 | rr = u32IAP_EraseSectors(19, 21); |
Kovalev_D | 231:079835d508ef | 56 | } |
Kovalev_D | 205:775d54fdf646 | 57 | |
Kovalev_D | 205:775d54fdf646 | 58 | void WriteFlash(void) |
Kovalev_D | 231:079835d508ef | 59 | { |
Kovalev_D | 208:19150d2b528f | 60 | Gyro.FlashMod = 0; |
Kovalev_D | 205:775d54fdf646 | 61 | |
Kovalev_D | 205:775d54fdf646 | 62 | //SystemInitDef(); |
Kovalev_D | 205:775d54fdf646 | 63 | NVIC_DisableIRQ(TIMER1_IRQn); |
Kovalev_D | 205:775d54fdf646 | 64 | NVIC_DisableIRQ(TIMER2_IRQn); |
Kovalev_D | 205:775d54fdf646 | 65 | NVIC_DisableIRQ(TIMER3_IRQn); |
Kovalev_D | 205:775d54fdf646 | 66 | NVIC_DisableIRQ(EINT3_IRQn); |
Kovalev_D | 205:775d54fdf646 | 67 | |
Kovalev_D | 208:19150d2b528f | 68 | // unsigned int start_address = (unsigned int) & GyroP; |
Kovalev_D | 207:d1ce992f5d17 | 69 | rr = u32IAP_PrepareSectors(19, 21); |
Kovalev_D | 208:19150d2b528f | 70 | rr = u32IAP_EraseSectors (19, 21); |
Kovalev_D | 207:d1ce992f5d17 | 71 | rr = u32IAP_PrepareSectors(19, 21); |
Kovalev_D | 208:19150d2b528f | 72 | rr = u32IAP_CopyRAMToFlash(0x030000, &GyroP , 1024); |
Kovalev_D | 205:775d54fdf646 | 73 | // SystemInit1(); // Инициализация контроллера: установка тактовых частот |
Kovalev_D | 205:775d54fdf646 | 74 | //SystemCoreClockUpdate1(); // расчет тактовой частоты процессора перед инициализацией UART - 103MHz |
Kovalev_D | 205:775d54fdf646 | 75 | |
Kovalev_D | 205:775d54fdf646 | 76 | NVIC_EnableIRQ(TIMER1_IRQn); |
Kovalev_D | 205:775d54fdf646 | 77 | NVIC_EnableIRQ(TIMER2_IRQn); |
Kovalev_D | 205:775d54fdf646 | 78 | NVIC_EnableIRQ(TIMER3_IRQn); |
Kovalev_D | 205:775d54fdf646 | 79 | NVIC_EnableIRQ(EINT3_IRQn); |
Kovalev_D | 208:19150d2b528f | 80 | //SystemCoreClockUpdate1(); |
Kovalev_D | 205:775d54fdf646 | 81 | |
Kovalev_D | 205:775d54fdf646 | 82 | } |
Kovalev_D | 136:19b9e6abb86f | 83 | void ReadFlash ( void) |
Kovalev_D | 136:19b9e6abb86f | 84 | { |
Kovalev_D | 205:775d54fdf646 | 85 | NVIC_DisableIRQ(TIMER1_IRQn); |
Kovalev_D | 205:775d54fdf646 | 86 | NVIC_DisableIRQ(TIMER2_IRQn); |
Kovalev_D | 205:775d54fdf646 | 87 | NVIC_DisableIRQ(TIMER3_IRQn); |
Kovalev_D | 205:775d54fdf646 | 88 | NVIC_DisableIRQ(EINT3_IRQn); |
Kovalev_D | 147:1aed74f19a8f | 89 | Gyro.FlashMod = 0; |
Kovalev_D | 231:079835d508ef | 90 | |
Kovalev_D | 205:775d54fdf646 | 91 | |
Kovalev_D | 207:d1ce992f5d17 | 92 | pDestT= (unsigned int) (0x030000); |
Kovalev_D | 136:19b9e6abb86f | 93 | Flash = (GyroParam*) pDestT; |
Kovalev_D | 136:19b9e6abb86f | 94 | GyroP = *(Flash); |
Kovalev_D | 205:775d54fdf646 | 95 | |
Kovalev_D | 205:775d54fdf646 | 96 | NVIC_EnableIRQ(TIMER1_IRQn); |
Kovalev_D | 205:775d54fdf646 | 97 | NVIC_EnableIRQ(TIMER2_IRQn); |
Kovalev_D | 205:775d54fdf646 | 98 | NVIC_EnableIRQ(TIMER3_IRQn); |
Kovalev_D | 205:775d54fdf646 | 99 | NVIC_EnableIRQ(EINT3_IRQn); |
Kovalev_D | 208:19150d2b528f | 100 | } |
Kovalev_D | 169:140743e3bb96 | 101 | ///////////////end flah and boot/////////// |
Kovalev_D | 222:7de7b3bf3a1d | 102 | |
Kovalev_D | 191:40028201ddad | 103 | void M_RateA(void) |
Kovalev_D | 226:4a4d5bd5fcd7 | 104 | { |
Kovalev_D | 226:4a4d5bd5fcd7 | 105 | |
Kovalev_D | 226:4a4d5bd5fcd7 | 106 | if(Gyro.ModeOut==3) |
Kovalev_D | 226:4a4d5bd5fcd7 | 107 | { |
Kovalev_D | 226:4a4d5bd5fcd7 | 108 | if (Gyro.Device_Mode) Gyro.ModeOut=4; |
Kovalev_D | 226:4a4d5bd5fcd7 | 109 | } |
Kovalev_D | 226:4a4d5bd5fcd7 | 110 | |
Kovalev_D | 209:224e7331a061 | 111 | switch(Gyro.ModeOut) |
Kovalev_D | 209:224e7331a061 | 112 | { |
Kovalev_D | 226:4a4d5bd5fcd7 | 113 | case 1: if(Gyro.Rate1_Event ) CMD_Rate(); break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 114 | case 2: if(Gyro.Reper_Event ) CMD_Rate2(); break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 115 | case 3: if(Gyro.Event_500Hz ) CMD_Delta_PS(); break; |
Kovalev_D | 227:2774b56bfab0 | 116 | case 4: if(Gyro.EXT_Latch ) CMD_Delta_PS(); Gyro.EXT_Latch=0; break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 117 | case 5: if(Gyro.Event_500Hz ) CMD_Delta_Bins(); break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 118 | case 6: if(Gyro.EXT_Latch ) CMD_B_Delta(); Gyro.EXT_Latch=0; break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 119 | case 7: if(Gyro.Event_500Hz ) CMD_B_Delta(); break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 120 | case 8: if(Gyro.Rate3_Event ) CMD_Rate3(); break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 121 | case 9: if(Gyro.Reper_Event ){ CMD_Rate2(); Gyro.ModeOut=0;} break; |
Kovalev_D | 225:f8fee6c586cc | 122 | case 10: CMD_Rate7();Gyro.ModeOut=0;break;//if(Gyro.EvenRate7 ){ CMD_Rate7(); Gyro.EvenRate7=0;} break; |
Kovalev_D | 222:7de7b3bf3a1d | 123 | case 11: if(Gyro.EvenRate5K ){ M_Rate5K(); Gyro.EvenRate5K--;} break; |
Kovalev_D | 196:f76dbc081e63 | 124 | } |
Kovalev_D | 191:40028201ddad | 125 | } |
Kovalev_D | 136:19b9e6abb86f | 126 | |
Kovalev_D | 214:4c70e452c491 | 127 | void BuffClear(void) |
Kovalev_D | 214:4c70e452c491 | 128 | { |
Kovalev_D | 214:4c70e452c491 | 129 | for(int q=0; q<60; q++) |
Kovalev_D | 214:4c70e452c491 | 130 | { |
Kovalev_D | 214:4c70e452c491 | 131 | BuffTemp[q]=0; |
Kovalev_D | 214:4c70e452c491 | 132 | } |
Kovalev_D | 214:4c70e452c491 | 133 | } |
Kovalev_D | 222:7de7b3bf3a1d | 134 | |
Kovalev_D | 222:7de7b3bf3a1d | 135 | |
Kovalev_D | 222:7de7b3bf3a1d | 136 | |
Kovalev_D | 222:7de7b3bf3a1d | 137 | |
Kovalev_D | 222:7de7b3bf3a1d | 138 | |
Kovalev_D | 222:7de7b3bf3a1d | 139 | |
Kovalev_D | 214:4c70e452c491 | 140 | void CMD_Rate7(void) |
Kovalev_D | 214:4c70e452c491 | 141 | { |
Kovalev_D | 214:4c70e452c491 | 142 | BuffClear(); |
Kovalev_D | 214:4c70e452c491 | 143 | |
Kovalev_D | 225:f8fee6c586cc | 144 | unsigned int Temp; |
Kovalev_D | 225:f8fee6c586cc | 145 | int ADC_Worm[70]; |
Kovalev_D | 214:4c70e452c491 | 146 | int Temp1; |
Kovalev_D | 214:4c70e452c491 | 147 | float Temp2; |
Kovalev_D | 222:7de7b3bf3a1d | 148 | static unsigned int t=0; |
Kovalev_D | 231:079835d508ef | 149 | |
Kovalev_D | 214:4c70e452c491 | 150 | BuffTemp[0] = Gyro.SOC_Out; |
Kovalev_D | 214:4c70e452c491 | 151 | BuffTemp[1] = Gyro.My_Addres; |
Kovalev_D | 231:079835d508ef | 152 | |
Kovalev_D | 231:079835d508ef | 153 | |
Kovalev_D | 231:079835d508ef | 154 | |
Kovalev_D | 231:079835d508ef | 155 | for(int q=0; q<64; q++) |
Kovalev_D | 231:079835d508ef | 156 | { |
Kovalev_D | 231:079835d508ef | 157 | Temp = (WormFilt2[q]>>6) + 128; |
Kovalev_D | 225:f8fee6c586cc | 158 | BuffTemp[q+2] = (Temp) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 225:f8fee6c586cc | 159 | } |
Kovalev_D | 214:4c70e452c491 | 160 | |
Kovalev_D | 214:4c70e452c491 | 161 | |
Kovalev_D | 225:f8fee6c586cc | 162 | |
Kovalev_D | 225:f8fee6c586cc | 163 | iRate_7 = ((Spi.DAC_B-0x7fff)&0xffff); |
Kovalev_D | 225:f8fee6c586cc | 164 | BuffTemp[66]=(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 225:f8fee6c586cc | 165 | BuffTemp[67]=(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; |
Kovalev_D | 225:f8fee6c586cc | 166 | |
Kovalev_D | 225:f8fee6c586cc | 167 | Rate_7 = Gyro.PLC_Eror_count>>3; |
Kovalev_D | 225:f8fee6c586cc | 168 | BuffTemp[68]=(Rate_7 >> 8) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 225:f8fee6c586cc | 169 | BuffTemp[69]=(Rate_7 >> 0) & 0xff;//младший байт разности счетчиков; |
Kovalev_D | 214:4c70e452c491 | 170 | |
Kovalev_D | 214:4c70e452c491 | 171 | Gyro.PLC_Eror_count=0; |
Kovalev_D | 218:b4067cac75c0 | 172 | |
Kovalev_D | 218:b4067cac75c0 | 173 | switch(Gyro.LG_Type) |
Kovalev_D | 214:4c70e452c491 | 174 | { |
Kovalev_D | 225:f8fee6c586cc | 175 | case 1: iRate_7 = 0xffff-Spi.DAC_A; break; |
Kovalev_D | 218:b4067cac75c0 | 176 | |
Kovalev_D | 214:4c70e452c491 | 177 | case 0: Temp2 = (Spi.DAC_A*1.538) - 0xd80f; |
Kovalev_D | 218:b4067cac75c0 | 178 | iRate_7 = (int)Temp2; |
Kovalev_D | 218:b4067cac75c0 | 179 | break; |
Kovalev_D | 214:4c70e452c491 | 180 | } |
Kovalev_D | 225:f8fee6c586cc | 181 | Rate_7 = (unsigned int)(iRate_7&0xffff); |
Kovalev_D | 225:f8fee6c586cc | 182 | BuffTemp[70]= (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 225:f8fee6c586cc | 183 | BuffTemp[71]= (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; |
Kovalev_D | 214:4c70e452c491 | 184 | |
Kovalev_D | 225:f8fee6c586cc | 185 | Check(BuffTemp,74); |
Kovalev_D | 225:f8fee6c586cc | 186 | WriteConN (BuffTemp,74); |
Kovalev_D | 214:4c70e452c491 | 187 | } |
Kovalev_D | 214:4c70e452c491 | 188 | |
Kovalev_D | 214:4c70e452c491 | 189 | |
Kovalev_D | 214:4c70e452c491 | 190 | |
Kovalev_D | 129:406995a91322 | 191 | void CMD_M_Param_R(void) |
igor_v | 0:8ad47e2b6f00 | 192 | { |
Kovalev_D | 208:19150d2b528f | 193 | |
Kovalev_D | 214:4c70e452c491 | 194 | |
Kovalev_D | 208:19150d2b528f | 195 | unsigned int NP=0; |
Kovalev_D | 129:406995a91322 | 196 | unsigned int Param; |
Kovalev_D | 208:19150d2b528f | 197 | |
Kovalev_D | 214:4c70e452c491 | 198 | |
Kovalev_D | 208:19150d2b528f | 199 | NP = BuffTemp[3]; |
Kovalev_D | 208:19150d2b528f | 200 | |
Kovalev_D | 209:224e7331a061 | 201 | for (int i=0;i<8;i++) |
Kovalev_D | 209:224e7331a061 | 202 | {BuffTemp[i]=0;} |
Kovalev_D | 208:19150d2b528f | 203 | |
Kovalev_D | 208:19150d2b528f | 204 | |
Kovalev_D | 129:406995a91322 | 205 | BuffTemp[0] = Gyro.SOC_Out; |
Kovalev_D | 129:406995a91322 | 206 | BuffTemp[1] = Gyro.My_Addres; |
Kovalev_D | 129:406995a91322 | 207 | |
Kovalev_D | 208:19150d2b528f | 208 | |
Kovalev_D | 209:224e7331a061 | 209 | /* sprintf((Time),"%d = %d \r\n",NP, GyroP.Array[NP]); |
Kovalev_D | 209:224e7331a061 | 210 | WriteCon(Time);*/ |
Kovalev_D | 129:406995a91322 | 211 | Param = GyroP.Array[NP]; |
Kovalev_D | 208:19150d2b528f | 212 | BuffTemp[2] =(GyroP.Array[NP] >> 8) & 0xff;//старший байт требуемого параметра |
Kovalev_D | 208:19150d2b528f | 213 | BuffTemp[3] =(GyroP.Array[NP] >> 0) & 0xff;//младший байт требуемого параметра |
Kovalev_D | 231:079835d508ef | 214 | |
Kovalev_D | 129:406995a91322 | 215 | Check(BuffTemp, 6); |
Kovalev_D | 129:406995a91322 | 216 | WriteConN (BuffTemp,6); |
Kovalev_D | 205:775d54fdf646 | 217 | /*sprintf((Time),"READ Param = <%07d> GyroP.Array[NP] = <%07d> NP= <%07d> Gyro.CaunPlus+Gyro.CaunMin-5000 <%07d> \r\n",Param, GyroP.Array[NP], NP, GyroP.Str.PLC_Lern); |
Kovalev_D | 205:775d54fdf646 | 218 | WriteCon(Time);*/ |
Kovalev_D | 208:19150d2b528f | 219 | NP=0; |
Kovalev_D | 129:406995a91322 | 220 | } |
Kovalev_D | 231:079835d508ef | 221 | |
Kovalev_D | 231:079835d508ef | 222 | |
Kovalev_D | 231:079835d508ef | 223 | |
Kovalev_D | 231:079835d508ef | 224 | |
Kovalev_D | 231:079835d508ef | 225 | |
Kovalev_D | 231:079835d508ef | 226 | float Float(unsigned int TermoHi,unsigned int TermoLo) |
Kovalev_D | 231:079835d508ef | 227 | { |
Kovalev_D | 231:079835d508ef | 228 | char Data[4]; |
Kovalev_D | 231:079835d508ef | 229 | int SecDelta; |
Kovalev_D | 231:079835d508ef | 230 | int TempTD; |
Kovalev_D | 231:079835d508ef | 231 | union |
Kovalev_D | 231:079835d508ef | 232 | { |
Kovalev_D | 231:079835d508ef | 233 | float num; |
Kovalev_D | 231:079835d508ef | 234 | char byte[4]; |
Kovalev_D | 231:079835d508ef | 235 | } SimpleFloat; |
Kovalev_D | 231:079835d508ef | 236 | |
Kovalev_D | 231:079835d508ef | 237 | Data[0]=TermoLo&0xfff; |
Kovalev_D | 231:079835d508ef | 238 | Data[1]=TermoLo>>8; |
Kovalev_D | 231:079835d508ef | 239 | Data[2]=TermoHi&0xfff; |
Kovalev_D | 231:079835d508ef | 240 | Data[3]=TermoHi>>8; |
Kovalev_D | 231:079835d508ef | 241 | |
Kovalev_D | 231:079835d508ef | 242 | for(int i = 0; i < 4; i++) |
Kovalev_D | 231:079835d508ef | 243 | { |
Kovalev_D | 231:079835d508ef | 244 | SimpleFloat.byte[i] = Data[i]; |
Kovalev_D | 231:079835d508ef | 245 | } |
Kovalev_D | 231:079835d508ef | 246 | |
Kovalev_D | 231:079835d508ef | 247 | |
Kovalev_D | 231:079835d508ef | 248 | return SimpleFloat.num*10000; |
Kovalev_D | 231:079835d508ef | 249 | |
Kovalev_D | 231:079835d508ef | 250 | } |
Kovalev_D | 231:079835d508ef | 251 | void Switch(unsigned int NP) |
Kovalev_D | 231:079835d508ef | 252 | { |
Kovalev_D | 231:079835d508ef | 253 | unsigned int TempTermodataHi, TempTermodataLo; |
Kovalev_D | 231:079835d508ef | 254 | switch(NP) |
Kovalev_D | 231:079835d508ef | 255 | { |
Kovalev_D | 231:079835d508ef | 256 | case 63: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_0 = GyroP.Str.TStatic_0; break; |
Kovalev_D | 231:079835d508ef | 257 | case 64: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_1 = GyroP.Str.TStatic_1; break; |
Kovalev_D | 231:079835d508ef | 258 | case 65: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_2 = GyroP.Str.TStatic_2; break; |
Kovalev_D | 231:079835d508ef | 259 | case 66: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_3 = GyroP.Str.TStatic_3; break; |
Kovalev_D | 231:079835d508ef | 260 | case 67: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_4 = GyroP.Str.TStatic_4; break; |
Kovalev_D | 231:079835d508ef | 261 | case 68: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_5 = GyroP.Str.TStatic_5; break; |
Kovalev_D | 231:079835d508ef | 262 | case 69: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_6 = GyroP.Str.TStatic_6; break; |
Kovalev_D | 231:079835d508ef | 263 | case 70: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_7 = GyroP.Str.TStatic_7; break; |
Kovalev_D | 231:079835d508ef | 264 | case 71: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_8 = GyroP.Str.TStatic_8; break; |
Kovalev_D | 231:079835d508ef | 265 | case 72: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_9 = GyroP.Str.TStatic_9; break; |
Kovalev_D | 231:079835d508ef | 266 | case 73: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_10 = GyroP.Str.TStatic_10; break; |
Kovalev_D | 231:079835d508ef | 267 | case 74: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_11 = GyroP.Str.TStatic_11; break; |
Kovalev_D | 231:079835d508ef | 268 | case 75: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_12 = GyroP.Str.TStatic_12; break; |
Kovalev_D | 231:079835d508ef | 269 | case 76: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_13 = GyroP.Str.TStatic_13; break; |
Kovalev_D | 231:079835d508ef | 270 | |
Kovalev_D | 231:079835d508ef | 271 | |
Kovalev_D | 231:079835d508ef | 272 | case 160: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_0 = GyroP.Str.TDCool_0; break; |
Kovalev_D | 231:079835d508ef | 273 | case 161: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_1 = GyroP.Str.TDCool_1; break; |
Kovalev_D | 231:079835d508ef | 274 | case 162: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_2 = GyroP.Str.TDCool_2; break; |
Kovalev_D | 231:079835d508ef | 275 | case 163: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_3 = GyroP.Str.TDCool_3; break; |
Kovalev_D | 231:079835d508ef | 276 | case 164: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_4 = GyroP.Str.TDCool_4; break; |
Kovalev_D | 231:079835d508ef | 277 | case 165: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_5 = GyroP.Str.TDCool_5; break; |
Kovalev_D | 231:079835d508ef | 278 | case 166: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_6 = GyroP.Str.TDCool_6; break; |
Kovalev_D | 231:079835d508ef | 279 | case 167: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_7 = GyroP.Str.TDCool_7; break; |
Kovalev_D | 231:079835d508ef | 280 | case 168: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_8 = GyroP.Str.TDCool_8; break; |
Kovalev_D | 231:079835d508ef | 281 | case 169: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_9 = GyroP.Str.TDCool_9; break; |
Kovalev_D | 231:079835d508ef | 282 | case 170: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_10 = GyroP.Str.TDCool_10; break; |
Kovalev_D | 231:079835d508ef | 283 | case 171: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_11 = GyroP.Str.TDCool_11; break; |
Kovalev_D | 231:079835d508ef | 284 | case 172: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_12 = GyroP.Str.TDCool_12; break; |
Kovalev_D | 231:079835d508ef | 285 | case 173: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_13 = GyroP.Str.TDCool_13; break; |
Kovalev_D | 231:079835d508ef | 286 | |
Kovalev_D | 231:079835d508ef | 287 | |
Kovalev_D | 231:079835d508ef | 288 | case 78: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_0 = Float(GyroP.Str.TermoDeltaStatic_0, GyroP.Str.TermoDeltaStatic_1 ); break; |
Kovalev_D | 231:079835d508ef | 289 | case 80: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_1 = Float(GyroP.Str.TermoDeltaStatic_2, GyroP.Str.TermoDeltaStatic_3 ); break; |
Kovalev_D | 231:079835d508ef | 290 | case 82: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_2 = Float(GyroP.Str.TermoDeltaStatic_4, GyroP.Str.TermoDeltaStatic_5 ); break; |
Kovalev_D | 231:079835d508ef | 291 | case 84: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_3 = Float(GyroP.Str.TermoDeltaStatic_6, GyroP.Str.TermoDeltaStatic_7 ); break; |
Kovalev_D | 231:079835d508ef | 292 | case 86: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_4 = Float(GyroP.Str.TermoDeltaStatic_8, GyroP.Str.TermoDeltaStatic_9 ); break; |
Kovalev_D | 231:079835d508ef | 293 | case 88: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_5 = Float(GyroP.Str.TermoDeltaStatic_10,GyroP.Str.TermoDeltaStatic_11); break; |
Kovalev_D | 231:079835d508ef | 294 | case 90: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_6 = Float(GyroP.Str.TermoDeltaStatic_12,GyroP.Str.TermoDeltaStatic_13); break; |
Kovalev_D | 231:079835d508ef | 295 | case 92: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_7 = Float(GyroP.Str.TermoDeltaStatic_14,GyroP.Str.TermoDeltaStatic_15); break; |
Kovalev_D | 231:079835d508ef | 296 | case 94: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_8 = Float(GyroP.Str.TermoDeltaStatic_16,GyroP.Str.TermoDeltaStatic_17); break; |
Kovalev_D | 231:079835d508ef | 297 | case 96: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_9 = Float(GyroP.Str.TermoDeltaStatic_18,GyroP.Str.TermoDeltaStatic_19); break; |
Kovalev_D | 231:079835d508ef | 298 | case 98: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_10 = Float(GyroP.Str.TermoDeltaStatic_20,GyroP.Str.TermoDeltaStatic_21); break; |
Kovalev_D | 231:079835d508ef | 299 | case 100: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_11 = Float(GyroP.Str.TermoDeltaStatic_22,GyroP.Str.TermoDeltaStatic_23); break; |
Kovalev_D | 231:079835d508ef | 300 | case 102: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_12 = Float(GyroP.Str.TermoDeltaStatic_24,GyroP.Str.TermoDeltaStatic_25); break; |
Kovalev_D | 231:079835d508ef | 301 | case 104: TermoCorrStatic.TermoDeltaStatic.Str.TermoDeltaStatic_13 = Float(GyroP.Str.TermoDeltaStatic_26,GyroP.Str.TermoDeltaStatic_27); break; |
Kovalev_D | 231:079835d508ef | 302 | case 175: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_0 = Float(GyroP.Str.TermoDynamicDataHeat0, GyroP.Str.TermoDynamicDataHeat1 ); break; |
Kovalev_D | 231:079835d508ef | 303 | case 177: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_1 = Float(GyroP.Str.TermoDynamicDataHeat2, GyroP.Str.TermoDynamicDataHeat3 ); break; |
Kovalev_D | 231:079835d508ef | 304 | case 179: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_2 = Float(GyroP.Str.TermoDynamicDataHeat4, GyroP.Str.TermoDynamicDataHeat5 ); break; |
Kovalev_D | 231:079835d508ef | 305 | case 181: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_3 = Float(GyroP.Str.TermoDynamicDataHeat6, GyroP.Str.TermoDynamicDataHeat7 ); break; |
Kovalev_D | 231:079835d508ef | 306 | case 183: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_4 = Float(GyroP.Str.TermoDynamicDataHeat8, GyroP.Str.TermoDynamicDataHeat9 ); break; |
Kovalev_D | 231:079835d508ef | 307 | case 185: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_5 = Float(GyroP.Str.TermoDynamicDataHeat10,GyroP.Str.TermoDynamicDataHeat11); break; |
Kovalev_D | 231:079835d508ef | 308 | case 187: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_6 = Float(GyroP.Str.TermoDynamicDataHeat12,GyroP.Str.TermoDynamicDataHeat13); break; |
Kovalev_D | 231:079835d508ef | 309 | case 189: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_7 = Float(GyroP.Str.TermoDynamicDataHeat14,GyroP.Str.TermoDynamicDataHeat15); break; |
Kovalev_D | 231:079835d508ef | 310 | case 191: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_8 = Float(GyroP.Str.TermoDynamicDataHeat16,GyroP.Str.TermoDynamicDataHeat17); break; |
Kovalev_D | 231:079835d508ef | 311 | case 193: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_9 = Float(GyroP.Str.TermoDynamicDataHeat18,GyroP.Str.TermoDynamicDataHeat19); break; |
Kovalev_D | 231:079835d508ef | 312 | case 195: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_10 = Float(GyroP.Str.TermoDynamicDataHeat20,GyroP.Str.TermoDynamicDataHeat21); break; |
Kovalev_D | 231:079835d508ef | 313 | case 197: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_11 = Float(GyroP.Str.TermoDynamicDataHeat22,GyroP.Str.TermoDynamicDataHeat23); break; |
Kovalev_D | 231:079835d508ef | 314 | case 199: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_12 = Float(GyroP.Str.TermoDynamicDataHeat24,GyroP.Str.TermoDynamicDataHeat25); break; |
Kovalev_D | 231:079835d508ef | 315 | case 201: TermoCorrDynamic.TermoDeltaDynamic.Str.TermoDeltaDynamic_13 = Float(GyroP.Str.TermoDynamicDataHeat26,GyroP.Str.TermoDynamicDataHeat27); break; |
Kovalev_D | 231:079835d508ef | 316 | } |
Kovalev_D | 231:079835d508ef | 317 | |
Kovalev_D | 231:079835d508ef | 318 | } |
Kovalev_D | 129:406995a91322 | 319 | void CMD_M_Param_W(void) |
Kovalev_D | 129:406995a91322 | 320 | { |
Kovalev_D | 208:19150d2b528f | 321 | unsigned int NP=0; |
Kovalev_D | 208:19150d2b528f | 322 | unsigned int Param,temp,flash; |
Kovalev_D | 231:079835d508ef | 323 | unsigned int TempTermodataHi, TempTermodataLo; |
Kovalev_D | 231:079835d508ef | 324 | float Ttemp; |
Kovalev_D | 231:079835d508ef | 325 | |
Kovalev_D | 129:406995a91322 | 326 | NP = BuffTemp[3]; |
Kovalev_D | 129:406995a91322 | 327 | Param = (BuffTemp[4]<<8); |
Kovalev_D | 129:406995a91322 | 328 | Param |= BuffTemp[5]; |
Kovalev_D | 129:406995a91322 | 329 | |
Kovalev_D | 208:19150d2b528f | 330 | GyroP.Array[NP] = Param; |
Kovalev_D | 222:7de7b3bf3a1d | 331 | flash=GyroP.Array[115]; |
Kovalev_D | 231:079835d508ef | 332 | sprintf((Time),"READ NP= <%07d> Param = <%07d> \r\n", NP, Param); |
Kovalev_D | 231:079835d508ef | 333 | WriteCon(Time); |
Kovalev_D | 231:079835d508ef | 334 | Gyro.NP=NP; |
Kovalev_D | 231:079835d508ef | 335 | // Switch(NP); |
Kovalev_D | 231:079835d508ef | 336 | |
Kovalev_D | 208:19150d2b528f | 337 | switch(NP) |
Kovalev_D | 208:19150d2b528f | 338 | { |
Kovalev_D | 231:079835d508ef | 339 | case 63: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_0 = GyroP.Str.TStatic_0; break; |
Kovalev_D | 231:079835d508ef | 340 | case 64: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_1 = GyroP.Str.TStatic_1; break; |
Kovalev_D | 231:079835d508ef | 341 | case 65: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_2 = GyroP.Str.TStatic_2; break; |
Kovalev_D | 231:079835d508ef | 342 | case 66: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_3 = GyroP.Str.TStatic_3; break; |
Kovalev_D | 231:079835d508ef | 343 | case 67: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_4 = GyroP.Str.TStatic_4; break; |
Kovalev_D | 231:079835d508ef | 344 | case 68: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_5 = GyroP.Str.TStatic_5; break; |
Kovalev_D | 231:079835d508ef | 345 | case 69: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_6 = GyroP.Str.TStatic_6; break; |
Kovalev_D | 231:079835d508ef | 346 | case 70: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_7 = GyroP.Str.TStatic_7; break; |
Kovalev_D | 231:079835d508ef | 347 | case 71: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_8 = GyroP.Str.TStatic_8; break; |
Kovalev_D | 231:079835d508ef | 348 | case 72: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_9 = GyroP.Str.TStatic_9; break; |
Kovalev_D | 231:079835d508ef | 349 | case 73: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_10 = GyroP.Str.TStatic_10; break; |
Kovalev_D | 231:079835d508ef | 350 | case 74: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_11 = GyroP.Str.TStatic_11; break; |
Kovalev_D | 231:079835d508ef | 351 | case 75: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_12 = GyroP.Str.TStatic_12; break; |
Kovalev_D | 231:079835d508ef | 352 | case 76: TermoCorrStatic.TermoTempStatic.Str.TermoTempStatic_13 = GyroP.Str.TStatic_13; break; |
Kovalev_D | 231:079835d508ef | 353 | |
Kovalev_D | 231:079835d508ef | 354 | |
Kovalev_D | 231:079835d508ef | 355 | case 160: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_0 = GyroP.Str.TDCool_0; break; |
Kovalev_D | 231:079835d508ef | 356 | case 161: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_1 = GyroP.Str.TDCool_1; break; |
Kovalev_D | 231:079835d508ef | 357 | case 162: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_2 = GyroP.Str.TDCool_2; break; |
Kovalev_D | 231:079835d508ef | 358 | case 163: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_3 = GyroP.Str.TDCool_3; break; |
Kovalev_D | 231:079835d508ef | 359 | case 164: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_4 = GyroP.Str.TDCool_4; break; |
Kovalev_D | 231:079835d508ef | 360 | case 165: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_5 = GyroP.Str.TDCool_5; break; |
Kovalev_D | 231:079835d508ef | 361 | case 166: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_6 = GyroP.Str.TDCool_6; break; |
Kovalev_D | 231:079835d508ef | 362 | case 167: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_7 = GyroP.Str.TDCool_7; break; |
Kovalev_D | 231:079835d508ef | 363 | case 168: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_8 = GyroP.Str.TDCool_8; break; |
Kovalev_D | 231:079835d508ef | 364 | case 169: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_9 = GyroP.Str.TDCool_9; break; |
Kovalev_D | 231:079835d508ef | 365 | case 170: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_10 = GyroP.Str.TDCool_10; break; |
Kovalev_D | 231:079835d508ef | 366 | case 171: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_11 = GyroP.Str.TDCool_11; break; |
Kovalev_D | 231:079835d508ef | 367 | case 172: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_12 = GyroP.Str.TDCool_12; break; |
Kovalev_D | 231:079835d508ef | 368 | case 173: TermoCorrDynamic.TermoTempDynamic.Str.TermoTempDynamic_13 = GyroP.Str.TDCool_13; break; |
Kovalev_D | 231:079835d508ef | 369 | |
Kovalev_D | 231:079835d508ef | 370 | |
Kovalev_D | 231:079835d508ef | 371 | |
Kovalev_D | 227:2774b56bfab0 | 372 | //case 0: Gyro.My_Addres = GyroP.Str.My_Addres; break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 373 | case 1: Gyro.HFO_ref = (unsigned int)(GyroP.Str.HFO_ref) ; break; |
Kovalev_D | 231:079835d508ef | 374 | case 2: Gyro.HFO_Gain = GyroP.Str.HFO_Gain; break; |
Kovalev_D | 225:f8fee6c586cc | 375 | case 3: if(Gyro.LG_Type) Gyro.HFO_Max=0xffff-GyroP.Str.DAC_current_Work; //((int)(GyroP.Str.DAC_current_Work*0.67)-2000); |
Kovalev_D | 211:ac8251b067d2 | 376 | else Spi.DAC_A = ((((int)(GyroP.Str.DAC_current_Work+ 0x7fff)&0xffff)+22544)*0.65); break; |
Kovalev_D | 211:ac8251b067d2 | 377 | |
Kovalev_D | 225:f8fee6c586cc | 378 | case 4: if(Gyro.LG_Type) Gyro.HFO_Min=0xffff-GyroP.Str.DAC_current_Start; break; //((int)(GyroP.Str.DAC_current_Start*0.67)-2000); break; |
Kovalev_D | 208:19150d2b528f | 379 | |
Kovalev_D | 222:7de7b3bf3a1d | 380 | case 5: Gyro.TimeToJump = GyroP.Str.TimeToJump; break; |
Kovalev_D | 222:7de7b3bf3a1d | 381 | case 6: Gyro.JumpDelta = GyroP.Str.JumpDelta; break; |
Kovalev_D | 222:7de7b3bf3a1d | 382 | |
Kovalev_D | 209:224e7331a061 | 383 | case 7: Gyro.PLC_Phase = GyroP.Str.PLC_Phase; break; |
Kovalev_D | 209:224e7331a061 | 384 | case 8: Gyro.PLC_Gain = GyroP.Str.PLC_Gain; break; |
Kovalev_D | 209:224e7331a061 | 385 | case 12: Gyro.FrqPhase = GyroP.Str.FrqPhase; break; |
Kovalev_D | 209:224e7331a061 | 386 | case 13: Gyro.FrqChengSpeed = GyroP.Str.FrqChengSpeed; break; |
Kovalev_D | 209:224e7331a061 | 387 | |
Kovalev_D | 209:224e7331a061 | 388 | case 14: Gyro.FrqHZ = (7680000 / GyroP.Str.FrqHZ); |
Kovalev_D | 209:224e7331a061 | 389 | Gyro.Frq = (7680000 / GyroP.Str.FrqHZ)<<16; |
Kovalev_D | 208:19150d2b528f | 390 | break; |
Kovalev_D | 208:19150d2b528f | 391 | |
Kovalev_D | 209:224e7331a061 | 392 | case 15: Gyro.FrqHZmin = (7680000 / GyroP.Str.FrqHZmin)<<16; break; |
Kovalev_D | 209:224e7331a061 | 393 | case 16: Gyro.FrqHZmax = (7680000 / GyroP.Str.FrqHZmax)<<16; break; |
Kovalev_D | 208:19150d2b528f | 394 | |
Kovalev_D | 208:19150d2b528f | 395 | case 18: temp=((GyroP.Str.VB_Fdf_Hi<<16) | GyroP.Str.VB_Fdf_Lo); |
Kovalev_D | 225:f8fee6c586cc | 396 | |
Kovalev_D | 218:b4067cac75c0 | 397 | temp=temp*20; |
Kovalev_D | 218:b4067cac75c0 | 398 | Gyro.AmpTarget=(unsigned int)(temp); |
Kovalev_D | 208:19150d2b528f | 399 | break; |
Kovalev_D | 208:19150d2b528f | 400 | |
Kovalev_D | 209:224e7331a061 | 401 | case 19: Gyro.AmpSpeed = GyroP.Str.AmpSpeed; break; |
Kovalev_D | 209:224e7331a061 | 402 | case 20: Gyro.AmpPerMin = GyroP.Str.AmpPerMin; break; |
Kovalev_D | 209:224e7331a061 | 403 | case 21: Gyro.AmpPerMax = GyroP.Str.AmpPerMax; break; |
Kovalev_D | 208:19150d2b528f | 404 | |
Kovalev_D | 208:19150d2b528f | 405 | case 22: Gyro.AmpPer = GyroP.Str.AmpPer; |
Kovalev_D | 208:19150d2b528f | 406 | Gyro.Amp = GyroP.Str.AmpPer<<16; |
Kovalev_D | 208:19150d2b528f | 407 | break; |
Kovalev_D | 208:19150d2b528f | 408 | |
Kovalev_D | 209:224e7331a061 | 409 | case 23: Gyro.AmpMin = GyroP.Str.AmpMin; break; |
Kovalev_D | 209:224e7331a061 | 410 | case 24: Gyro.AmpTD = GyroP.Str.AmpTD; break; |
Kovalev_D | 209:224e7331a061 | 411 | case 25: Gyro.AmpPerDel = GyroP.Str.AmpPerDel; break; |
Kovalev_D | 220:04c54405b82d | 412 | case 33: Gyro.ShiftMod = GyroP.Str.ShiftMod; break; |
Kovalev_D | 209:224e7331a061 | 413 | case 34: Gyro.ModAmp = GyroP.Str.ModAmp; break; |
Kovalev_D | 208:19150d2b528f | 414 | case 56: Gyro.Gain_Sin = GyroP.Str.Gain_Sin; |
Kovalev_D | 208:19150d2b528f | 415 | Out_G_photo(Gyro.Gain_Sin, Gyro.Gain_Cos); |
Kovalev_D | 208:19150d2b528f | 416 | break; |
Kovalev_D | 208:19150d2b528f | 417 | case 57: Gyro.Gain_Cos = GyroP.Str.Gain_Cos; |
Kovalev_D | 208:19150d2b528f | 418 | Out_G_photo(Gyro.Gain_Sin, Gyro.Gain_Cos); |
Kovalev_D | 208:19150d2b528f | 419 | break; |
Kovalev_D | 209:224e7331a061 | 420 | case 60: Gyro.GLD_Serial = GyroP.Str.GLD_Serial; break; |
Kovalev_D | 211:ac8251b067d2 | 421 | |
Kovalev_D | 211:ac8251b067d2 | 422 | |
Kovalev_D | 225:f8fee6c586cc | 423 | case 10: Gyro.DownTreshold = (unsigned int)((GyroP.Str.DownTreshold-0x7fff)&0xffff); break; |
Kovalev_D | 225:f8fee6c586cc | 424 | case 11: Gyro.HighTreshold = (unsigned int)((GyroP.Str.HighTreshold-0x7fff)&0xffff); break; |
Kovalev_D | 225:f8fee6c586cc | 425 | |
Kovalev_D | 225:f8fee6c586cc | 426 | case 9: Gyro.PLCDelay = GyroP.Str.PLCDelay; break; |
Kovalev_D | 225:f8fee6c586cc | 427 | |
Kovalev_D | 225:f8fee6c586cc | 428 | case 105:Gyro.ResetLevelCool = (unsigned int)((GyroP.Str.ResetLevelCool-0x7fff)&0xffff); break; |
Kovalev_D | 225:f8fee6c586cc | 429 | case 55: Gyro.ResetLevelHeat = (unsigned int)((GyroP.Str.ResetLevelHeat-0x7fff)&0xffff); break; |
Kovalev_D | 225:f8fee6c586cc | 430 | |
Kovalev_D | 231:079835d508ef | 431 | |
Kovalev_D | 231:079835d508ef | 432 | default : Gyro.ParamFlag=1; |
Kovalev_D | 231:079835d508ef | 433 | |
Kovalev_D | 208:19150d2b528f | 434 | } |
Kovalev_D | 208:19150d2b528f | 435 | |
Kovalev_D | 208:19150d2b528f | 436 | NP=0; |
Kovalev_D | 129:406995a91322 | 437 | |
Kovalev_D | 129:406995a91322 | 438 | BuffTemp[0] = Gyro.SOC_Out; |
Kovalev_D | 129:406995a91322 | 439 | BuffTemp[1] = Gyro.My_Addres; |
Kovalev_D | 129:406995a91322 | 440 | BuffTemp[2] = Gyro.CMD_In; |
Kovalev_D | 208:19150d2b528f | 441 | BuffTemp[3] =0; //(//GyroP.Array[NP]>> 8) & 0xff;//старший байт требуемого параметра |
Kovalev_D | 129:406995a91322 | 442 | |
Kovalev_D | 129:406995a91322 | 443 | Check(BuffTemp, 6); |
Kovalev_D | 129:406995a91322 | 444 | WriteConN (BuffTemp,6); |
Kovalev_D | 222:7de7b3bf3a1d | 445 | if(flash){GyroP.Array[115]=0; flash=0; WriteFlash(); ReadFlash ();} |
Kovalev_D | 208:19150d2b528f | 446 | |
Kovalev_D | 208:19150d2b528f | 447 | |
Kovalev_D | 129:406995a91322 | 448 | } |
igor_v | 0:8ad47e2b6f00 | 449 | void CMD_Maintenance(void) |
igor_v | 0:8ad47e2b6f00 | 450 | { |
Kovalev_D | 227:2774b56bfab0 | 451 | unsigned int Temp; |
Kovalev_D | 231:079835d508ef | 452 | |
Kovalev_D | 231:079835d508ef | 453 | |
Kovalev_D | 231:079835d508ef | 454 | sprintf((Time),"%d %d\r\n", Spi.DAC_B, PlcWormDeltaout); |
Kovalev_D | 231:079835d508ef | 455 | WriteCon(Time); |
Kovalev_D | 231:079835d508ef | 456 | |
Kovalev_D | 231:079835d508ef | 457 | /* sprintf((Time),"%d\r\n",convertStrToTime(__DATE__)); |
Kovalev_D | 231:079835d508ef | 458 | WriteCon(Time);*/ |
Kovalev_D | 231:079835d508ef | 459 | |
Kovalev_D | 231:079835d508ef | 460 | |
Kovalev_D | 231:079835d508ef | 461 | |
Kovalev_D | 227:2774b56bfab0 | 462 | Gyro.ModeOut = 0; |
Kovalev_D | 227:2774b56bfab0 | 463 | Gyro.Device_Mode = 0; |
Kovalev_D | 218:b4067cac75c0 | 464 | for(int q=0; q<64; q++) |
Kovalev_D | 218:b4067cac75c0 | 465 | { |
Kovalev_D | 218:b4067cac75c0 | 466 | BuffTemp[q]=0; |
Kovalev_D | 218:b4067cac75c0 | 467 | } |
Kovalev_D | 208:19150d2b528f | 468 | //Gyro.DropDelayGLD = DropDelayGLD_0;//задержка на выдачу 45 микросекунд для любого адреса ГЛД |
Kovalev_D | 122:fbacb932a30b | 469 | BuffTemp[0] = Gyro.SOC_Out; |
Kovalev_D | 124:9ae09249f842 | 470 | BuffTemp[1] = Gyro.My_Addres; |
Kovalev_D | 209:224e7331a061 | 471 | |
Kovalev_D | 231:079835d508ef | 472 | Temp = Gyro.Firmware_Version;//17543; //Gyro.Firmware_Version; |
Kovalev_D | 227:2774b56bfab0 | 473 | BuffTemp[2] = (Temp >> 0) & 0xff; |
Kovalev_D | 227:2774b56bfab0 | 474 | BuffTemp[3] = (Temp >> 8) & 0xff; |
Kovalev_D | 227:2774b56bfab0 | 475 | |
Kovalev_D | 227:2774b56bfab0 | 476 | Temp = Gyro.GLD_Serial; |
Kovalev_D | 227:2774b56bfab0 | 477 | BuffTemp[4]=(Temp >> 0) & 0xff; |
Kovalev_D | 227:2774b56bfab0 | 478 | BuffTemp[5]=(Temp >> 8) & 0xff; |
Kovalev_D | 209:224e7331a061 | 479 | |
igor_v | 21:bc8c1cec3da6 | 480 | Check(BuffTemp, 8); |
igor_v | 21:bc8c1cec3da6 | 481 | WriteConN (BuffTemp,8); |
Kovalev_D | 121:bbae560cdd43 | 482 | |
igor_v | 0:8ad47e2b6f00 | 483 | } |
Kovalev_D | 193:a0fe8bfc97e4 | 484 | void CMD_B_Delta(void) |
Kovalev_D | 193:a0fe8bfc97e4 | 485 | { |
Kovalev_D | 196:f76dbc081e63 | 486 | Gyro.Event_500Hz=0; |
Kovalev_D | 205:775d54fdf646 | 487 | Gyro.EXT_Latch=0; |
Kovalev_D | 193:a0fe8bfc97e4 | 488 | unsigned int Temp; |
Kovalev_D | 193:a0fe8bfc97e4 | 489 | BuffTemp[ 0] = Gyro.SOC_Out; |
Kovalev_D | 193:a0fe8bfc97e4 | 490 | BuffTemp[ 1] = Gyro.My_Addres; |
Kovalev_D | 193:a0fe8bfc97e4 | 491 | |
Kovalev_D | 193:a0fe8bfc97e4 | 492 | Temp = Gyro.CuruAngle; |
Kovalev_D | 193:a0fe8bfc97e4 | 493 | Gyro.CuruAngle = 0; |
Kovalev_D | 193:a0fe8bfc97e4 | 494 | BuffTemp[ 2] =(Temp >> 16) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 193:a0fe8bfc97e4 | 495 | BuffTemp[ 3] =(Temp >> 8) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 193:a0fe8bfc97e4 | 496 | BuffTemp[ 4] =(Temp >> 0) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 193:a0fe8bfc97e4 | 497 | BuffTemp[ 5] = 0x00000000; |
Kovalev_D | 193:a0fe8bfc97e4 | 498 | Check(BuffTemp, 8); |
Kovalev_D | 193:a0fe8bfc97e4 | 499 | WriteConN (BuffTemp,8); |
Kovalev_D | 193:a0fe8bfc97e4 | 500 | } |
Kovalev_D | 165:b2bd0c810a4f | 501 | |
Kovalev_D | 193:a0fe8bfc97e4 | 502 | void CMD_Delta_Bins(void) |
Kovalev_D | 196:f76dbc081e63 | 503 | { Gyro.Event_500Hz=0; |
Kovalev_D | 193:a0fe8bfc97e4 | 504 | unsigned int Temp; |
Kovalev_D | 193:a0fe8bfc97e4 | 505 | BuffTemp[ 0] = Gyro.SOC_Out; |
Kovalev_D | 193:a0fe8bfc97e4 | 506 | BuffTemp[ 1] = Gyro.My_Addres; |
Kovalev_D | 193:a0fe8bfc97e4 | 507 | |
Kovalev_D | 193:a0fe8bfc97e4 | 508 | Temp = Gyro.CuruAngle; |
Kovalev_D | 193:a0fe8bfc97e4 | 509 | Gyro.CuruAngle = 0; |
Kovalev_D | 193:a0fe8bfc97e4 | 510 | |
Kovalev_D | 193:a0fe8bfc97e4 | 511 | BuffTemp[ 2] =(Temp >> 24) & 0xff;//старший байт разности счетчиков |
Kovalev_D | 193:a0fe8bfc97e4 | 512 | BuffTemp[ 3] =(Temp >> 16) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 193:a0fe8bfc97e4 | 513 | BuffTemp[ 4] =(Temp >> 8) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 193:a0fe8bfc97e4 | 514 | BuffTemp[ 5] =(Temp >> 0) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 193:a0fe8bfc97e4 | 515 | BuffTemp[ 6] = 0x0000; |
Kovalev_D | 193:a0fe8bfc97e4 | 516 | Check(BuffTemp, 9); |
Kovalev_D | 193:a0fe8bfc97e4 | 517 | WriteConN (BuffTemp,9); |
Kovalev_D | 193:a0fe8bfc97e4 | 518 | } |
Kovalev_D | 193:a0fe8bfc97e4 | 519 | void CMD_Delta_PS(void) |
Kovalev_D | 210:b02fa166315d | 520 | { int drob,Temp1; |
Kovalev_D | 210:b02fa166315d | 521 | float Temp2=0; |
Kovalev_D | 193:a0fe8bfc97e4 | 522 | Gyro.EXT_Latch=0; |
Kovalev_D | 196:f76dbc081e63 | 523 | Gyro.Event_500Hz=0; |
Kovalev_D | 122:fbacb932a30b | 524 | unsigned int Temp; |
Kovalev_D | 218:b4067cac75c0 | 525 | |
Kovalev_D | 218:b4067cac75c0 | 526 | |
Kovalev_D | 218:b4067cac75c0 | 527 | |
Kovalev_D | 124:9ae09249f842 | 528 | BuffTemp[ 0] = Gyro.SOC_Out; |
Kovalev_D | 122:fbacb932a30b | 529 | BuffTemp[ 1] = Gyro.My_Addres; |
Kovalev_D | 208:19150d2b528f | 530 | |
Kovalev_D | 209:224e7331a061 | 531 | Gyro.CuruAngle = Gyro.CuruAngle + OldCuruAngle; //(72 град/с) |
Kovalev_D | 227:2774b56bfab0 | 532 | |
Kovalev_D | 214:4c70e452c491 | 533 | OldCuruAngle=Gyro.CuruAngle & 0xf; //сохраняем 3 бит для след измирений |
Kovalev_D | 227:2774b56bfab0 | 534 | Temp=Gyro.CuruAngle>>4; |
Kovalev_D | 227:2774b56bfab0 | 535 | //приводим к форме вывода |
Kovalev_D | 209:224e7331a061 | 536 | Gyro.CuruAngle = 0; |
Kovalev_D | 227:2774b56bfab0 | 537 | //Temp=200; |
Kovalev_D | 124:9ae09249f842 | 538 | BuffTemp[ 2] =(Temp >> 8) & 0xff;//старший байт разности счетчиков |
Kovalev_D | 124:9ae09249f842 | 539 | BuffTemp[ 3] =(Temp >> 0) & 0xff;//младший байт разности счетчиков |
Kovalev_D | 124:9ae09249f842 | 540 | |
Kovalev_D | 124:9ae09249f842 | 541 | BuffTemp[ 4] = CountParam; |
Kovalev_D | 124:9ae09249f842 | 542 | switch(CountParam) { |
Kovalev_D | 182:ebcd2bc3be8f | 543 | |
Kovalev_D | 124:9ae09249f842 | 544 | //F_ras |
Kovalev_D | 124:9ae09249f842 | 545 | case 0: |
Kovalev_D | 211:ac8251b067d2 | 546 | OutDeltaPS = Gyro.F_ras; |
Kovalev_D | 211:ac8251b067d2 | 547 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 548 | break; |
Kovalev_D | 124:9ae09249f842 | 549 | |
Kovalev_D | 124:9ae09249f842 | 550 | case 1: |
Kovalev_D | 211:ac8251b067d2 | 551 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 552 | break; |
Kovalev_D | 208:19150d2b528f | 553 | |
Kovalev_D | 124:9ae09249f842 | 554 | |
Kovalev_D | 124:9ae09249f842 | 555 | //HFO |
Kovalev_D | 124:9ae09249f842 | 556 | case 2: |
Kovalev_D | 227:2774b56bfab0 | 557 | |
Kovalev_D | 227:2774b56bfab0 | 558 | OutDeltaPS = 0xffff - Spi.DAC_A; |
Kovalev_D | 211:ac8251b067d2 | 559 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 560 | break; |
Kovalev_D | 124:9ae09249f842 | 561 | |
Kovalev_D | 124:9ae09249f842 | 562 | case 3: |
Kovalev_D | 211:ac8251b067d2 | 563 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 564 | break; |
Kovalev_D | 124:9ae09249f842 | 565 | |
Kovalev_D | 124:9ae09249f842 | 566 | |
Kovalev_D | 124:9ae09249f842 | 567 | |
Kovalev_D | 124:9ae09249f842 | 568 | //T_Vibro |
Kovalev_D | 124:9ae09249f842 | 569 | case 4: |
Kovalev_D | 228:a8195e1b1123 | 570 | OutDeltaPS = Gyro.Frq>>12;//(unsigned int)(7680000/(Gyro.Frq>>16)); |
Kovalev_D | 211:ac8251b067d2 | 571 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 572 | break; |
Kovalev_D | 124:9ae09249f842 | 573 | |
Kovalev_D | 124:9ae09249f842 | 574 | case 5: |
Kovalev_D | 211:ac8251b067d2 | 575 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 576 | break; |
Kovalev_D | 124:9ae09249f842 | 577 | |
Kovalev_D | 124:9ae09249f842 | 578 | |
Kovalev_D | 124:9ae09249f842 | 579 | |
Kovalev_D | 124:9ae09249f842 | 580 | //L_Vibro |
Kovalev_D | 124:9ae09249f842 | 581 | case 6: |
Kovalev_D | 210:b02fa166315d | 582 | //Temp = Gyro.L_vibro>>1; |
Kovalev_D | 228:a8195e1b1123 | 583 | OutDeltaPS = Gyro.AmpPer; |
Kovalev_D | 211:ac8251b067d2 | 584 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 585 | |
Kovalev_D | 124:9ae09249f842 | 586 | break; |
Kovalev_D | 124:9ae09249f842 | 587 | |
Kovalev_D | 124:9ae09249f842 | 588 | case 7: |
Kovalev_D | 211:ac8251b067d2 | 589 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 590 | break; |
Kovalev_D | 124:9ae09249f842 | 591 | |
Kovalev_D | 124:9ae09249f842 | 592 | |
Kovalev_D | 124:9ae09249f842 | 593 | |
Kovalev_D | 124:9ae09249f842 | 594 | //Напряжение на регуляторе периметра |
Kovalev_D | 124:9ae09249f842 | 595 | case 8: |
Kovalev_D | 227:2774b56bfab0 | 596 | OutDeltaPS = ((Spi.DAC_B-0x7fff)&0xffff); |
Kovalev_D | 211:ac8251b067d2 | 597 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 598 | |
Kovalev_D | 124:9ae09249f842 | 599 | break; |
Kovalev_D | 124:9ae09249f842 | 600 | |
Kovalev_D | 124:9ae09249f842 | 601 | case 9: |
Kovalev_D | 211:ac8251b067d2 | 602 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 603 | break; |
Kovalev_D | 124:9ae09249f842 | 604 | |
Kovalev_D | 124:9ae09249f842 | 605 | |
Kovalev_D | 124:9ae09249f842 | 606 | |
Kovalev_D | 124:9ae09249f842 | 607 | //темпкратурный канал 0 |
Kovalev_D | 124:9ae09249f842 | 608 | case 10: |
Kovalev_D | 211:ac8251b067d2 | 609 | OutDeltaPS = 0; |
Kovalev_D | 211:ac8251b067d2 | 610 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff; |
igor_v | 0:8ad47e2b6f00 | 611 | |
Kovalev_D | 124:9ae09249f842 | 612 | break; |
Kovalev_D | 124:9ae09249f842 | 613 | |
Kovalev_D | 124:9ae09249f842 | 614 | case 11: |
Kovalev_D | 211:ac8251b067d2 | 615 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 616 | break; |
Kovalev_D | 124:9ae09249f842 | 617 | |
Kovalev_D | 124:9ae09249f842 | 618 | |
Kovalev_D | 124:9ae09249f842 | 619 | |
Kovalev_D | 177:1666a83d88a5 | 620 | //f |
Kovalev_D | 124:9ae09249f842 | 621 | case 12: |
Kovalev_D | 211:ac8251b067d2 | 622 | OutDeltaPS =0;//(unsigned int)(0x7fff-Spi.ADC5)*0.79; |
Kovalev_D | 210:b02fa166315d | 623 | // Temp = Gyro.AD_Slow >> 16; |
Kovalev_D | 211:ac8251b067d2 | 624 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 625 | |
Kovalev_D | 124:9ae09249f842 | 626 | break; |
Kovalev_D | 124:9ae09249f842 | 627 | |
Kovalev_D | 124:9ae09249f842 | 628 | case 13: |
Kovalev_D | 211:ac8251b067d2 | 629 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 630 | break; |
Kovalev_D | 124:9ae09249f842 | 631 | |
Kovalev_D | 124:9ae09249f842 | 632 | |
Kovalev_D | 124:9ae09249f842 | 633 | |
Kovalev_D | 124:9ae09249f842 | 634 | //ток 1 |
Kovalev_D | 124:9ae09249f842 | 635 | case 14: |
Kovalev_D | 210:b02fa166315d | 636 | //Temp = Gyro.In1; |
Kovalev_D | 227:2774b56bfab0 | 637 | IntOutDeltaPS = 0;//((Gyro.In1>>1)*0.800875)-0x3e0b; |
Kovalev_D | 211:ac8251b067d2 | 638 | BuffTemp[5] = (IntOutDeltaPS >> 8) & 0xff;//in1//2 |
Kovalev_D | 124:9ae09249f842 | 639 | |
Kovalev_D | 124:9ae09249f842 | 640 | break; |
Kovalev_D | 124:9ae09249f842 | 641 | |
Kovalev_D | 124:9ae09249f842 | 642 | case 15: |
Kovalev_D | 211:ac8251b067d2 | 643 | BuffTemp[5] = (IntOutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 644 | break; |
Kovalev_D | 124:9ae09249f842 | 645 | |
Kovalev_D | 124:9ae09249f842 | 646 | |
Kovalev_D | 124:9ae09249f842 | 647 | |
Kovalev_D | 124:9ae09249f842 | 648 | //ток 2 |
Kovalev_D | 124:9ae09249f842 | 649 | case 16: |
Kovalev_D | 210:b02fa166315d | 650 | // Temp = Gyro.In2; |
Kovalev_D | 227:2774b56bfab0 | 651 | IntOutDeltaPS =0;// ((Gyro.In2>>1)*0.800875)-0x3e0b; |
Kovalev_D | 211:ac8251b067d2 | 652 | BuffTemp[5] = (IntOutDeltaPS >> 8) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 653 | break; |
Kovalev_D | 124:9ae09249f842 | 654 | |
Kovalev_D | 124:9ae09249f842 | 655 | case 17: |
Kovalev_D | 211:ac8251b067d2 | 656 | BuffTemp[5] = (IntOutDeltaPS >> 0) & 0xff;//in2//3 |
Kovalev_D | 124:9ae09249f842 | 657 | break; |
Kovalev_D | 124:9ae09249f842 | 658 | |
Kovalev_D | 124:9ae09249f842 | 659 | |
Kovalev_D | 124:9ae09249f842 | 660 | |
Kovalev_D | 124:9ae09249f842 | 661 | //разностный температурный канал Delta Temp |
Kovalev_D | 124:9ae09249f842 | 662 | case 18: |
Kovalev_D | 211:ac8251b067d2 | 663 | OutDeltaPS = 0; |
Kovalev_D | 211:ac8251b067d2 | 664 | OutDeltaPS = Gyro.DeltaT; |
Kovalev_D | 211:ac8251b067d2 | 665 | BuffTemp[5] = (OutDeltaPS >> 8) & 0xff;//дельта |
Kovalev_D | 124:9ae09249f842 | 666 | break; |
Kovalev_D | 124:9ae09249f842 | 667 | |
Kovalev_D | 124:9ae09249f842 | 668 | case 19: |
Kovalev_D | 211:ac8251b067d2 | 669 | BuffTemp[5] = (OutDeltaPS >> 0) & 0xff; |
Kovalev_D | 124:9ae09249f842 | 670 | break; |
Kovalev_D | 124:9ae09249f842 | 671 | |
Kovalev_D | 124:9ae09249f842 | 672 | |
Kovalev_D | 124:9ae09249f842 | 673 | |
Kovalev_D | 124:9ae09249f842 | 674 | //температурный канал 5 |
Kovalev_D | 124:9ae09249f842 | 675 | case 20: |
Kovalev_D | 211:ac8251b067d2 | 676 | OutDeltaPS = 0; |
Kovalev_D | 227:2774b56bfab0 | 677 | OutDeltaPS = Gyro.Termo; |
Kovalev_D | 211:ac8251b067d2 | 678 | BuffTemp[5] =(OutDeltaPS >> 8) & 0xff;//температура |
Kovalev_D | 124:9ae09249f842 | 679 | break; |
Kovalev_D | 124:9ae09249f842 | 680 | |
Kovalev_D | 124:9ae09249f842 | 681 | case 21: |
Kovalev_D | 211:ac8251b067d2 | 682 | BuffTemp[5] =(OutDeltaPS >> 0) & 0xff;//ADC6 sesnsor 5 |
Kovalev_D | 211:ac8251b067d2 | 683 | /* sprintf((Time),"%d %d \r\n", Spi.ADC1, Spi.ADC5 ); |
Kovalev_D | 211:ac8251b067d2 | 684 | WriteCon(Time);*/ |
Kovalev_D | 124:9ae09249f842 | 685 | break; |
Kovalev_D | 124:9ae09249f842 | 686 | } |
Kovalev_D | 162:44e4ded32c6a | 687 | Check(BuffTemp, CRC_N); |
Kovalev_D | 162:44e4ded32c6a | 688 | WriteConN (BuffTemp,CRC_N); |
Kovalev_D | 128:1e4675a36c93 | 689 | |
Kovalev_D | 165:b2bd0c810a4f | 690 | |
Kovalev_D | 165:b2bd0c810a4f | 691 | if(CountParam>20)CountParam=0;//зацикливания буфера от 0 до 21 |
Kovalev_D | 165:b2bd0c810a4f | 692 | else CountParam++; |
Kovalev_D | 124:9ae09249f842 | 693 | |
Kovalev_D | 124:9ae09249f842 | 694 | } |
Kovalev_D | 124:9ae09249f842 | 695 | |
Kovalev_D | 222:7de7b3bf3a1d | 696 | |
Kovalev_D | 222:7de7b3bf3a1d | 697 | void M_Rate5K(void) |
Kovalev_D | 222:7de7b3bf3a1d | 698 | { |
Kovalev_D | 222:7de7b3bf3a1d | 699 | |
Kovalev_D | 225:f8fee6c586cc | 700 | unsigned int Temp; |
Kovalev_D | 222:7de7b3bf3a1d | 701 | //Temp=Gyro.CuruAngle; //приводим к форме вывода |
Kovalev_D | 222:7de7b3bf3a1d | 702 | BuffTemp[ 3] =(Gyro.CuruAngle >> 8) & 0xff;//старший байт разности счетчиков 7 --младший байт разности счетчиков |
Kovalev_D | 222:7de7b3bf3a1d | 703 | BuffTemp[ 2] =(Gyro.CuruAngle >> 0) & 0xff;//младший байт разности счетчиков 8 --старший байт разности счетчиков |
Kovalev_D | 222:7de7b3bf3a1d | 704 | Gyro.CuruAngle=0; |
Kovalev_D | 222:7de7b3bf3a1d | 705 | |
Kovalev_D | 222:7de7b3bf3a1d | 706 | |
Kovalev_D | 225:f8fee6c586cc | 707 | Temp = ((Spi.DAC_B-0x7fff)&0xffff); |
Kovalev_D | 222:7de7b3bf3a1d | 708 | BuffTemp[5] = (Spi.DAC_B >> 8) & 0xff; //23 Выход регулятора рабочего периметра |
Kovalev_D | 222:7de7b3bf3a1d | 709 | BuffTemp[4] = (Spi.DAC_B >> 0) & 0xff; |
Kovalev_D | 222:7de7b3bf3a1d | 710 | |
Kovalev_D | 225:f8fee6c586cc | 711 | |
Kovalev_D | 225:f8fee6c586cc | 712 | Temp = 0xffff - Spi.DAC_A; |
Kovalev_D | 222:7de7b3bf3a1d | 713 | BuffTemp[7] =(Temp >> 8) & 0xff;//выход регулятора гвч; 11 --выход регулятора ГВЧ |
Kovalev_D | 222:7de7b3bf3a1d | 714 | BuffTemp[6] =(Temp >> 0) & 0xff; |
Kovalev_D | 222:7de7b3bf3a1d | 715 | |
Kovalev_D | 222:7de7b3bf3a1d | 716 | /* sprintf((Time),"%d %d %d\r\n",Gyro.CuruAngle,(Spi.DAC_B-0x7fff),Temp); |
Kovalev_D | 222:7de7b3bf3a1d | 717 | WriteCon(Time);*/ |
Kovalev_D | 222:7de7b3bf3a1d | 718 | |
Kovalev_D | 222:7de7b3bf3a1d | 719 | //Check(BuffTemp, 7); |
Kovalev_D | 222:7de7b3bf3a1d | 720 | WriteConN (BuffTemp,8); |
Kovalev_D | 222:7de7b3bf3a1d | 721 | Gyro.EvenRate5K++; |
Kovalev_D | 222:7de7b3bf3a1d | 722 | } |
Kovalev_D | 222:7de7b3bf3a1d | 723 | |
Kovalev_D | 222:7de7b3bf3a1d | 724 | |
igor_v | 0:8ad47e2b6f00 | 725 | void CMD_Rate(void) |
Kovalev_D | 190:289514f730ee | 726 | { |
Kovalev_D | 231:079835d508ef | 727 | |
Kovalev_D | 231:079835d508ef | 728 | |
Kovalev_D | 231:079835d508ef | 729 | |
Kovalev_D | 231:079835d508ef | 730 | |
Kovalev_D | 124:9ae09249f842 | 731 | Gyro.Rate1_Event=0; |
Kovalev_D | 108:030cdde08314 | 732 | unsigned int Temp; |
Kovalev_D | 208:19150d2b528f | 733 | int Temp1; |
Kovalev_D | 209:224e7331a061 | 734 | float Temp2; |
Kovalev_D | 122:fbacb932a30b | 735 | |
Kovalev_D | 208:19150d2b528f | 736 | BuffTemp[ 0] = Gyro.SOC_Out; //1 --старт данных |
Kovalev_D | 208:19150d2b528f | 737 | BuffTemp[ 1] = Gyro.My_Addres; //2 --адрес отвечающего устройствва |
igor_v | 21:bc8c1cec3da6 | 738 | |
Kovalev_D | 209:224e7331a061 | 739 | BuffTemp[ 2] =( Gyro.CaunPlusReper >> 8) & 0xff;//старший байт счетчика +. 3 --сарший байт счентчика + |
Kovalev_D | 209:224e7331a061 | 740 | BuffTemp[ 3] =( Gyro.CaunPlusReper >> 0) & 0xff;//младший байт счетчика +. 4 --младший байт счетчика + |
Kovalev_D | 211:ac8251b067d2 | 741 | |
Kovalev_D | 231:079835d508ef | 742 | BuffTemp[ 4] =( Gyro.CaunMinReper >> 8) & 0xff;//старший байт счетчика -. 5 --сарший байт счентчика - |
Kovalev_D | 231:079835d508ef | 743 | BuffTemp[ 5] =( Gyro.CaunMinReper >> 0) & 0xff;//младший байт счетчика -. 6 --младший байт счетчика - |
Kovalev_D | 211:ac8251b067d2 | 744 | |
Kovalev_D | 209:224e7331a061 | 745 | Gyro.CuruAngle = Gyro.CuruAngle + OldCuruAngle; //(72 град/с) |
Kovalev_D | 214:4c70e452c491 | 746 | OldCuruAngle=Gyro.CuruAngle & 0x3f; //сохраняем 5 бит для след измирений |
Kovalev_D | 214:4c70e452c491 | 747 | Temp=Gyro.CuruAngle>>6; //приводим к форме вывода |
Kovalev_D | 211:ac8251b067d2 | 748 | |
Kovalev_D | 231:079835d508ef | 749 | Gyro.AngelCompens=0; |
Kovalev_D | 208:19150d2b528f | 750 | Gyro.CuruAngle = 0; |
Kovalev_D | 208:19150d2b528f | 751 | BuffTemp[ 6] =(Temp >> 8) & 0xff;//старший байт разности счетчиков 7 --младший байт разности счетчиков |
Kovalev_D | 208:19150d2b528f | 752 | BuffTemp[ 7] =(Temp >> 0) & 0xff;//младший байт разности счетчиков 8 --старший байт разности счетчиков |
Kovalev_D | 108:030cdde08314 | 753 | |
Kovalev_D | 231:079835d508ef | 754 | |
Kovalev_D | 208:19150d2b528f | 755 | BuffTemp[38] =(Temp >> 24) & 0xff;; //39 приращение угла |
Kovalev_D | 208:19150d2b528f | 756 | BuffTemp[39] =(Temp >> 16) & 0xff;; //40 формат 22.10 |
Kovalev_D | 208:19150d2b528f | 757 | BuffTemp[40] =(Temp >> 8) & 0xff;; //41 1бит знак |
Kovalev_D | 208:19150d2b528f | 758 | BuffTemp[41] =(Temp >> 0) & 0xff;; //42 |
Kovalev_D | 209:224e7331a061 | 759 | |
Kovalev_D | 208:19150d2b528f | 760 | Temp = Gyro.F_ras; |
Kovalev_D | 209:224e7331a061 | 761 | //Gyro.F_ras=0; |
Kovalev_D | 208:19150d2b528f | 762 | BuffTemp[ 8] = (Temp >> 8) & 0xff;//расщипление частота 9 --частота расщипления |
Kovalev_D | 209:224e7331a061 | 763 | BuffTemp[ 9] = (Temp >> 0) & 0xff;// 10 --частота расщипления |
Kovalev_D | 208:19150d2b528f | 764 | |
Kovalev_D | 211:ac8251b067d2 | 765 | //(unsigned int)((Gyro.DacIn+30000)*0.6667); |
Kovalev_D | 226:4a4d5bd5fcd7 | 766 | Temp1 = 0xffff - Spi.DAC_A; |
Kovalev_D | 226:4a4d5bd5fcd7 | 767 | BuffTemp[10] = (Temp1 >> 8) & 0xff;//выход регулятора гвч; 11 --выход регулятора ГВЧ |
Kovalev_D | 209:224e7331a061 | 768 | BuffTemp[11] = (Temp1 >> 0) & 0xff; //12 --выход регулятора ГВЧ |
Kovalev_D | 209:224e7331a061 | 769 | |
Kovalev_D | 231:079835d508ef | 770 | |
Kovalev_D | 226:4a4d5bd5fcd7 | 771 | Temp =(int)(tempDeltaRegul); //для призмы |
Kovalev_D | 225:f8fee6c586cc | 772 | tempDeltaRegul=0; |
Kovalev_D | 208:19150d2b528f | 773 | BuffTemp[12]=(Temp >> 8) & 0xff;//// HFO 13 --сигнал ошибки регулятора ГВЧ |
Kovalev_D | 208:19150d2b528f | 774 | BuffTemp[13]=(Temp >> 0) & 0xff;//// 14 --сигнал ошибки регулятора ГВЧ |
Kovalev_D | 209:224e7331a061 | 775 | |
Kovalev_D | 209:224e7331a061 | 776 | //Temp = (unsigned int)((7675000*16/(Gyro.Frq>>12))); |
Kovalev_D | 227:2774b56bfab0 | 777 | Temp = Gyro.Frq>>12;//(unsigned int)(7680000/(Gyro.Frq>>16)); |
Kovalev_D | 208:19150d2b528f | 778 | BuffTemp[14] = (Temp >> 8) & 0xff; //15 период вибропривода.(частота) T_Vibro |
Kovalev_D | 208:19150d2b528f | 779 | BuffTemp[15] = (Temp >> 0) & 0xff; //16 период вибропривода. |
Kovalev_D | 208:19150d2b528f | 780 | |
Kovalev_D | 209:224e7331a061 | 781 | Temp = Gyro.FrqPhaseEror<<2;//Spi.DAC_A-0x7fff; |
Kovalev_D | 209:224e7331a061 | 782 | BuffTemp[16] = (Temp >> 8) & 0xff; //17 старший байт ФД регулятора периода вибропривода |
Kovalev_D | 209:224e7331a061 | 783 | BuffTemp[17] = (Temp >> 0) & 0xff; |
Kovalev_D | 209:224e7331a061 | 784 | /*sprintf((Time),"%d %d\r\n",Gyro.FrqPhaseEror, Gyro.FrqPhaseEror<<2); |
Kovalev_D | 209:224e7331a061 | 785 | WriteCon(Time); */ //18 |
igor_v | 21:bc8c1cec3da6 | 786 | |
Kovalev_D | 227:2774b56bfab0 | 787 | Temp = Gyro.AmpPer/*>>1*/;//(unsigned int)(((7675000*16/200) * Gyro.AmpPer /(Gyro.Frq>>12))); |
Kovalev_D | 208:19150d2b528f | 788 | BuffTemp[18] = (Temp >> 8) & 0xff; //19 длительность импулься вибропривода(амплитуда) |
Kovalev_D | 208:19150d2b528f | 789 | BuffTemp[19] = (Temp >> 0) & 0xff; //20 |
Kovalev_D | 210:b02fa166315d | 790 | |
Kovalev_D | 208:19150d2b528f | 791 | |
Kovalev_D | 208:19150d2b528f | 792 | Temp = 0x0;//Gyro.L_vibro<<2; |
Kovalev_D | 208:19150d2b528f | 793 | BuffTemp[20] = (Temp >> 8) & 0xff;//регулятор датчика угла поворота //21 старший байт регулятора датчика угла поворота |
Kovalev_D | 208:19150d2b528f | 794 | BuffTemp[21] = (Temp >> 0) & 0xff; //22 |
Kovalev_D | 208:19150d2b528f | 795 | |
Kovalev_D | 225:f8fee6c586cc | 796 | Temp1 =((Spi.DAC_B-0x7fff)&0xffff);///(3300+(0x7fff+(Spi.DAC_B*1.083))); |
Kovalev_D | 209:224e7331a061 | 797 | BuffTemp[22] = (Temp1 >> 8) & 0xff; //23 Выход регулятора рабочего периметра |
Kovalev_D | 209:224e7331a061 | 798 | BuffTemp[23] = (Temp1 >> 0) & 0xff; |
Kovalev_D | 209:224e7331a061 | 799 | //24 |
Kovalev_D | 211:ac8251b067d2 | 800 | |
Kovalev_D | 220:04c54405b82d | 801 | Temp = PLC_EROR; |
Kovalev_D | 220:04c54405b82d | 802 | PLC_EROR=0; |
Kovalev_D | 220:04c54405b82d | 803 | |
Kovalev_D | 208:19150d2b528f | 804 | BuffTemp[24] = (Temp >> 8) & 0xff;// //25 ФД СРП |
Kovalev_D | 208:19150d2b528f | 805 | BuffTemp[25] = (Temp >> 0) & 0xff;// //26 ФД СРП |
Kovalev_D | 209:224e7331a061 | 806 | |
Kovalev_D | 209:224e7331a061 | 807 | Temp =0;/* Gyro.AD_Slow >> 16*/; |
Kovalev_D | 208:19150d2b528f | 808 | BuffTemp[26] = (Temp >> 8) & 0xff; //27 ADC 0 |
Kovalev_D | 208:19150d2b528f | 809 | BuffTemp[27] = (Temp >> 0) & 0xff; //28 |
Kovalev_D | 113:8be429494918 | 810 | |
Kovalev_D | 209:224e7331a061 | 811 | Temp =0; /*Gyro.AD_Slow >> 16*/; |
Kovalev_D | 208:19150d2b528f | 812 | BuffTemp[28] = (Temp >> 8) & 0xff; //29 ADC 1 |
Kovalev_D | 208:19150d2b528f | 813 | BuffTemp[29] = (Temp >> 0) & 0xff; //30 |
Kovalev_D | 113:8be429494918 | 814 | |
Kovalev_D | 220:04c54405b82d | 815 | Temp1 = 0;//((Gyro.In1>>1)*0.800875)-0x3e0b; |
Kovalev_D | 209:224e7331a061 | 816 | BuffTemp[30] = (Temp1 >> 8) & 0xff;//in1//2 //31 ADC 2 |
Kovalev_D | 209:224e7331a061 | 817 | BuffTemp[31] = (Temp1 >> 0) & 0xff; //32 |
Kovalev_D | 208:19150d2b528f | 818 | |
Kovalev_D | 220:04c54405b82d | 819 | Temp1 =0;//((Gyro.In2>>1)*0.800875)-0x3e0b;// - 0x4FFF; |
Kovalev_D | 209:224e7331a061 | 820 | BuffTemp[32] = (Temp1 >> 8) & 0xff; //33 ADC 3 |
Kovalev_D | 209:224e7331a061 | 821 | BuffTemp[33] = (Temp1 >> 0) & 0xff;//in2//3 //34 |
Kovalev_D | 209:224e7331a061 | 822 | |
Kovalev_D | 208:19150d2b528f | 823 | Temp = (Gyro.DeltaT); |
Kovalev_D | 208:19150d2b528f | 824 | BuffTemp[34] = (Temp >> 8) & 0xff;//дельта //35 ADC 4 |
Kovalev_D | 208:19150d2b528f | 825 | BuffTemp[35] = (Temp >> 0) & 0xff; //36 |
Kovalev_D | 208:19150d2b528f | 826 | // Temp = 000; |
Kovalev_D | 208:19150d2b528f | 827 | |
Kovalev_D | 208:19150d2b528f | 828 | Temp = Gyro.Termo; |
Kovalev_D | 208:19150d2b528f | 829 | BuffTemp[36] =(Temp >> 8) & 0xff;//температура //37 ADC 5 |
Kovalev_D | 208:19150d2b528f | 830 | BuffTemp[37] =(Temp >> 0) & 0xff;//ADC6 sesnsor 5 //38 |
igor_v | 21:bc8c1cec3da6 | 831 | |
igor_v | 21:bc8c1cec3da6 | 832 | Check(BuffTemp, 44); |
igor_v | 21:bc8c1cec3da6 | 833 | WriteConN (BuffTemp,44); |
Kovalev_D | 209:224e7331a061 | 834 | for(int i=0; i<45;i++) {BuffTemp[i]=0;} |
Kovalev_D | 209:224e7331a061 | 835 | } |
Kovalev_D | 209:224e7331a061 | 836 | |
Kovalev_D | 210:b02fa166315d | 837 | void CMD_Rate2(void) |
Kovalev_D | 210:b02fa166315d | 838 | { |
Kovalev_D | 210:b02fa166315d | 839 | unsigned int Temp; |
Kovalev_D | 225:f8fee6c586cc | 840 | //float y = 52646.45 |
Kovalev_D | 210:b02fa166315d | 841 | Gyro.Reper_Event=0; |
Kovalev_D | 214:4c70e452c491 | 842 | for(int q=0; q<64; q++) |
Kovalev_D | 214:4c70e452c491 | 843 | { |
Kovalev_D | 214:4c70e452c491 | 844 | BuffTemp[q]=0; |
Kovalev_D | 214:4c70e452c491 | 845 | } |
Kovalev_D | 210:b02fa166315d | 846 | BuffTemp[ 0] = Gyro.SOC_Out; |
Kovalev_D | 210:b02fa166315d | 847 | BuffTemp[ 1] = Gyro.My_Addres; |
Kovalev_D | 216:189b0ea1dc38 | 848 | |
Kovalev_D | 211:ac8251b067d2 | 849 | Temp=Gyro.CaunPlusReper; |
Kovalev_D | 211:ac8251b067d2 | 850 | |
Kovalev_D | 210:b02fa166315d | 851 | BuffTemp[ 2] =(Temp >> 8) & 0xff;//старший байт счетчика +. |
Kovalev_D | 210:b02fa166315d | 852 | BuffTemp[ 3] =(Temp >> 0) & 0xff;//младший байт счетчика +. |
Kovalev_D | 211:ac8251b067d2 | 853 | //сохраняем 5 бит для след измирений |
Kovalev_D | 210:b02fa166315d | 854 | |
Kovalev_D | 211:ac8251b067d2 | 855 | Temp= Gyro.CaunMinReper; |
Kovalev_D | 211:ac8251b067d2 | 856 | |
Kovalev_D | 210:b02fa166315d | 857 | BuffTemp[ 4] =(Temp >> 8) & 0xff;//старший байт счетчика -. |
Kovalev_D | 210:b02fa166315d | 858 | BuffTemp[ 5] =(Temp >> 0) & 0xff;//младший байт счетчика -. |
Kovalev_D | 216:189b0ea1dc38 | 859 | |
Kovalev_D | 211:ac8251b067d2 | 860 | |
Kovalev_D | 210:b02fa166315d | 861 | Check(BuffTemp, 8); |
Kovalev_D | 210:b02fa166315d | 862 | WriteConN (BuffTemp,8); |
Kovalev_D | 210:b02fa166315d | 863 | } |
Kovalev_D | 210:b02fa166315d | 864 | |
Kovalev_D | 210:b02fa166315d | 865 | void CMD_Rate3(void) |
Kovalev_D | 210:b02fa166315d | 866 | { |
Kovalev_D | 210:b02fa166315d | 867 | Gyro.Rate3_Event=0; |
Kovalev_D | 210:b02fa166315d | 868 | BuffTemp[ 0] = Gyro.SOC_Out; |
Kovalev_D | 210:b02fa166315d | 869 | BuffTemp[ 1] = Gyro.My_Addres; |
Kovalev_D | 210:b02fa166315d | 870 | BuffTemp[ 2] = 0xcc;//старший байт счетчика +. |
Kovalev_D | 210:b02fa166315d | 871 | BuffTemp[ 3] = 0xcc;//младший байт счетчика +. |
Kovalev_D | 210:b02fa166315d | 872 | |
Kovalev_D | 210:b02fa166315d | 873 | BuffTemp[ 4] =0xBB;//старший байт счетчика -. |
Kovalev_D | 210:b02fa166315d | 874 | BuffTemp[ 5] =0xBB;//младший байт счетчика -. |
Kovalev_D | 210:b02fa166315d | 875 | |
Kovalev_D | 210:b02fa166315d | 876 | Check(BuffTemp, 8); |
Kovalev_D | 210:b02fa166315d | 877 | WriteConN (BuffTemp,8); |
Kovalev_D | 210:b02fa166315d | 878 | } |
Kovalev_D | 210:b02fa166315d | 879 | |
Kovalev_D | 209:224e7331a061 | 880 | void CMD_M_Stymul() |
Kovalev_D | 209:224e7331a061 | 881 | { |
Kovalev_D | 209:224e7331a061 | 882 | int temp,Consol=0,HFO,b4; |
Kovalev_D | 209:224e7331a061 | 883 | float Temp1; |
Kovalev_D | 209:224e7331a061 | 884 | temp=BuffTemp[3]; |
Kovalev_D | 209:224e7331a061 | 885 | |
Kovalev_D | 209:224e7331a061 | 886 | b4 = temp; |
Kovalev_D | 209:224e7331a061 | 887 | Consol = temp>>7; |
Kovalev_D | 209:224e7331a061 | 888 | HFO = temp&0x3;// // (номер (код) ЦАПа 0...3, HFO - 3dac, PLC - 0DAC |
Kovalev_D | 209:224e7331a061 | 889 | |
Kovalev_D | 209:224e7331a061 | 890 | temp = (((BuffTemp[4]<<8) | BuffTemp[5])&0xFFFF); |
Kovalev_D | 209:224e7331a061 | 891 | if(HFO) |
Kovalev_D | 209:224e7331a061 | 892 | { |
Kovalev_D | 209:224e7331a061 | 893 | Gyro.DacIn=temp; |
Kovalev_D | 225:f8fee6c586cc | 894 | if(Gyro.LG_Type==1) Spi.DAC_A = 0xffff-Gyro.DacIn; //((unsigned int)((Gyro.DacIn+0x7011)*0.6667)); |
Kovalev_D | 222:7de7b3bf3a1d | 895 | else Spi.DAC_A = (unsigned int)(0xffff-Gyro.DacIn); //Spi.DAC_A = ((unsigned int)((Gyro.DacIn+23200)*0.64)); |
Kovalev_D | 209:224e7331a061 | 896 | } |
Kovalev_D | 225:f8fee6c586cc | 897 | |
Kovalev_D | 225:f8fee6c586cc | 898 | else Spi.DAC_B = (unsigned int)((temp-0x7fff)&0xffff); |
Kovalev_D | 227:2774b56bfab0 | 899 | /*sprintf((Time),"%d %d \r\n", Spi.DAC_B, temp); |
Kovalev_D | 227:2774b56bfab0 | 900 | WriteCon(Time); */ |
Kovalev_D | 225:f8fee6c586cc | 901 | for(int q=0; q<64; q++) |
Kovalev_D | 218:b4067cac75c0 | 902 | { |
Kovalev_D | 218:b4067cac75c0 | 903 | BuffTemp[q]=0; |
Kovalev_D | 218:b4067cac75c0 | 904 | } |
Kovalev_D | 209:224e7331a061 | 905 | BuffTemp[0] = Gyro.SOC_Out; //DD |
Kovalev_D | 209:224e7331a061 | 906 | BuffTemp[1] = Gyro.My_Addres; //00 |
Kovalev_D | 209:224e7331a061 | 907 | BuffTemp[2] = Gyro.CMD_In; //D9 |
Kovalev_D | 209:224e7331a061 | 908 | BuffTemp[3] =0; |
Kovalev_D | 209:224e7331a061 | 909 | Check(BuffTemp, CRC_N); |
Kovalev_D | 209:224e7331a061 | 910 | WriteConN (BuffTemp,CRC_N); |
igor_v | 0:8ad47e2b6f00 | 911 | } |
Kovalev_D | 209:224e7331a061 | 912 | |
Kovalev_D | 179:2b4e6bc277df | 913 | void CMD_M_vib() |
Kovalev_D | 179:2b4e6bc277df | 914 | { |
Kovalev_D | 209:224e7331a061 | 915 | unsigned int temp1,temp2,anser; |
Kovalev_D | 209:224e7331a061 | 916 | temp1 = (((BuffTemp[4]<<8) | BuffTemp[5])&0xFFFF); |
Kovalev_D | 227:2774b56bfab0 | 917 | Gyro.Frq = (temp1<<12); |
Kovalev_D | 227:2774b56bfab0 | 918 | // Gyro.Frq = (122780000/temp1)<<12; |
Kovalev_D | 227:2774b56bfab0 | 919 | |
Kovalev_D | 227:2774b56bfab0 | 920 | F_vib= (unsigned int)(825600000 / temp1); |
Kovalev_D | 227:2774b56bfab0 | 921 | temp2 = (((BuffTemp[6]<<8) | BuffTemp[7])&0xFFFF); |
Kovalev_D | 227:2774b56bfab0 | 922 | |
Kovalev_D | 227:2774b56bfab0 | 923 | sprintf((Time),"%d %d \r\n",temp1, temp2); |
Kovalev_D | 227:2774b56bfab0 | 924 | WriteCon(Time); |
Kovalev_D | 227:2774b56bfab0 | 925 | Gyro.AmpPer = temp2; |
Kovalev_D | 227:2774b56bfab0 | 926 | Gyro.Amp = (Gyro.AmpPer<<17)/100; |
Kovalev_D | 227:2774b56bfab0 | 927 | /* Gyro.AmpPer = ((((((Gyro.Frq>>12)*200)/16)*temp2)/7680000)/2); |
Kovalev_D | 227:2774b56bfab0 | 928 | Gyro.Amp = (Gyro.AmpPer)<<17;*/ |
Kovalev_D | 225:f8fee6c586cc | 929 | |
Kovalev_D | 209:224e7331a061 | 930 | BuffTemp[0] = Gyro.SOC_Out; |
Kovalev_D | 209:224e7331a061 | 931 | BuffTemp[1] = Gyro.My_Addres; |
Kovalev_D | 209:224e7331a061 | 932 | BuffTemp[2] = Gyro.CMD_In; |
Kovalev_D | 209:224e7331a061 | 933 | BuffTemp[3] = 0x0; |
Kovalev_D | 209:224e7331a061 | 934 | BuffTemp[4] = 0x0; |
Kovalev_D | 209:224e7331a061 | 935 | Check(BuffTemp, CRC_N); |
Kovalev_D | 209:224e7331a061 | 936 | WriteConN (BuffTemp,CRC_N); |
Kovalev_D | 179:2b4e6bc277df | 937 | } |
igor_v | 21:bc8c1cec3da6 | 938 | void CMD_M_Control_D8()///установка\сброс регистров управления |
igor_v | 21:bc8c1cec3da6 | 939 | { |
Kovalev_D | 209:224e7331a061 | 940 | unsigned int bit=0,Pa=0; |
Kovalev_D | 209:224e7331a061 | 941 | unsigned int SR=0,V=0,Bit_num=0,A=0; |
Kovalev_D | 209:224e7331a061 | 942 | Pa = BuffTemp[3]; |
Kovalev_D | 209:224e7331a061 | 943 | SR = Pa >> 7; |
Kovalev_D | 209:224e7331a061 | 944 | V = (Pa>>5)&0x3; |
Kovalev_D | 209:224e7331a061 | 945 | A = (Pa>>4)&0x1; |
Kovalev_D | 209:224e7331a061 | 946 | Bit_num = Pa & 0xf; |
Kovalev_D | 104:ab1cb4ff56b2 | 947 | |
Kovalev_D | 209:224e7331a061 | 948 | switch (SR) |
Kovalev_D | 209:224e7331a061 | 949 | { |
Kovalev_D | 209:224e7331a061 | 950 | case 0: |
Kovalev_D | 209:224e7331a061 | 951 | switch (A) |
Kovalev_D | 209:224e7331a061 | 952 | { |
Kovalev_D | 209:224e7331a061 | 953 | case 0: |
Kovalev_D | 209:224e7331a061 | 954 | switch (Bit_num) |
Kovalev_D | 209:224e7331a061 | 955 | { |
Kovalev_D | 209:224e7331a061 | 956 | case 0x06: FrqOFF break; |
Kovalev_D | 209:224e7331a061 | 957 | case 0x05: AVibOFF break; |
Kovalev_D | 209:224e7331a061 | 958 | case 0x01: HFOOFF break; |
Kovalev_D | 209:224e7331a061 | 959 | case 0x03: PlcOFF break; |
Kovalev_D | 222:7de7b3bf3a1d | 960 | case 0x02: Gyro.RgConA &= ~(1<<2); break; |
Kovalev_D | 209:224e7331a061 | 961 | } |
Kovalev_D | 209:224e7331a061 | 962 | break; |
Kovalev_D | 209:224e7331a061 | 963 | case 1: |
Kovalev_D | 209:224e7331a061 | 964 | switch (Bit_num) |
Kovalev_D | 209:224e7331a061 | 965 | { |
Kovalev_D | 209:224e7331a061 | 966 | case 0x00: Gyro.RgConB &= ~(1<<0); break; |
Kovalev_D | 209:224e7331a061 | 967 | case 0x01: Gyro.RgConB &= ~(1<<1); break; |
Kovalev_D | 209:224e7331a061 | 968 | case 0x02: Gyro.RgConB &= ~(1<<2); break; |
Kovalev_D | 209:224e7331a061 | 969 | } |
Kovalev_D | 209:224e7331a061 | 970 | break; |
Kovalev_D | 209:224e7331a061 | 971 | } |
Kovalev_D | 209:224e7331a061 | 972 | |
Kovalev_D | 209:224e7331a061 | 973 | |
Kovalev_D | 209:224e7331a061 | 974 | break; |
Kovalev_D | 209:224e7331a061 | 975 | case 1: |
Kovalev_D | 209:224e7331a061 | 976 | switch (A) |
Kovalev_D | 209:224e7331a061 | 977 | { |
Kovalev_D | 209:224e7331a061 | 978 | case 0: |
Kovalev_D | 209:224e7331a061 | 979 | switch (Bit_num) |
Kovalev_D | 209:224e7331a061 | 980 | { |
Kovalev_D | 222:7de7b3bf3a1d | 981 | case 0x06: FrqON break; |
Kovalev_D | 222:7de7b3bf3a1d | 982 | case 0x05: AVibON break; |
Kovalev_D | 222:7de7b3bf3a1d | 983 | case 0x01: HFOON break; |
Kovalev_D | 222:7de7b3bf3a1d | 984 | case 0x03: PlcON break; |
Kovalev_D | 222:7de7b3bf3a1d | 985 | case 0x02: Gyro.RgConA |= (1<<2); break; |
Kovalev_D | 209:224e7331a061 | 986 | } |
Kovalev_D | 209:224e7331a061 | 987 | break; |
Kovalev_D | 209:224e7331a061 | 988 | case 1: |
Kovalev_D | 209:224e7331a061 | 989 | switch (Bit_num) |
Kovalev_D | 209:224e7331a061 | 990 | { |
Kovalev_D | 209:224e7331a061 | 991 | case 0x00: Gyro.RgConB |= (1<<0); break; |
Kovalev_D | 209:224e7331a061 | 992 | case 0x01: Gyro.RgConB |= (1<<1); break; |
Kovalev_D | 209:224e7331a061 | 993 | case 0x02: Gyro.RgConB |= (1<<2); break; |
Kovalev_D | 209:224e7331a061 | 994 | } |
Kovalev_D | 209:224e7331a061 | 995 | break; |
Kovalev_D | 209:224e7331a061 | 996 | } |
Kovalev_D | 209:224e7331a061 | 997 | break; |
Kovalev_D | 209:224e7331a061 | 998 | } |
igor_v | 30:17c84ed091b3 | 999 | BuffTemp[0] = Gyro.SOC_Out; //DD |
igor_v | 30:17c84ed091b3 | 1000 | BuffTemp[1] = Gyro.My_Addres; //00 |
igor_v | 30:17c84ed091b3 | 1001 | BuffTemp[2] = Gyro.CMD_In; //D8 |
Kovalev_D | 209:224e7331a061 | 1002 | switch (A) |
Kovalev_D | 209:224e7331a061 | 1003 | { |
Kovalev_D | 209:224e7331a061 | 1004 | case 0: |
Kovalev_D | 209:224e7331a061 | 1005 | BuffTemp[ 4] =(Gyro.RgConA >> 8) & 0xff; |
Kovalev_D | 209:224e7331a061 | 1006 | BuffTemp[ 5] =(Gyro.RgConA >> 0) & 0xff; |
Kovalev_D | 209:224e7331a061 | 1007 | break; |
Kovalev_D | 209:224e7331a061 | 1008 | |
Kovalev_D | 209:224e7331a061 | 1009 | case 1: |
Kovalev_D | 209:224e7331a061 | 1010 | BuffTemp[ 4] =(Gyro.RgConB >> 8) & 0xff; |
Kovalev_D | 209:224e7331a061 | 1011 | BuffTemp[ 5] =(Gyro.RgConB >> 0) & 0xff; |
Kovalev_D | 209:224e7331a061 | 1012 | break; |
Kovalev_D | 209:224e7331a061 | 1013 | } |
Kovalev_D | 209:224e7331a061 | 1014 | Check(BuffTemp, CRC_N); |
Kovalev_D | 209:224e7331a061 | 1015 | WriteConN (BuffTemp,CRC_N); |
Kovalev_D | 209:224e7331a061 | 1016 | } |
Kovalev_D | 208:19150d2b528f | 1017 | |
igor_v | 21:bc8c1cec3da6 | 1018 | void CMD_M_Control_D9()///чтение регистров управления |
igor_v | 21:bc8c1cec3da6 | 1019 | { |
Kovalev_D | 209:224e7331a061 | 1020 | int bit,NReg,param=0; |
igor_v | 30:17c84ed091b3 | 1021 | BuffTemp[0] = Gyro.SOC_Out; //DD |
igor_v | 30:17c84ed091b3 | 1022 | BuffTemp[1] = Gyro.My_Addres; //00 |
igor_v | 30:17c84ed091b3 | 1023 | BuffTemp[2] = Gyro.CMD_In; //D9 |
Kovalev_D | 209:224e7331a061 | 1024 | param = BuffTemp[3]; |
Kovalev_D | 209:224e7331a061 | 1025 | if (param) |
Kovalev_D | 209:224e7331a061 | 1026 | { |
igor_v | 21:bc8c1cec3da6 | 1027 | BuffTemp[3]=1<<4; |
igor_v | 30:17c84ed091b3 | 1028 | BuffTemp[4] = (Gyro.RgConB>>8 ) & 0xff; |
igor_v | 30:17c84ed091b3 | 1029 | BuffTemp[5] = Gyro.RgConB & 0xff; |
igor_v | 21:bc8c1cec3da6 | 1030 | } |
Kovalev_D | 209:224e7331a061 | 1031 | else |
Kovalev_D | 209:224e7331a061 | 1032 | { |
Kovalev_D | 209:224e7331a061 | 1033 | BuffTemp[3]=0<<4; |
Kovalev_D | 209:224e7331a061 | 1034 | BuffTemp[4] = (Gyro.RgConA>>8 )& 0xff; |
Kovalev_D | 209:224e7331a061 | 1035 | BuffTemp[5] = Gyro.RgConA & 0xff; |
Kovalev_D | 209:224e7331a061 | 1036 | } |
igor_v | 21:bc8c1cec3da6 | 1037 | Check(BuffTemp, CRC_N); |
igor_v | 21:bc8c1cec3da6 | 1038 | WriteConN (BuffTemp,CRC_N); |
igor_v | 21:bc8c1cec3da6 | 1039 | } |
igor_v | 21:bc8c1cec3da6 | 1040 | // (номер (код) ЦАПа 0...3, старший байт требуемого ЦАПа, младший байт треб ЦАПа) |
Kovalev_D | 209:224e7331a061 | 1041 | |
Kovalev_D | 209:224e7331a061 | 1042 | |
Kovalev_D | 194:8f3cb37a5541 | 1043 | |
Kovalev_D | 194:8f3cb37a5541 | 1044 | void GLDStartDischarg(void) |
Kovalev_D | 208:19150d2b528f | 1045 | { TimeDischarg=0; |
Kovalev_D | 208:19150d2b528f | 1046 | Try=0; |
Kovalev_D | 194:8f3cb37a5541 | 1047 | switch(Gyro.My_Addres) |
Kovalev_D | 194:8f3cb37a5541 | 1048 | {//смещение поджига и подсветки в зависимости от адреса ГЛД |
Kovalev_D | 194:8f3cb37a5541 | 1049 | case 0: |
Kovalev_D | 194:8f3cb37a5541 | 1050 | Gyro.Discharg = StartDischarg << ShiftStart0; |
Kovalev_D | 194:8f3cb37a5541 | 1051 | Gyro.BackLight = StartBackLight << ShiftStart0; |
Kovalev_D | 194:8f3cb37a5541 | 1052 | break; |
Kovalev_D | 194:8f3cb37a5541 | 1053 | case 1: |
Kovalev_D | 194:8f3cb37a5541 | 1054 | Gyro.Discharg = StartDischarg << ShiftStart1; |
Kovalev_D | 194:8f3cb37a5541 | 1055 | Gyro.BackLight = StartBackLight << ShiftStart1; |
Kovalev_D | 194:8f3cb37a5541 | 1056 | break; |
Kovalev_D | 194:8f3cb37a5541 | 1057 | case 2: |
Kovalev_D | 194:8f3cb37a5541 | 1058 | Gyro.Discharg = StartDischarg << ShiftStart2; |
Kovalev_D | 194:8f3cb37a5541 | 1059 | Gyro.BackLight = StartBackLight << ShiftStart2; |
Kovalev_D | 194:8f3cb37a5541 | 1060 | break; |
Kovalev_D | 194:8f3cb37a5541 | 1061 | case 3: |
Kovalev_D | 194:8f3cb37a5541 | 1062 | Gyro.Discharg = StartDischarg << ShiftStart3; |
Kovalev_D | 194:8f3cb37a5541 | 1063 | Gyro.BackLight = StartBackLight << ShiftStart3; |
Kovalev_D | 194:8f3cb37a5541 | 1064 | break; |
Kovalev_D | 194:8f3cb37a5541 | 1065 | } |
Kovalev_D | 194:8f3cb37a5541 | 1066 | } |
Kovalev_D | 194:8f3cb37a5541 | 1067 | |
Kovalev_D | 103:e96f08947def | 1068 | void Gph_W() |
Kovalev_D | 103:e96f08947def | 1069 | { |
Kovalev_D | 205:775d54fdf646 | 1070 | //Gyro.flagGph_W=3; |
Kovalev_D | 208:19150d2b528f | 1071 | |
Kovalev_D | 172:ef7bf1663645 | 1072 | Out_G_photo(BuffTemp[4],BuffTemp[5]); |
Kovalev_D | 209:224e7331a061 | 1073 | BuffTemp[0] = Gyro.SOC_Out; //DD |
Kovalev_D | 209:224e7331a061 | 1074 | BuffTemp[1] = Gyro.My_Addres; //00 |
Kovalev_D | 209:224e7331a061 | 1075 | BuffTemp[2] = Gyro.CMD_In; //D9 |
Kovalev_D | 209:224e7331a061 | 1076 | BuffTemp[3] = 0; |
Kovalev_D | 209:224e7331a061 | 1077 | Check(BuffTemp, CRC_N); |
Kovalev_D | 209:224e7331a061 | 1078 | WriteConN (BuffTemp,CRC_N); |
Kovalev_D | 103:e96f08947def | 1079 | } |
Kovalev_D | 209:224e7331a061 | 1080 | void DeviceMode() |
Kovalev_D | 209:224e7331a061 | 1081 | { |
Kovalev_D | 209:224e7331a061 | 1082 | int TempMod=1; |
Kovalev_D | 209:224e7331a061 | 1083 | BuffTemp[0] = Gyro.SOC_Out; //DD |
Kovalev_D | 209:224e7331a061 | 1084 | BuffTemp[1] = Gyro.My_Addres; //00 |
Kovalev_D | 209:224e7331a061 | 1085 | BuffTemp[2] = Gyro.CMD_In; //D9 |
Kovalev_D | 209:224e7331a061 | 1086 | TempMod = BuffTemp[3] & 0xf; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1087 | Gyro.Device_Mode = TempMod; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1088 | |
Kovalev_D | 226:4a4d5bd5fcd7 | 1089 | sprintf((Time)," Comand - DeviceMode(); Gyro.Device_Mode = %d Gyro.ModeOut = %d\r\n",Gyro.Device_Mode,Gyro.ModeOut); |
Kovalev_D | 226:4a4d5bd5fcd7 | 1090 | WriteCon(Time); |
Kovalev_D | 226:4a4d5bd5fcd7 | 1091 | /* |
Kovalev_D | 226:4a4d5bd5fcd7 | 1092 | sprintf((Time),"%d\r\n",Gyro.Device_Mode); |
Kovalev_D | 226:4a4d5bd5fcd7 | 1093 | WriteCon(Time);*/ |
Kovalev_D | 226:4a4d5bd5fcd7 | 1094 | BuffTemp[3]=Gyro.Device_Mode & 0xff; |
Kovalev_D | 209:224e7331a061 | 1095 | BuffTemp[4]=0; |
Kovalev_D | 209:224e7331a061 | 1096 | BuffTemp[5]=0; |
Kovalev_D | 209:224e7331a061 | 1097 | Check(BuffTemp, CRC_N); |
Kovalev_D | 209:224e7331a061 | 1098 | WriteConN (BuffTemp,CRC_N); |
Kovalev_D | 209:224e7331a061 | 1099 | } |
Kovalev_D | 102:4270092be987 | 1100 | |
igor_v | 0:8ad47e2b6f00 | 1101 | unsigned int Check(char *c, unsigned int Count) |
igor_v | 0:8ad47e2b6f00 | 1102 | { |
igor_v | 21:bc8c1cec3da6 | 1103 | int i=1; |
igor_v | 21:bc8c1cec3da6 | 1104 | unsigned int temp,CRC; |
igor_v | 21:bc8c1cec3da6 | 1105 | |
igor_v | 21:bc8c1cec3da6 | 1106 | |
igor_v | 21:bc8c1cec3da6 | 1107 | temp=1; |
igor_v | 21:bc8c1cec3da6 | 1108 | CRC=0; |
igor_v | 21:bc8c1cec3da6 | 1109 | |
igor_v | 21:bc8c1cec3da6 | 1110 | |
igor_v | 21:bc8c1cec3da6 | 1111 | for(; i<Count-2; i++) { |
igor_v | 21:bc8c1cec3da6 | 1112 | CRC+=c[i]; |
igor_v | 21:bc8c1cec3da6 | 1113 | } |
igor_v | 0:8ad47e2b6f00 | 1114 | |
igor_v | 21:bc8c1cec3da6 | 1115 | if(c[Count-2]!=((CRC>>8)&0xFF)) { |
igor_v | 21:bc8c1cec3da6 | 1116 | temp=0; |
igor_v | 30:17c84ed091b3 | 1117 | Gyro.RsErrLine = (Gyro.RsErrLine)&=0x2; |
igor_v | 21:bc8c1cec3da6 | 1118 | } |
igor_v | 0:8ad47e2b6f00 | 1119 | |
igor_v | 21:bc8c1cec3da6 | 1120 | if(c[Count-1]!=((CRC>>0)&0xFF)) { |
igor_v | 21:bc8c1cec3da6 | 1121 | temp=0; |
igor_v | 30:17c84ed091b3 | 1122 | // Gyro.RsErrLine= (Gyro.RsErrLine)=0x2; |
igor_v | 21:bc8c1cec3da6 | 1123 | } |
igor_v | 21:bc8c1cec3da6 | 1124 | |
igor_v | 21:bc8c1cec3da6 | 1125 | c[Count-2]=(CRC>>8)&0xFF; |
igor_v | 21:bc8c1cec3da6 | 1126 | c[Count-1]=(CRC>>0)&0xFF; |
igor_v | 21:bc8c1cec3da6 | 1127 | |
igor_v | 21:bc8c1cec3da6 | 1128 | return temp; |
igor_v | 0:8ad47e2b6f00 | 1129 | } |
igor_v | 0:8ad47e2b6f00 | 1130 | |
igor_v | 0:8ad47e2b6f00 | 1131 | int Getlengf(void) |
igor_v | 0:8ad47e2b6f00 | 1132 | { |
Kovalev_D | 121:bbae560cdd43 | 1133 | unsigned int lengf; |
Kovalev_D | 121:bbae560cdd43 | 1134 | lengf = 1; |
Kovalev_D | 194:8f3cb37a5541 | 1135 | switch(Gyro.CMD_In) |
Kovalev_D | 194:8f3cb37a5541 | 1136 | { |
Kovalev_D | 194:8f3cb37a5541 | 1137 | case 0x99: lengf=6; CRC_N=8; break; //Mintainance |
Kovalev_D | 194:8f3cb37a5541 | 1138 | case 0xB0: lengf=6; CRC_N=9; break; //Delta_Bins |
Kovalev_D | 194:8f3cb37a5541 | 1139 | case 0x0F: lengf=6; CRC_N=8; break; //Delta_Bins |
Kovalev_D | 194:8f3cb37a5541 | 1140 | case 0xA0: lengf=6; CRC_N=8; break; //Delta_PS |
Kovalev_D | 194:8f3cb37a5541 | 1141 | case 0xDD: lengf=6; CRC_N=44; break; //m_rate |
Kovalev_D | 209:224e7331a061 | 1142 | case 0x0A: lengf=8; CRC_N=6; break; //m_stymul |
Kovalev_D | 194:8f3cb37a5541 | 1143 | case 0xE9: lengf=6; CRC_N=8; break; //DeviceMode |
Kovalev_D | 194:8f3cb37a5541 | 1144 | case 0xE8: lengf=6; CRC_N=8; break; //DeviceMode |
Kovalev_D | 194:8f3cb37a5541 | 1145 | case 0xA5: lengf=6; CRC_N=8; break; //DeviceMode |
Kovalev_D | 209:224e7331a061 | 1146 | case 0xD8: lengf=6; CRC_N=8; break; //m_control |
Kovalev_D | 194:8f3cb37a5541 | 1147 | case 0xD9: lengf=6; CRC_N=8; break; //m_control |
Kovalev_D | 209:224e7331a061 | 1148 | case 0xE4: lengf=8; CRC_N=6; break; //M_VIB_W |
Kovalev_D | 209:224e7331a061 | 1149 | case 0xE6: lengf=8; CRC_N=6; break; //M_Gph_W |
Kovalev_D | 209:224e7331a061 | 1150 | |
Kovalev_D | 194:8f3cb37a5541 | 1151 | } return lengf; |
igor_v | 0:8ad47e2b6f00 | 1152 | } |
igor_v | 0:8ad47e2b6f00 | 1153 | |
igor_v | 0:8ad47e2b6f00 | 1154 | void Read_CMD(void) |
igor_v | 21:bc8c1cec3da6 | 1155 | { |
Kovalev_D | 188:4c523cc373cc | 1156 | |
Kovalev_D | 147:1aed74f19a8f | 1157 | Gyro.RsErrLine = (Gyro.RsErrLine)& 0xffff;//для сброса ошибки |
Kovalev_D | 188:4c523cc373cc | 1158 | CountBuFFIn=ReadChekCon1(BuffTemp); |
Kovalev_D | 188:4c523cc373cc | 1159 | // чтение данных из консоли |
Kovalev_D | 188:4c523cc373cc | 1160 | if(CountBuFFIn==1) { |
Kovalev_D | 190:289514f730ee | 1161 | // если есть первый байт |
Kovalev_D | 209:224e7331a061 | 1162 | if (BuffTemp[0] != SOC_In) |
Kovalev_D | 209:224e7331a061 | 1163 | { |
Kovalev_D | 147:1aed74f19a8f | 1164 | ReadCon1(BuffTemp); |
Kovalev_D | 194:8f3cb37a5541 | 1165 | Gyro.RsErrLine += 0x100; |
Kovalev_D | 209:224e7331a061 | 1166 | //BuffTemp[99]=Gyro.RsErrLine; |
Kovalev_D | 209:224e7331a061 | 1167 | ReadCon1(BuffTemp); |
Kovalev_D | 209:224e7331a061 | 1168 | } |
Kovalev_D | 147:1aed74f19a8f | 1169 | } |
Kovalev_D | 190:289514f730ee | 1170 | else if(CountBuFFIn==2) //если второй байт |
Kovalev_D | 194:8f3cb37a5541 | 1171 | { // широковещаительный |
Kovalev_D | 209:224e7331a061 | 1172 | if (BuffTemp[1] != Gyro.My_Addres /*|| BuffTemp[1] !=0x1f*/) |
Kovalev_D | 209:224e7331a061 | 1173 | { |
Kovalev_D | 93:b3803774f110 | 1174 | ReadCon1(BuffTemp); |
Kovalev_D | 194:8f3cb37a5541 | 1175 | Gyro.RsErrLine += 0x1; |
Kovalev_D | 209:224e7331a061 | 1176 | ReadCon1(BuffTemp); |
Kovalev_D | 188:4c523cc373cc | 1177 | } |
Kovalev_D | 147:1aed74f19a8f | 1178 | } |
Kovalev_D | 190:289514f730ee | 1179 | else if(CountBuFFIn==3) // если третий байт |
Kovalev_D | 147:1aed74f19a8f | 1180 | { |
igor_v | 30:17c84ed091b3 | 1181 | Gyro.CMD_In=BuffTemp[2]; |
Kovalev_D | 92:c892f0311aa7 | 1182 | N=Getlengf(); |
Kovalev_D | 92:c892f0311aa7 | 1183 | } |
Kovalev_D | 92:c892f0311aa7 | 1184 | else if(CountBuFFIn==4 && (N==6)) |
Kovalev_D | 92:c892f0311aa7 | 1185 | { // N - длина посылки аскглд(для записи параметров). определяется по коду команды в Getlengf(); |
igor_v | 21:bc8c1cec3da6 | 1186 | Param1=BuffTemp[3]; |
Kovalev_D | 92:c892f0311aa7 | 1187 | } |
Kovalev_D | 92:c892f0311aa7 | 1188 | else if((CountBuFFIn==5)&&(N==7)) |
Kovalev_D | 92:c892f0311aa7 | 1189 | { |
igor_v | 21:bc8c1cec3da6 | 1190 | Param1=BuffTemp[3]; |
igor_v | 21:bc8c1cec3da6 | 1191 | Param2=BuffTemp[4]; |
igor_v | 0:8ad47e2b6f00 | 1192 | |
Kovalev_D | 92:c892f0311aa7 | 1193 | } |
Kovalev_D | 92:c892f0311aa7 | 1194 | else if((CountBuFFIn==6)&&(N==8)) |
Kovalev_D | 147:1aed74f19a8f | 1195 | { |
igor_v | 21:bc8c1cec3da6 | 1196 | Param1=BuffTemp[3]; |
igor_v | 21:bc8c1cec3da6 | 1197 | Param2=BuffTemp[4]; |
igor_v | 21:bc8c1cec3da6 | 1198 | Param3=BuffTemp[5]; |
Kovalev_D | 92:c892f0311aa7 | 1199 | } |
Kovalev_D | 102:4270092be987 | 1200 | else if((CountBuFFIn==8)&&(N==10)) |
Kovalev_D | 147:1aed74f19a8f | 1201 | { |
Kovalev_D | 102:4270092be987 | 1202 | Param1=BuffTemp[4]; |
Kovalev_D | 102:4270092be987 | 1203 | Param2=BuffTemp[5]; |
Kovalev_D | 102:4270092be987 | 1204 | Param3=BuffTemp[6]; |
Kovalev_D | 102:4270092be987 | 1205 | Param4=BuffTemp[7]; |
Kovalev_D | 102:4270092be987 | 1206 | } |
Kovalev_D | 98:95b8e79f13e1 | 1207 | |
Kovalev_D | 92:c892f0311aa7 | 1208 | else if(CountBuFFIn > (N-1)) |
Kovalev_D | 92:c892f0311aa7 | 1209 | { |
Kovalev_D | 147:1aed74f19a8f | 1210 | ReadCon1(BuffTemp); |
Kovalev_D | 208:19150d2b528f | 1211 | |
Kovalev_D | 209:224e7331a061 | 1212 | //if(SA)CMD_M_Stymul_Answer(); |
Kovalev_D | 208:19150d2b528f | 1213 | // if(d8_anser)D8_Answer(); |
Kovalev_D | 208:19150d2b528f | 1214 | |
Kovalev_D | 147:1aed74f19a8f | 1215 | switch(Gyro.CMD_In) { |
Kovalev_D | 226:4a4d5bd5fcd7 | 1216 | // case 0xA5: DeviceMode() ; break; |
Kovalev_D | 209:224e7331a061 | 1217 | case 0x99: /*Gyro.ModeOut=0;*/CMD_Maintenance(); break; |
Kovalev_D | 209:224e7331a061 | 1218 | case 0xD8: CMD_M_Control_D8(); break; |
Kovalev_D | 194:8f3cb37a5541 | 1219 | case 0xE9: CMD_M_Param_R(); break; //чтение параметров |
Kovalev_D | 194:8f3cb37a5541 | 1220 | case 0xE8: CMD_M_Param_W(); break; //запись параметра |
Kovalev_D | 194:8f3cb37a5541 | 1221 | case 0xDA: GLDStartDischarg(); break; |
Kovalev_D | 194:8f3cb37a5541 | 1222 | case 0xD9: CMD_M_Control_D9(); break; |
Kovalev_D | 208:19150d2b528f | 1223 | case 0x0A: CMD_M_Stymul(); break; |
Kovalev_D | 209:224e7331a061 | 1224 | case 0xDD: TempParam=(BuffTemp[3]) & 0x9f; //Rate |
Kovalev_D | 193:a0fe8bfc97e4 | 1225 | switch(TempParam) { |
Kovalev_D | 209:224e7331a061 | 1226 | case Rate1 : CMD_Rate(); break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1227 | //case Rate2 : Gyro.ModeOut=9; break; |
Kovalev_D | 209:224e7331a061 | 1228 | case Rate3 : CMD_Rate3(); break; |
Kovalev_D | 194:8f3cb37a5541 | 1229 | case PRate1 : Gyro.ModeOut=1; break; |
Kovalev_D | 214:4c70e452c491 | 1230 | case PRate2 : Gyro.ModeOut=2; break; |
Kovalev_D | 214:4c70e452c491 | 1231 | case PRate3 : Gyro.ModeOut=8; break; |
Kovalev_D | 214:4c70e452c491 | 1232 | case Rate7 : CMD_Rate7(); break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1233 | case PRate7 : Gyro.ModeOut=10; break; |
Kovalev_D | 222:7de7b3bf3a1d | 1234 | case Rate5K : M_Rate5K(); break; |
Kovalev_D | 222:7de7b3bf3a1d | 1235 | case PRate5K: |
Kovalev_D | 222:7de7b3bf3a1d | 1236 | if(Gyro.ModeOut){} |
Kovalev_D | 222:7de7b3bf3a1d | 1237 | else Gyro.ModeOut=11; |
Kovalev_D | 222:7de7b3bf3a1d | 1238 | break; |
Kovalev_D | 214:4c70e452c491 | 1239 | |
Kovalev_D | 193:a0fe8bfc97e4 | 1240 | } |
Kovalev_D | 194:8f3cb37a5541 | 1241 | break; //DropDelay(); выставка задержки для мультидропа сбрасывается в команде CMD_Maintenance() на () микросекунд; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1242 | |
Kovalev_D | 226:4a4d5bd5fcd7 | 1243 | case 0xA0: /*DropDelay();*/ |
Kovalev_D | 226:4a4d5bd5fcd7 | 1244 | // TempParam=(BuffTemp[3]) & 0x80; //Delta_PS |
Kovalev_D | 226:4a4d5bd5fcd7 | 1245 | |
Kovalev_D | 226:4a4d5bd5fcd7 | 1246 | switch(Gyro.Device_Mode) |
Kovalev_D | 226:4a4d5bd5fcd7 | 1247 | { |
Kovalev_D | 226:4a4d5bd5fcd7 | 1248 | case 0: Gyro.ModeOut=3; Gyro.Event_500Hz=0; break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1249 | case 4: Gyro.ModeOut=4; break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1250 | } |
Kovalev_D | 226:4a4d5bd5fcd7 | 1251 | sprintf((Time)," Comand - B_Delta_PS(); Gyro.Device_Mode = %d Gyro.ModeOut = %d\r\n", Gyro.Device_Mode, Gyro.ModeOut); |
Kovalev_D | 226:4a4d5bd5fcd7 | 1252 | WriteCon(Time); |
Kovalev_D | 194:8f3cb37a5541 | 1253 | break; |
Kovalev_D | 226:4a4d5bd5fcd7 | 1254 | |
Kovalev_D | 194:8f3cb37a5541 | 1255 | case 0xB0: DropDelay(); TempParam = TempParam=(BuffTemp[3]>>7); //Delta_Bins |
Kovalev_D | 193:a0fe8bfc97e4 | 1256 | switch(TempParam) { |
Kovalev_D | 196:f76dbc081e63 | 1257 | case PDelta_Bins: Gyro.ModeOut=5; Gyro.Event_500Hz=0; break; |
Kovalev_D | 193:a0fe8bfc97e4 | 1258 | case Delta_Bins : CMD_Delta_Bins(); break; |
Kovalev_D | 193:a0fe8bfc97e4 | 1259 | } |
Kovalev_D | 194:8f3cb37a5541 | 1260 | break; |
Kovalev_D | 194:8f3cb37a5541 | 1261 | case 0x0F: DropDelay(); TempParam = (((BuffTemp[3])>>4) & 0x9); //B_Delta |
Kovalev_D | 193:a0fe8bfc97e4 | 1262 | switch(TempParam) { |
Kovalev_D | 193:a0fe8bfc97e4 | 1263 | case PB_Delta_EXT: Gyro.ModeOut=6; break; |
Kovalev_D | 196:f76dbc081e63 | 1264 | case PB_Delta_INT: Gyro.ModeOut=7; Gyro.Event_500Hz=0; break; |
Kovalev_D | 193:a0fe8bfc97e4 | 1265 | case B_Delta_EXT: CMD_B_Delta(); break; |
Kovalev_D | 193:a0fe8bfc97e4 | 1266 | case B_Delta_INT: CMD_B_Delta(); break; |
Kovalev_D | 193:a0fe8bfc97e4 | 1267 | } |
Kovalev_D | 194:8f3cb37a5541 | 1268 | break; |
Kovalev_D | 194:8f3cb37a5541 | 1269 | case 0xE4: CMD_M_vib(); break; |
Kovalev_D | 209:224e7331a061 | 1270 | case 0xA5: DeviceMode(); break; |
Kovalev_D | 194:8f3cb37a5541 | 1271 | case 0xE6: Gph_W(); break; |
Kovalev_D | 194:8f3cb37a5541 | 1272 | Gyro.RsErrLine = 0; |
Kovalev_D | 194:8f3cb37a5541 | 1273 | } |
Kovalev_D | 194:8f3cb37a5541 | 1274 | } |
Kovalev_D | 147:1aed74f19a8f | 1275 | } |
Kovalev_D | 193:a0fe8bfc97e4 | 1276 | |
Kovalev_D | 193:a0fe8bfc97e4 | 1277 | |
Kovalev_D | 147:1aed74f19a8f | 1278 | void TechLog(void) |
Kovalev_D | 147:1aed74f19a8f | 1279 | { |
Kovalev_D | 208:19150d2b528f | 1280 | unsigned int temp=0; |
Kovalev_D | 225:f8fee6c586cc | 1281 | if (ReadCon (Time)) |
Kovalev_D | 208:19150d2b528f | 1282 | { |
Kovalev_D | 214:4c70e452c491 | 1283 | int a=0; |
Kovalev_D | 225:f8fee6c586cc | 1284 | |
Kovalev_D | 225:f8fee6c586cc | 1285 | |
Kovalev_D | 231:079835d508ef | 1286 | if (Time[0] == 'r') |
Kovalev_D | 231:079835d508ef | 1287 | { //Mod 250 Hz PLCRegul250(); |
Kovalev_D | 231:079835d508ef | 1288 | // InitPlcFilt () ; |
Kovalev_D | 231:079835d508ef | 1289 | } |
Kovalev_D | 225:f8fee6c586cc | 1290 | |
Kovalev_D | 225:f8fee6c586cc | 1291 | if (Time[0] == 'y') |
Kovalev_D | 225:f8fee6c586cc | 1292 | { //Mod 250 Hz PLCRegul250(); |
Kovalev_D | 225:f8fee6c586cc | 1293 | if( Gyro.Debag) Gyro.Debag=0; |
Kovalev_D | 225:f8fee6c586cc | 1294 | else Gyro.Debag=1; |
Kovalev_D | 225:f8fee6c586cc | 1295 | } |
Kovalev_D | 225:f8fee6c586cc | 1296 | if (Time[0] == 'u') |
Kovalev_D | 225:f8fee6c586cc | 1297 | { //Mod 250 Hz PLCRegul250(); |
Kovalev_D | 225:f8fee6c586cc | 1298 | if( Gyro.Debag2) Gyro.Debag2=0; |
Kovalev_D | 225:f8fee6c586cc | 1299 | else Gyro.Debag2=1; |
Kovalev_D | 225:f8fee6c586cc | 1300 | } |
Kovalev_D | 227:2774b56bfab0 | 1301 | if (Time[0] == 'C') Spi.DAC_A+=32; |
Kovalev_D | 227:2774b56bfab0 | 1302 | if (Time[0] == 'c') Spi.DAC_A-=32; |
Kovalev_D | 227:2774b56bfab0 | 1303 | |
Kovalev_D | 231:079835d508ef | 1304 | |
Kovalev_D | 227:2774b56bfab0 | 1305 | if (Time[0] == 'V') Spi.DAC_A+=160; |
Kovalev_D | 227:2774b56bfab0 | 1306 | if (Time[0] == 'v') Spi.DAC_A-=160; |
Kovalev_D | 227:2774b56bfab0 | 1307 | |
Kovalev_D | 231:079835d508ef | 1308 | if (Time[0] == 'X') Spi.DAC_B+=1653; |
Kovalev_D | 231:079835d508ef | 1309 | if (Time[0] == 'x') Spi.DAC_B-=1653; |
Kovalev_D | 231:079835d508ef | 1310 | if (Time[0] == 'Z') Spi.DAC_B+=3306; |
Kovalev_D | 231:079835d508ef | 1311 | if (Time[0] == 'z') Spi.DAC_B-=3306; |
Kovalev_D | 147:1aed74f19a8f | 1312 | ///////////////////////////////////////////////////////////////// |
Kovalev_D | 147:1aed74f19a8f | 1313 | //////////////////////////////////////////////////////////////// |
Kovalev_D | 147:1aed74f19a8f | 1314 | //////////////////////Выбор FlashMod/////////////////////////// |
Kovalev_D | 147:1aed74f19a8f | 1315 | //////////////////////////////////////////////////////////////// |
Kovalev_D | 208:19150d2b528f | 1316 | |
Kovalev_D | 225:f8fee6c586cc | 1317 | } |
igor_v | 0:8ad47e2b6f00 | 1318 | } |
igor_v | 0:8ad47e2b6f00 | 1319 | |
igor_v | 0:8ad47e2b6f00 | 1320 |