Dmitry Kovalev / Mbed 2 deprecated LG2

fork

Dependencies:   mbed

Fork of LG by igor Apu

main.c@52:30f2e52a493f, 2016-02-11 (annotated)

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