Dmitry Kovalev / Mbed 2 deprecated LGfiltr

forkd

Dependencies:   mbed

Fork of LGstaandart by Dmitry Kovalev

main.c@51:81f47b817071, 2016-02-11 (annotated)

Committer:
igor_v
Date:
Thu Feb 11 20:26:23 2016 +0000
Revision:
51:81f47b817071
Parent:
50:0e3d47f18a50
Child:
52:30f2e52a493f
1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
igor_v 8:5188b1448d34 1 //ssdfwewedfsfds
igor_v 0:8ad47e2b6f00 2 /****************************************Copyright (c)****************************************************
igor_v 0:8ad47e2b6f00 3 **--------------File Info---------------------------------------------------------------------------------
igor_v 0:8ad47e2b6f00 4 ** File name: main.c
igor_v 0:8ad47e2b6f00 5 ** Last modified Date: 2011-10-24
igor_v 0:8ad47e2b6f00 6 ** Last Version: V1.00
igor_v 0:8ad47e2b6f00 7 ** Descriptions: The main() function
igor_v 0:8ad47e2b6f00 8 **
igor_v 0:8ad47e2b6f00 9 **--------------------------------------------------------------------------------------------------------
igor_v 0:8ad47e2b6f00 10 ** Created by: Electrooptica Incorp.
igor_v 0:8ad47e2b6f00 11 ** Created date: 2011-08-22
igor_v 0:8ad47e2b6f00 12 ** Version: V1.00
igor_v 3:ed8744c5f67a 13 ** Descriptions:
igor_v 3:ed8744c5f67a 14 **--------------------------------------------------------------------------------------------------------
igor_v 30:17c84ed091b3 15 последнии изменения
igor_v 30:17c84ed091b3 16 //2016_02_03_17_47
igor_v 31:c783288001b5 17 //2016_02_06 igor
igor_v 37:bdd52117b56e 18 //2016_06 Dima
Kovalev_D 41:70d12776d1ef 19 //2016_02_06 21:20 Kovalev_D
igor_v 0:8ad47e2b6f00 20 *********************************************************************************************************/
igor_v 21:bc8c1cec3da6 21
igor_v 0:8ad47e2b6f00 22
igor_v 0:8ad47e2b6f00 23 #include "Global.h"
igor_v 0:8ad47e2b6f00 24 //#include <math.h>
igor_v 0:8ad47e2b6f00 25
Kovalev_D 10:8d2edc51f3c9 26
igor_v 0:8ad47e2b6f00 27 /******************************************************************************
igor_v 0:8ad47e2b6f00 28 ** Main Function main()
igor_v 0:8ad47e2b6f00 29 ******************************************************************************/
igor_v 0:8ad47e2b6f00 30 extern uint32_t CMD_Mode;
igor_v 51:81f47b817071 31
igor_v 51:81f47b817071 32
igor_v 51:81f47b817071 33
igor_v 51:81f47b817071 34
igor_v 51:81f47b817071 35 //int y = 0;
igor_v 30:17c84ed091b3 36 unsigned int secPuls,CountBI,CmmandIn,tt,th;
igor_v 0:8ad47e2b6f00 37
igor_v 51:81f47b817071 38
igor_v 48:8697dfe679b9 39
igor_v 48:8697dfe679b9 40
igor_v 48:8697dfe679b9 41
igor_v 48:8697dfe679b9 42
igor_v 48:8697dfe679b9 43
igor_v 48:8697dfe679b9 44
igor_v 48:8697dfe679b9 45
igor_v 0:8ad47e2b6f00 46 int flag=0, TIME=0,t=0, Sec=0,tmpSec=0,SEC=0, mSec=0;
igor_v 0:8ad47e2b6f00 47 int tempsec=0;
igor_v 0:8ad47e2b6f00 48 float DACF, K_DAC;
igor_v 3:ed8744c5f67a 49
igor_v 48:8697dfe679b9 50
igor_v 48:8697dfe679b9 51
igor_v 0:8ad47e2b6f00 52
igor_v 37:bdd52117b56e 53
igor_v 0:8ad47e2b6f00 54 int main (void)
igor_v 0:8ad47e2b6f00 55 {
igor_v 48:8697dfe679b9 56
igor_v 48:8697dfe679b9 57
igor_v 48:8697dfe679b9 58
Kovalev_D 45:cbc955aecebe 59 Gyro.SOC_Out=0xDD;
Kovalev_D 40:8a6494f61326 60 Gyro.Firmware_Version =0x15; //версия программы
Kovalev_D 40:8a6494f61326 61 Gyro.GLD_Serial = 0x20; //серийный номер
Kovalev_D 40:8a6494f61326 62 Gyro.My_Addres = 0; //адрес глд
Kovalev_D 40:8a6494f61326 63
Kovalev_D 40:8a6494f61326 64
Kovalev_D 40:8a6494f61326 65
igor_v 5:02e9f559395c 66 K_DAC=65535.0/(65535.0+(deltaDAC+deltaDAC/2));
igor_v 5:02e9f559395c 67 K_DAC=0.8;
igor_v 0:8ad47e2b6f00 68
Kovalev_D 40:8a6494f61326 69
Kovalev_D 40:8a6494f61326 70 Gyro.Discharg = 0x7; // инициализация время поджига 3 сек (в событии 1HZ)
Kovalev_D 40:8a6494f61326 71 Gyro.BackLight=0x3ff;// инициализация время подсветки 10 сек (в событии 1HZ)
igor_v 37:bdd52117b56e 72 secPuls =0;
igor_v 37:bdd52117b56e 73 Pulse_midl = 0;
igor_v 37:bdd52117b56e 74 PulseHalf = 0;
igor_v 37:bdd52117b56e 75 CuruAngle = 0;
igor_v 37:bdd52117b56e 76 Spi.DAC_A = 0x7fff;
igor_v 37:bdd52117b56e 77 Spi.DAC_B = 0x7fff;
igor_v 21:bc8c1cec3da6 78 //инициализация
Diletant 46:2670fa0fcebc 79 SystemInit1(); // Инициализация контроллера: установка тактовых частот
igor_v 48:8697dfe679b9 80
igor_v 48:8697dfe679b9 81
igor_v 48:8697dfe679b9 82 Init_Pin();
igor_v 11:af609f6dee46 83
igor_v 30:17c84ed091b3 84 ///*
igor_v 12:74bd0ecf7f83 85
igor_v 30:17c84ed091b3 86
Kovalev_D 47:d902ef6f7564 87
Kovalev_D 47:d902ef6f7564 88
igor_v 48:8697dfe679b9 89
igor_v 48:8697dfe679b9 90
igor_v 48:8697dfe679b9 91
Kovalev_D 47:d902ef6f7564 92
igor_v 48:8697dfe679b9 93
igor_v 48:8697dfe679b9 94
igor_v 48:8697dfe679b9 95
igor_v 48:8697dfe679b9 96
Kovalev_D 50:0e3d47f18a50 97 //DMA_Init(); // Инициализация DMA не используем
Diletant 46:2670fa0fcebc 98 FlashDMA_Init(); // Загрузка параметров с флэш
igor_v 30:17c84ed091b3 99
Diletant 46:2670fa0fcebc 100 SystemCoreClockUpdate1(); // расчет тактовой частоты процессора перед инициализацией UART - 100MHz
igor_v 51:81f47b817071 101
Diletant 46:2670fa0fcebc 102 UARTInit(); // инициализация UART0 на скорость 38400.
igor_v 37:bdd52117b56e 103 UART1_Init(); // инициализация UART1 на скорость 38400.
igor_v 30:17c84ed091b3 104
igor_v 30:17c84ed091b3 105
igor_v 30:17c84ed091b3 106 DAC_ADC_Exchange_Init(); // инициализация обмена АЦП и ЦАП.
igor_v 30:17c84ed091b3 107 DACInit(); // инициализация ЦАП.
Diletant 46:2670fa0fcebc 108 SOI_Init(); // Инициализация квадратурного энкодера.
igor_v 30:17c84ed091b3 109
Diletant 46:2670fa0fcebc 110 IntLatch_Init(); // инициализация внутренней защелки.
Diletant 46:2670fa0fcebc 111 ExtLatch_Init(); // инициализация внешней защелки.
igor_v 0:8ad47e2b6f00 112
igor_v 48:8697dfe679b9 113
igor_v 3:ed8744c5f67a 114
igor_v 3:ed8744c5f67a 115
igor_v 13:e2a1d18677b8 116
igor_v 21:bc8c1cec3da6 117 LoadFlashParam(FromFLASH); //загрузка параметров.
Kovalev_D 50:0e3d47f18a50 118 //UART_DMA_Init(); //инициализация DMA для UART.//не используем
igor_v 21:bc8c1cec3da6 119 G_Photo_Init(); //инициализация интерфейса I2C для фотодетектора.
igor_v 21:bc8c1cec3da6 120 Out_G_photo(60, 60); //запись в буфер мастера принятые от функции данные (60,60) и установка флага старта передачи и занятой шины.
igor_v 0:8ad47e2b6f00 121 // WDTInit();
igor_v 0:8ad47e2b6f00 122
igor_v 0:8ad47e2b6f00 123
igor_v 30:17c84ed091b3 124 open_all_loops(); //#define open_all_loops() RgConA = 0 (Основной регистр управления устройства (0 - включить, 1 - отключить)).
igor_v 30:17c84ed091b3 125 Output.Str.HF_reg = Device_blk.Str.HF_min; //HFO output voltage = максивальное напряжение на ГВЧ.
igor_v 51:81f47b817071 126
igor_v 30:17c84ed091b3 127 init_PLC(); //Инициализация СРП(регулировка периметра)
igor_v 30:17c84ed091b3 128 init_Dither_reg(); //инициализация вибропривода
igor_v 51:81f47b817071 129
igor_v 30:17c84ed091b3 130 RgConB = RATE_VIBRO_1; // дополнительный регистр управления = разность вибросчетчиков после фильтра скольз.среднего(#define RATE_VIBRO_1 0x0001)
igor_v 21:bc8c1cec3da6 131
igor_v 5:02e9f559395c 132 init_Vibro();
Diletant 49:53277d871197 133 init_timer(TIME_INTERVAL ); //Timer 1: CCLK / 7812 = 12800.819Hz; Vibro: Timer1/32 = 400.025Hz; 10ms???
igor_v 5:02e9f559395c 134 enable_timer1();
Diletant 49:53277d871197 135 Init_TIM2(); //Timer 2: CCLK / 4 / 250 = 100kHz
igor_v 5:02e9f559395c 136 enable_timer2();
igor_v 5:02e9f559395c 137 close_all_loops();
igor_v 0:8ad47e2b6f00 138
igor_v 13:e2a1d18677b8 139
igor_v 51:81f47b817071 140 LPC_GPIO0->FIOCLR = (1<<5);
igor_v 5:02e9f559395c 141
igor_v 3:ed8744c5f67a 142
igor_v 15:f5191a1c3805 143 Event1Hz = 0;
igor_v 15:f5191a1c3805 144 Event1K = 0;
igor_v 15:f5191a1c3805 145 Event100K = 0;
igor_v 15:f5191a1c3805 146 EventVibro = 0;
igor_v 15:f5191a1c3805 147 Time1K = 0;
igor_v 15:f5191a1c3805 148 Time100K = 0;
igor_v 15:f5191a1c3805 149 Time1Hz = 0;
igor_v 15:f5191a1c3805 150 Clock1Hz = 0;
Kovalev_D 40:8a6494f61326 151 Gyro.Discharg = StartDischarg;
Kovalev_D 50:0e3d47f18a50 152 Gyro.BackLight = StartBackLight;
Kovalev_D 40:8a6494f61326 153
igor_v 3:ed8744c5f67a 154 Pulse_8Point = 0;
igor_v 3:ed8744c5f67a 155 Pulse_16Point = 0;
igor_v 3:ed8744c5f67a 156 Pulse_32Point = 0;
igor_v 0:8ad47e2b6f00 157
igor_v 3:ed8744c5f67a 158 Temp_AMP=0;
igor_v 3:ed8744c5f67a 159 Temp_ADC_2=0;
igor_v 3:ed8744c5f67a 160 Temp_ADC_3=0;
igor_v 3:ed8744c5f67a 161 Temp_ADC_4=0;
igor_v 3:ed8744c5f67a 162 Temp_ADC_5=0;
igor_v 0:8ad47e2b6f00 163
igor_v 51:81f47b817071 164
igor_v 51:81f47b817071 165 for (int i = 0; i < 16; i++ ) {
igor_v 51:81f47b817071 166 Buff_ADC_1[i] = 0; // ампл ацп.
igor_v 51:81f47b817071 167 Buff_ADC_2[i] = 0;
igor_v 51:81f47b817071 168 Buff_ADC_3[i] = 0;
igor_v 51:81f47b817071 169 Buff_ADC_4[i] = 0;
igor_v 51:81f47b817071 170 Buff_ADC_5[i] = 0;
igor_v 3:ed8744c5f67a 171 }
igor_v 51:81f47b817071 172 for (int i = 0; i < 32; i++ ) {
igor_v 51:81f47b817071 173
igor_v 51:81f47b817071 174 Buff_16Point[i] = 0x00;
igor_v 51:81f47b817071 175 Buff_8Point[i] = 0x00;
igor_v 51:81f47b817071 176 Buff_32Point[i] = 0x00;
igor_v 51:81f47b817071 177 Buff_16PointD[i] = 0x00;
igor_v 51:81f47b817071 178 }
igor_v 51:81f47b817071 179
igor_v 51:81f47b817071 180
igor_v 51:81f47b817071 181
igor_v 51:81f47b817071 182
igor_v 51:81f47b817071 183
Kovalev_D 47:d902ef6f7564 184 WriteCon1("\n\r ...GL start programm uart ACK.... ");
Kovalev_D 47:d902ef6f7564 185 WriteCon("\n\r ...GL start programm uart Tech.... ");
igor_v 15:f5191a1c3805 186 sprintf(Time,"\r\nCompiled: %s %s.",__DATE__, __TIME__ ); //Подготовка даты и времени компиляции
igor_v 13:e2a1d18677b8 187 WriteCon(Time);
igor_v 11:af609f6dee46 188
igor_v 37:bdd52117b56e 189
igor_v 11:af609f6dee46 190
Kovalev_D 50:0e3d47f18a50 191 while ( 1 ) { //основной цикл.
Kovalev_D 47:d902ef6f7564 192 Concol (); // Проврка 0 консоли (вход и выход)
Kovalev_D 47:d902ef6f7564 193 Concol1 (); // Проврка 0 консоли (вход и выход)
igor_v 3:ed8744c5f67a 194 if (OutBufConCount) OutBufConCount--;
igor_v 48:8697dfe679b9 195
igor_v 48:8697dfe679b9 196
igor_v 15:f5191a1c3805 197 if (ReadCon (Time)) {
igor_v 16:18e3fd7b92d0 198 if (Time[0] == 'h') { // если ввели буквц h то выдать подсказку. сделанно через принф ОЧЕНЬ плохо в работе не использовать
igor_v 15:f5191a1c3805 199 sprintf(Time,"\r\nCompiled: %s %s.",__DATE__, __TIME__ ); //Подготовка даты и времени компиляции
igor_v 15:f5191a1c3805 200 WriteCon(Time);
igor_v 15:f5191a1c3805 201 sprintf(Time,"--%d.%3.d.%2.d.",Clock1Hz,Time1K,Time100K); //Временно выдачпа временни из трех чисел
igor_v 15:f5191a1c3805 202 WriteCon(Time);
Kovalev_D 47:d902ef6f7564 203
igor_v 15:f5191a1c3805 204 }
Kovalev_D 47:d902ef6f7564 205
igor_v 51:81f47b817071 206 if (Time[0] == 'D'){Gyro.Discharg = StartDischarg;}
igor_v 51:81f47b817071 207 if (Time[0] == 'L'){Gyro.BackLight = StartBackLight;}
igor_v 51:81f47b817071 208 if (Time[0] == '1'){sprintf(Time,"\r\n");for (int i = 0; i < 32; i++ )sprintf((Time + i * 9)," <%05d> ",Buff_32Point[i]); WriteCon(Time);} // выдача технологическая
igor_v 51:81f47b817071 209
igor_v 48:8697dfe679b9 210
igor_v 48:8697dfe679b9 211
igor_v 51:81f47b817071 212
igor_v 51:81f47b817071 213
igor_v 51:81f47b817071 214
igor_v 15:f5191a1c3805 215 }
Kovalev_D 47:d902ef6f7564 216
igor_v 38:716472a4492e 217 if (OutBufCon1Count) OutBufCon1Count--;
igor_v 15:f5191a1c3805 218 if (Event1Hz) {// событие раз в 1 Гц
Kovalev_D 50:0e3d47f18a50 219 Event1Hz--;
Kovalev_D 50:0e3d47f18a50 220 Clock1Hz++;
Kovalev_D 40:8a6494f61326 221 //============================= блок управления поджигом, сделанно через сдвиг======================
Kovalev_D 40:8a6494f61326 222 if (Gyro.Discharg) { //Проверка поджига
Kovalev_D 50:0e3d47f18a50 223 Gyro.Discharg = Gyro.Discharg >> 1;
Kovalev_D 40:8a6494f61326 224 if (Gyro.Discharg & 0x01) Gyro.PinReg |= PinRegBitD;
Kovalev_D 40:8a6494f61326 225 else Gyro.PinReg &= ~PinRegBitD;
Kovalev_D 50:0e3d47f18a50 226
igor_v 16:18e3fd7b92d0 227 }
Kovalev_D 40:8a6494f61326 228 //============================= блок управления подсветкой, сделанно через сдвиг======================
Kovalev_D 40:8a6494f61326 229 if (Gyro.BackLight) { //Проверка подсветки
Kovalev_D 50:0e3d47f18a50 230 Gyro.BackLight = Gyro.BackLight >> 1;
Kovalev_D 40:8a6494f61326 231 if (Gyro.BackLight & 0x01) Gyro.PinReg |= PinRegBitL;
Kovalev_D 40:8a6494f61326 232 else Gyro.PinReg &= ~PinRegBitL;
Kovalev_D 50:0e3d47f18a50 233
Kovalev_D 40:8a6494f61326 234 }
Kovalev_D 47:d902ef6f7564 235 // CMD_Rate();
Kovalev_D 50:0e3d47f18a50 236 // WriteCon("."); //Так просто выдавать в секунду 1 байт ,что гирос жив
Kovalev_D 47:d902ef6f7564 237 /*
Kovalev_D 47:d902ef6f7564 238 for (y = 0; y < 32; y++ ){
Kovalev_D 47:d902ef6f7564 239 sprintf(Time," <%05d> ",Buff_32Point[y]);
Kovalev_D 47:d902ef6f7564 240 }sprintf(Time,"\r\n");
Kovalev_D 47:d902ef6f7564 241 WriteCon(Time);*/
Kovalev_D 47:d902ef6f7564 242
igor_v 15:f5191a1c3805 243 }
Kovalev_D 47:d902ef6f7564 244
Kovalev_D 47:d902ef6f7564 245
Kovalev_D 47:d902ef6f7564 246
Kovalev_D 47:d902ef6f7564 247
Kovalev_D 47:d902ef6f7564 248
igor_v 15:f5191a1c3805 249 if (Event1K) {// событие раз в 1 кГц
igor_v 15:f5191a1c3805 250 Event1K --;
igor_v 15:f5191a1c3805 251 Time1K++;
igor_v 15:f5191a1c3805 252 if (Time1K == 1000) {
igor_v 15:f5191a1c3805 253 Time1K = 0;
igor_v 15:f5191a1c3805 254 Event1Hz ++;
igor_v 16:18e3fd7b92d0 255
igor_v 15:f5191a1c3805 256 }
Kovalev_D 40:8a6494f61326 257
igor_v 15:f5191a1c3805 258 }
igor_v 42:6fc307c4963e 259 if (Event100K) { // событие раз в 100 кГц
igor_v 15:f5191a1c3805 260 Event100K --;
igor_v 15:f5191a1c3805 261 Time100K++;
igor_v 43:3f7c8a0ea59c 262
igor_v 42:6fc307c4963e 263 PinCheng(); // чтение регистра состояния выводов(вибро, полсветка, поджиг, LED) и управление выводами.
igor_v 43:3f7c8a0ea59c 264 if (OutBufCon1Count) OutBufCon1Count--; // обратный отсчет для управления ногой и формирование задержки на выдачу
igor_v 43:3f7c8a0ea59c 265 if (Time100K == 100) {
igor_v 15:f5191a1c3805 266 Time100K = 0;
igor_v 15:f5191a1c3805 267 Event1K ++;
igor_v 15:f5191a1c3805 268 }
igor_v 15:f5191a1c3805 269 }
igor_v 15:f5191a1c3805 270 if (EventVibro) {// событие от вибр
igor_v 15:f5191a1c3805 271 EventVibro --;
igor_v 15:f5191a1c3805 272 }
Kovalev_D 40:8a6494f61326 273 Read_CMD();
igor_v 37:bdd52117b56e 274
Kovalev_D 40:8a6494f61326 275 // VibroOut();
igor_v 3:ed8744c5f67a 276
igor_v 3:ed8744c5f67a 277 if(Time_1kHz>100) {
igor_v 3:ed8744c5f67a 278
igor_v 3:ed8744c5f67a 279 SEC++;
igor_v 5:02e9f559395c 280 if(Rate_Flag==1 && SEC>500) {
igor_v 3:ed8744c5f67a 281 SEC-=500;
igor_v 12:74bd0ecf7f83 282 // CMD_Rate();
igor_v 3:ed8744c5f67a 283 }
igor_v 3:ed8744c5f67a 284
igor_v 3:ed8744c5f67a 285 Time_1kHz-=100;
igor_v 37:bdd52117b56e 286
igor_v 37:bdd52117b56e 287
igor_v 37:bdd52117b56e 288
igor_v 37:bdd52117b56e 289
igor_v 3:ed8744c5f67a 290 }
igor_v 3:ed8744c5f67a 291 ButtonLightUP();
igor_v 3:ed8744c5f67a 292 //Device_blk.Str.
igor_v 15:f5191a1c3805 293 // TakeFromBuff();
igor_v 3:ed8744c5f67a 294
igor_v 51:81f47b817071 295 // paramV=TakeParam(1);
igor_v 3:ed8744c5f67a 296
igor_v 3:ed8744c5f67a 297
Kovalev_D 50:0e3d47f18a50 298
Kovalev_D 50:0e3d47f18a50 299 } // main infinie loop
igor_v 0:8ad47e2b6f00 300 }
igor_v 0:8ad47e2b6f00 301
igor_v 0:8ad47e2b6f00 302 /******************************************************************************
igor_v 0:8ad47e2b6f00 303 ** End Of File
igor_v 0:8ad47e2b6f00 304 ******************************************************************************/
igor_v 0:8ad47e2b6f00 305
igor_v 0:8ad47e2b6f00 306