Dmitry Kovalev / Mbed 2 deprecated LG2

fork

Dependencies:   mbed

Fork of LG by igor Apu

main.c@16:18e3fd7b92d0, 2016-02-02 (annotated)

Committer:
igor_v
Date:
Tue Feb 02 17:14:25 2016 +0000
Revision:
16:18e3fd7b92d0
Parent:
15:f5191a1c3805
Child:
21:bc8c1cec3da6
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 0:8ad47e2b6f00 15 *********************************************************************************************************/
Kovalev_D 7:078abbed4565 16 // первое изменение певое изменения Дмитрия ghjdthrth
igor_v 0:8ad47e2b6f00 17
igor_v 0:8ad47e2b6f00 18 #include "Global.h"
igor_v 0:8ad47e2b6f00 19 //#include <math.h>
igor_v 0:8ad47e2b6f00 20
Kovalev_D 10:8d2edc51f3c9 21
Kovalev_D 10:8d2edc51f3c9 22
Kovalev_D 10:8d2edc51f3c9 23
Kovalev_D 10:8d2edc51f3c9 24 //проба версий
Kovalev_D 10:8d2edc51f3c9 25
Kovalev_D 10:8d2edc51f3c9 26
Kovalev_D 10:8d2edc51f3c9 27
Kovalev_D 10:8d2edc51f3c9 28
Kovalev_D 10:8d2edc51f3c9 29
igor_v 0:8ad47e2b6f00 30 /******************************************************************************
igor_v 0:8ad47e2b6f00 31 ** Main Function main()
igor_v 0:8ad47e2b6f00 32 ******************************************************************************/
igor_v 0:8ad47e2b6f00 33 extern uint32_t CMD_Mode;
igor_v 0:8ad47e2b6f00 34 //////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 35 //////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 3:ed8744c5f67a 36 int i1 =0;
igor_v 0:8ad47e2b6f00 37 //extern unsigned int Buff_QEI[256];
igor_v 0:8ad47e2b6f00 38 volatile unsigned int IRQ_Counter=0;
igor_v 0:8ad47e2b6f00 39 volatile uint32_t timer1_counter = 0;
igor_v 0:8ad47e2b6f00 40 int temp111=0,temp=0;
igor_v 0:8ad47e2b6f00 41 int y = 0;
igor_v 0:8ad47e2b6f00 42 int CuruAngleOld=0;
igor_v 0:8ad47e2b6f00 43 unsigned int LightUpCount,BackLightCount,secPuls,CountBI,CmmandIn,tt,th;
igor_v 0:8ad47e2b6f00 44
igor_v 0:8ad47e2b6f00 45 unsigned int paramV;
igor_v 0:8ad47e2b6f00 46
igor_v 0:8ad47e2b6f00 47
igor_v 0:8ad47e2b6f00 48
igor_v 0:8ad47e2b6f00 49 void Led_init()
igor_v 0:8ad47e2b6f00 50 {
igor_v 3:ed8744c5f67a 51 LPC_PINCON->PINSEL0 = (0x00<<28);
igor_v 3:ed8744c5f67a 52 LPC_GPIO1->FIODIR = (0x1<<30);
igor_v 3:ed8744c5f67a 53 LPC_PINCON->PINMODE0 = (0x3<<28);
igor_v 3:ed8744c5f67a 54 // LPC_GPIO1->FIOSET = (0x0<<30);
igor_v 3:ed8744c5f67a 55 // LPC_GPIO0->FIOSET = (1<<4);
igor_v 0:8ad47e2b6f00 56 }
igor_v 3:ed8744c5f67a 57
igor_v 0:8ad47e2b6f00 58 int flag=0, TIME=0,t=0, Sec=0,tmpSec=0,SEC=0, mSec=0;
igor_v 0:8ad47e2b6f00 59 int tempsec=0;
igor_v 0:8ad47e2b6f00 60 float DACF, K_DAC;
igor_v 3:ed8744c5f67a 61
igor_v 0:8ad47e2b6f00 62 void Led_Blink()
igor_v 0:8ad47e2b6f00 63 {
igor_v 3:ed8744c5f67a 64 if (flag == 0) {
igor_v 3:ed8744c5f67a 65 LPC_GPIO1->FIOSET = (0x1<<30);
igor_v 3:ed8744c5f67a 66 flag=1;
igor_v 3:ed8744c5f67a 67 } else {
igor_v 3:ed8744c5f67a 68 flag =0;
igor_v 3:ed8744c5f67a 69 LPC_GPIO1->FIOCLR = (0x01<<30);
igor_v 3:ed8744c5f67a 70 }
igor_v 0:8ad47e2b6f00 71 }
igor_v 0:8ad47e2b6f00 72
igor_v 0:8ad47e2b6f00 73 long LED_TEMP=0;
igor_v 11:af609f6dee46 74
igor_v 11:af609f6dee46 75
igor_v 11:af609f6dee46 76
igor_v 12:74bd0ecf7f83 77
igor_v 0:8ad47e2b6f00 78 int main (void)
igor_v 0:8ad47e2b6f00 79 {
igor_v 5:02e9f559395c 80 K_DAC=65535.0/(65535.0+(deltaDAC+deltaDAC/2));
igor_v 5:02e9f559395c 81 K_DAC=0.8;
igor_v 0:8ad47e2b6f00 82
igor_v 5:02e9f559395c 83 Main.Firmware_Version=0x15;
igor_v 5:02e9f559395c 84 Main.GLD_Serial = 0x20;
igor_v 5:02e9f559395c 85 Main.My_Addres=0;
igor_v 5:02e9f559395c 86 LightUpCount=1000;
igor_v 5:02e9f559395c 87 BackLightCount=5000;
igor_v 5:02e9f559395c 88 secPuls=0;
igor_v 5:02e9f559395c 89 Pulse_midl = 0;
igor_v 5:02e9f559395c 90 PulseHalf = 0;
igor_v 5:02e9f559395c 91 CuruAngle = 0;
igor_v 5:02e9f559395c 92 Spi.DAC_A=0x7fff;
igor_v 6:6c5cd8c615cc 93 Spi.DAC_B = 0x7fff;
igor_v 5:02e9f559395c 94 //�������������
igor_v 11:af609f6dee46 95
igor_v 12:74bd0ecf7f83 96 SystemInit1(); // ������������� �������ввававва
igor_v 5:02e9f559395c 97 Led_init();
igor_v 12:74bd0ecf7f83 98
igor_v 5:02e9f559395c 99 ///*
igor_v 5:02e9f559395c 100 //���������������� ������� �������
igor_v 5:02e9f559395c 101 LPC_PINCON->PINSEL0 &= ~(3<<8); //e. P0.4 is GPIO pin (������ ( 00 ) � 9:8 ��� PISEL0 ����� P0.4 ��� GPIO)
igor_v 5:02e9f559395c 102 LPC_PINCON->PINMODE0 |= (3<<8); //e. P0.4 is GPIO pin (������ ( 11 ) � 9:8 ��� PINMODE0 "��� ��������� �������������� ���������")
igor_v 5:02e9f559395c 103 LPC_GPIO0->FIODIR |= (1<<4); //e. P0.4 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.4 ��� �����)
igor_v 5:02e9f559395c 104 LightUpON //e. P0.4 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.4 ������ ������� �������)
igor_v 11:af609f6dee46 105
igor_v 11:af609f6dee46 106
igor_v 11:af609f6dee46 107
igor_v 11:af609f6dee46 108
igor_v 12:74bd0ecf7f83 109
igor_v 12:74bd0ecf7f83 110
igor_v 12:74bd0ecf7f83 111
igor_v 5:02e9f559395c 112 /*
igor_v 5:02e9f559395c 113 LPC_PINCON->PINSEL0 &= ~(3<<10); //e. P0.4 is GPIO pin (������ ( 00 ) � 9:8 ��� PISEL0 ����� P0.4 ��� GPIO)
igor_v 5:02e9f559395c 114 LPC_PINCON->PINMODE0 |= (3<<10); //e. P0.4 is GPIO pin (������ ( 11 ) � 9:8 ��� PINMODE0 "��� ��������� �������������� ���������")
igor_v 5:02e9f559395c 115 LPC_GPIO0->FIODIR |= (1<<5); //e. P0.4 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.4 ��� �����)
igor_v 5:02e9f559395c 116 LPC_GPIO0->FIOCLR |= (1<<5); //e. P0.4 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.4 ������ ������� �������)*/
igor_v 3:ed8744c5f67a 117 ///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 118 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 3:ed8744c5f67a 119
igor_v 5:02e9f559395c 120 LPC_PINCON->PINSEL3 = (0x00<<18); //e. P1.25 is GPIO pin
igor_v 5:02e9f559395c 121 LPC_PINCON->PINMODE3 |= (3<<18); //e. P1.25 (��������e �������������� ���������")
igor_v 5:02e9f559395c 122 LPC_GPIO1->FIODIR |= (1<<25); //e. P0.5 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����)
igor_v 5:02e9f559395c 123 LPC_GPIO1->FIOCLR |= (1<<25);
igor_v 3:ed8744c5f67a 124
igor_v 3:ed8744c5f67a 125
igor_v 0:8ad47e2b6f00 126 /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 3:ed8744c5f67a 127
igor_v 5:02e9f559395c 128 LPC_PINCON->PINSEL3 = (0x00<<24); //e. P1.28 is GPIO pin
igor_v 5:02e9f559395c 129 LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (������ ( 11 ) � ��� PINMODE0 "��� ��������� �������������� ���������")
igor_v 5:02e9f559395c 130 LPC_GPIO1->FIODIR |= (1<<28); //e. P1.28 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����)
igor_v 5:02e9f559395c 131 LPC_GPIO1->FIOCLR |= (1<<28);
igor_v 3:ed8744c5f67a 132 // init_timer(TIME_INTERVAL ); // 10ms
igor_v 3:ed8744c5f67a 133 // enable_timer1();
igor_v 0:8ad47e2b6f00 134 ///������������� ���������
igor_v 5:02e9f559395c 135 LPC_PINCON->PINSEL2 = (0x00<<24); //e. P2.12 is GPIO pin
igor_v 5:02e9f559395c 136 LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (������ ( 11 ) � ��� PINMODE0 "��� ��������� �������������� ���������")
igor_v 5:02e9f559395c 137 LPC_GPIO2->FIODIR |= (1<<12); //e. P1.28 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����)
igor_v 5:02e9f559395c 138 LPC_GPIO2->FIOCLR |= (1<<12);
igor_v 3:ed8744c5f67a 139
igor_v 3:ed8744c5f67a 140 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 141 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 5:02e9f559395c 142 /*
igor_v 5:02e9f559395c 143 //���������������� ������� ������� ��������� ���� (������ �� 80 ���� ������ 81)
igor_v 5:02e9f559395c 144 LPC_PINCON->PINSEL0 = (0x00<<10); //e. P0.5 is GPIO pin (������ ( 00 ) � 11:10 ��� PISEL0 ����� P0.5 ��� GPIO)
igor_v 5:02e9f559395c 145 LPC_PINCON->PINMODE0 |= (3<<10); //e. P0.5 is GPIO pin (������ ( 11 ) � 11:10 ��� PINMODE0 "��� ��������� �������������� ���������")
igor_v 5:02e9f559395c 146 LPC_GPIO0->FIODIR |= (1<<5); //e. P0.5 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����)
igor_v 5:02e9f559395c 147 LPC_GPIO0->FIOCLR |= (1<<5); //e. P0.5 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.5 ������ ������� �������)
igor_v 5:02e9f559395c 148 */
igor_v 5:02e9f559395c 149 DMA_Init(); // ������������� DMA
igor_v 5:02e9f559395c 150 FlashDMA_Init(); // �������� ���������� � ����
igor_v 3:ed8744c5f67a 151
igor_v 12:74bd0ecf7f83 152 SystemCoreClockUpdate1(); // ������ ��������� ������� ��� UART.
igor_v 5:02e9f559395c 153 UARTInit(); // ������������� UART0 �� �������� 38400.
igor_v 5:02e9f559395c 154 UART1_Init(); // ������������� UART1 �� �������� 38400.
igor_v 3:ed8744c5f67a 155
igor_v 0:8ad47e2b6f00 156
igor_v 5:02e9f559395c 157 DAC_ADC_Exchange_Init(); // ������������� ������ ��� � ���.
igor_v 5:02e9f559395c 158 DACInit(); // ������������� ���.
igor_v 5:02e9f559395c 159 SOI_Init(); // ������������� ������������� ��������.
igor_v 3:ed8744c5f67a 160
igor_v 5:02e9f559395c 161 IntLatch_Init(); // ������������� ���������� �������.
igor_v 5:02e9f559395c 162 ExtLatch_Init(); // ������������� ������� �������.
igor_v 0:8ad47e2b6f00 163
igor_v 3:ed8744c5f67a 164 //----------------debug-------------------------
igor_v 5:02e9f559395c 165 //LPC_GPIO2->FIODIR = 0x5C; // P2.0...P2.7 defined as Outputs
igor_v 5:02e9f559395c 166 //LPC_GPIO2->FIOCLR = 0x5C; // turn off all the LEDs
igor_v 3:ed8744c5f67a 167 //----------------debug-------------------------
igor_v 3:ed8744c5f67a 168
igor_v 3:ed8744c5f67a 169
igor_v 13:e2a1d18677b8 170
igor_v 5:02e9f559395c 171 LoadFlashParam(FromFLASH); //�������� ����������.
igor_v 5:02e9f559395c 172 UART_DMA_Init(); //������������� DMA ��� UART.
igor_v 5:02e9f559395c 173 G_Photo_Init(); //������������� ���������� I2C ��� �������������.
igor_v 5:02e9f559395c 174 Out_G_photo(60, 60); //������ � ����� ������� �������� �� ������� ������ (60,60) � ��������� ����� ������ �������� � ������� ����.
igor_v 0:8ad47e2b6f00 175 // WDTInit();
igor_v 0:8ad47e2b6f00 176
igor_v 0:8ad47e2b6f00 177
igor_v 5:02e9f559395c 178 open_all_loops(); //#define open_all_loops() RgConA = 0 (�������� ������� ���������� ���������� (0 - ��������, 1 - ���������)).
igor_v 5:02e9f559395c 179 Output.Str.HF_reg = Device_blk.Str.HF_min; //HFO output voltage = ������������ ���������� �� ���.
igor_v 5:02e9f559395c 180 init_PLC(); //������������� ���(����������� ���������)
igor_v 5:02e9f559395c 181 init_Dither_reg(); //������������� ������������
igor_v 5:02e9f559395c 182 RgConB = RATE_VIBRO_1; // �������������� ������� ���������� = �������� �������������� ����� ������� ������.��������(#define RATE_VIBRO_1 0x0001)
igor_v 5:02e9f559395c 183 init_Vibro();
igor_v 5:02e9f559395c 184 init_timer(TIME_INTERVAL ); // 10ms
igor_v 5:02e9f559395c 185 enable_timer1();
igor_v 5:02e9f559395c 186 Init_TIM2();
igor_v 5:02e9f559395c 187 enable_timer2();
igor_v 5:02e9f559395c 188 close_all_loops();
igor_v 0:8ad47e2b6f00 189
igor_v 13:e2a1d18677b8 190
igor_v 5:02e9f559395c 191 LPC_GPIO0->FIOCLR = (1<<5);
igor_v 5:02e9f559395c 192
igor_v 3:ed8744c5f67a 193
igor_v 15:f5191a1c3805 194 Event1Hz = 0;
igor_v 15:f5191a1c3805 195 Event1K = 0;
igor_v 15:f5191a1c3805 196 Event100K = 0;
igor_v 15:f5191a1c3805 197 EventVibro = 0;
igor_v 15:f5191a1c3805 198 Time1K = 0;
igor_v 15:f5191a1c3805 199 Time100K = 0;
igor_v 15:f5191a1c3805 200 Time1Hz = 0;
igor_v 15:f5191a1c3805 201 Clock1Hz = 0;
igor_v 16:18e3fd7b92d0 202 ShiftD = StartShiftD;
igor_v 16:18e3fd7b92d0 203 ShiftL = StartShiftL;
igor_v 15:f5191a1c3805 204
igor_v 3:ed8744c5f67a 205 Pulse_8Point = 0;
igor_v 3:ed8744c5f67a 206 Pulse_16Point = 0;
igor_v 3:ed8744c5f67a 207 Pulse_32Point = 0;
igor_v 0:8ad47e2b6f00 208
igor_v 3:ed8744c5f67a 209 Temp_AMP=0;
igor_v 3:ed8744c5f67a 210 Temp_ADC_2=0;
igor_v 3:ed8744c5f67a 211 Temp_ADC_3=0;
igor_v 3:ed8744c5f67a 212 Temp_ADC_4=0;
igor_v 3:ed8744c5f67a 213 Temp_ADC_5=0;
igor_v 0:8ad47e2b6f00 214
igor_v 3:ed8744c5f67a 215 for (y = 0; y < 256; y++ ) {
igor_v 5:02e9f559395c 216 Buff_16Point[y] = 0xffff;
igor_v 5:02e9f559395c 217 Buff_8Point[y] = 0xffff;
igor_v 5:02e9f559395c 218 Buff_32Point[y] = 0xffff;
igor_v 5:02e9f559395c 219 Buff_ADC_1[y] = 0; // ���� ���.
igor_v 5:02e9f559395c 220 Buff_ADC_2[y] = 0;
igor_v 5:02e9f559395c 221 Buff_ADC_3[y] = 0;
igor_v 5:02e9f559395c 222 Buff_ADC_4[y] = 0;
igor_v 5:02e9f559395c 223 Buff_ADC_5[y] = 0;
igor_v 0:8ad47e2b6f00 224
igor_v 3:ed8744c5f67a 225 }
igor_v 0:8ad47e2b6f00 226
igor_v 0:8ad47e2b6f00 227
igor_v 0:8ad47e2b6f00 228
igor_v 12:74bd0ecf7f83 229
igor_v 16:18e3fd7b92d0 230 WriteCon("\n\r ...GL start programm uart 0.... ");
igor_v 15:f5191a1c3805 231 sprintf(Time,"\r\nCompiled: %s %s.",__DATE__, __TIME__ ); //Подготовка даты и времени компиляции
igor_v 13:e2a1d18677b8 232 WriteCon(Time);
igor_v 11:af609f6dee46 233
igor_v 11:af609f6dee46 234
igor_v 11:af609f6dee46 235
igor_v 3:ed8744c5f67a 236 do { //�������� ����.
igor_v 15:f5191a1c3805 237 Concol (); // Проврка 0 консоли (вход и выход)
igor_v 3:ed8744c5f67a 238 if (OutBufConCount) OutBufConCount--;
igor_v 15:f5191a1c3805 239
igor_v 15:f5191a1c3805 240 if (ReadCon (Time)) {
igor_v 16:18e3fd7b92d0 241 if (Time[0] == 'h') { // если ввели буквц h то выдать подсказку. сделанно через принф ОЧЕНЬ плохо в работе не использовать
igor_v 15:f5191a1c3805 242 sprintf(Time,"\r\nCompiled: %s %s.",__DATE__, __TIME__ ); //Подготовка даты и времени компиляции
igor_v 15:f5191a1c3805 243 WriteCon(Time);
igor_v 15:f5191a1c3805 244 sprintf(Time,"--%d.%3.d.%2.d.",Clock1Hz,Time1K,Time100K); //Временно выдачпа временни из трех чисел
igor_v 15:f5191a1c3805 245 WriteCon(Time);
igor_v 15:f5191a1c3805 246 }
igor_v 15:f5191a1c3805 247 }
igor_v 15:f5191a1c3805 248
igor_v 15:f5191a1c3805 249 if (Event1Hz) {// событие раз в 1 Гц
igor_v 15:f5191a1c3805 250 Event1Hz --;
igor_v 15:f5191a1c3805 251 Clock1Hz++;
igor_v 16:18e3fd7b92d0 252
igor_v 16:18e3fd7b92d0 253 //============================= блок управления поджигом и подсветкой, сделанно через сдвиг======================
igor_v 16:18e3fd7b92d0 254 if (ShiftD) { //Проверка поджига
igor_v 16:18e3fd7b92d0 255 // if (ShiftD & 0x01)
igor_v 16:18e3fd7b92d0 256 ShiftD = ShiftD >> 1;
igor_v 16:18e3fd7b92d0 257 }
igor_v 16:18e3fd7b92d0 258 if (ShiftL) { //Проверка подсветки
igor_v 16:18e3fd7b92d0 259 ShiftL = ShiftL >> 1;
igor_v 16:18e3fd7b92d0 260
igor_v 16:18e3fd7b92d0 261 }
igor_v 16:18e3fd7b92d0 262
igor_v 15:f5191a1c3805 263 }
igor_v 15:f5191a1c3805 264 if (Event1K) {// событие раз в 1 кГц
igor_v 15:f5191a1c3805 265 Event1K --;
igor_v 15:f5191a1c3805 266 Time1K++;
igor_v 15:f5191a1c3805 267 if (Time1K == 1000) {
igor_v 15:f5191a1c3805 268 Time1K = 0;
igor_v 15:f5191a1c3805 269 Event1Hz ++;
igor_v 16:18e3fd7b92d0 270
igor_v 15:f5191a1c3805 271 }
igor_v 15:f5191a1c3805 272 }
igor_v 15:f5191a1c3805 273 if (Event100K) {// событие раз в 100 кГц
igor_v 15:f5191a1c3805 274 Event100K --;
igor_v 15:f5191a1c3805 275 Time100K++;
igor_v 15:f5191a1c3805 276 if (Time100K == 100) {
igor_v 15:f5191a1c3805 277 Time100K = 0;
igor_v 15:f5191a1c3805 278 Event1K ++;
igor_v 15:f5191a1c3805 279 }
igor_v 15:f5191a1c3805 280 }
igor_v 15:f5191a1c3805 281 if (EventVibro) {// событие от вибр
igor_v 15:f5191a1c3805 282 EventVibro --;
igor_v 15:f5191a1c3805 283 }
igor_v 15:f5191a1c3805 284
igor_v 15:f5191a1c3805 285
igor_v 15:f5191a1c3805 286
igor_v 15:f5191a1c3805 287
igor_v 15:f5191a1c3805 288 // Concol1 ();
igor_v 3:ed8744c5f67a 289 Read_CMD();
igor_v 3:ed8744c5f67a 290
igor_v 3:ed8744c5f67a 291 // VibroOut();
igor_v 3:ed8744c5f67a 292
igor_v 3:ed8744c5f67a 293 if(Time_1kHz>100) {
igor_v 3:ed8744c5f67a 294
igor_v 3:ed8744c5f67a 295 SEC++;
igor_v 5:02e9f559395c 296 if(Rate_Flag==1 && SEC>500) {
igor_v 3:ed8744c5f67a 297 SEC-=500;
igor_v 12:74bd0ecf7f83 298 // CMD_Rate();
igor_v 3:ed8744c5f67a 299 }
igor_v 3:ed8744c5f67a 300
igor_v 3:ed8744c5f67a 301 Time_1kHz-=100;
igor_v 3:ed8744c5f67a 302 if(LightUpCount) {
igor_v 3:ed8744c5f67a 303 LightUpCount--;
igor_v 3:ed8744c5f67a 304 LightUpON
igor_v 3:ed8744c5f67a 305 }
igor_v 0:8ad47e2b6f00 306
igor_v 3:ed8744c5f67a 307 else {
igor_v 3:ed8744c5f67a 308 LightUpOFF;
igor_v 3:ed8744c5f67a 309 }
igor_v 3:ed8744c5f67a 310 if(BackLightCount) {
igor_v 3:ed8744c5f67a 311 BackLightCount--;
igor_v 3:ed8744c5f67a 312 BackLightON
igor_v 3:ed8744c5f67a 313 } else {
igor_v 3:ed8744c5f67a 314 BackLightOFF;
igor_v 3:ed8744c5f67a 315 }
igor_v 3:ed8744c5f67a 316 }
igor_v 3:ed8744c5f67a 317 ButtonLightUP();
igor_v 3:ed8744c5f67a 318 //Device_blk.Str.
igor_v 15:f5191a1c3805 319 // TakeFromBuff();
igor_v 3:ed8744c5f67a 320
igor_v 3:ed8744c5f67a 321 //���������� �������.
igor_v 3:ed8744c5f67a 322 // paramV=TakeParam(1);
igor_v 3:ed8744c5f67a 323
igor_v 3:ed8744c5f67a 324
igor_v 15:f5191a1c3805 325
igor_v 3:ed8744c5f67a 326 if (LPC_PWM1->IR & 0x0001) { // ���� � �������� ���������� ���1 (������� PWM1IR) ���� ���� ���������� ���������� �������� � ����� (lim0 ?) ��:
igor_v 16:18e3fd7b92d0 327 /* ResetCS(ADC); //prepare ADC for sampling
igor_v 3:ed8744c5f67a 328 SetDAC(DAC);
igor_v 16:18e3fd7b92d0 329 LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED
igor_v 16:18e3fd7b92d0 330 LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED
igor_v 16:18e3fd7b92d0 331 LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED
igor_v 16:18e3fd7b92d0 332 SetCS(ADC); //start ADC sampling
igor_v 3:ed8744c5f67a 333 ResetDAC(DAC); //start DAC prepearing for writing
igor_v 3:ed8744c5f67a 334 */
igor_v 3:ed8744c5f67a 335 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 336 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 337 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 3:ed8744c5f67a 338 secPuls++;
igor_v 3:ed8744c5f67a 339 tmpSec++;
igor_v 3:ed8744c5f67a 340 mSec++;
igor_v 0:8ad47e2b6f00 341
igor_v 3:ed8744c5f67a 342 i1++;
igor_v 3:ed8744c5f67a 343 if(i1>10000)
igor_v 3:ed8744c5f67a 344 //if(CountV31>30)
igor_v 3:ed8744c5f67a 345 {
igor_v 15:f5191a1c3805 346 WriteCon(".");
igor_v 3:ed8744c5f67a 347 i1=0;
igor_v 3:ed8744c5f67a 348 /*
igor_v 3:ed8744c5f67a 349 SendToBuffStr("\n\r");
igor_v 3:ed8744c5f67a 350 // if (Buff_ADC_1 [y] > 65535)SendToBuffStr(" 0 "); else SendToBuffStr(" 1 ");
igor_v 3:ed8744c5f67a 351 sprintf (BuffTemp,"<%05d> <%05d> <%05d> <%05d> <%05d>", Temp_AMP>>5,Temp_ADC_2>>5,Temp_ADC_3>>5,Temp_ADC_4>>5,Temp_ADC_5>>5);
igor_v 3:ed8744c5f67a 352 // sprintf (BuffTemp,"<%07d> <%07d> <%07d> <%07d> <%07d>", Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5);
igor_v 3:ed8744c5f67a 353 SendToBuffStr(BuffTemp);
igor_v 3:ed8744c5f67a 354 */
igor_v 3:ed8744c5f67a 355 /*
igor_v 3:ed8744c5f67a 356 WriteConByte (Main.T_Vib&0xff00);
igor_v 3:ed8744c5f67a 357 WriteConByte (Main.T_Vib&0x00ff);
igor_v 3:ed8744c5f67a 358 WriteConByte (Main.T_Vib);
igor_v 3:ed8744c5f67a 359 */
igor_v 3:ed8744c5f67a 360 /*
igor_v 3:ed8744c5f67a 361
igor_v 3:ed8744c5f67a 362 for (y = 0; y < 32; y++ )
igor_v 3:ed8744c5f67a 363 {
igor_v 3:ed8744c5f67a 364
igor_v 3:ed8744c5f67a 365 WriteCon(BuffTemp);
igor_v 3:ed8744c5f67a 366 } WriteCon("\n\r");
igor_v 0:8ad47e2b6f00 367
igor_v 3:ed8744c5f67a 368 */
igor_v 3:ed8744c5f67a 369 /*
igor_v 3:ed8744c5f67a 370 Main.T_Vib=((7680000*16/Main.Frq)*4096);
igor_v 3:ed8744c5f67a 371 th= Main.T_Vib&0xff00;
igor_v 3:ed8744c5f67a 372 tt= Main.T_Vib&0x00ff;
igor_v 3:ed8744c5f67a 373 sprintf(BuffTemp,"<%07d >",( (Main.T_Vib&0xff00)));
igor_v 3:ed8744c5f67a 374 SendToBuffStr(BuffTemp);
igor_v 3:ed8744c5f67a 375
igor_v 3:ed8744c5f67a 376 sprintf(BuffTemp,"<%07d >",( ( Main.T_Vib&0x00ff)));
igor_v 3:ed8744c5f67a 377 SendToBuffStr(BuffTemp);
igor_v 15:f5191a1c3805 378
igor_v 3:ed8744c5f67a 379 CuruAngleOld=CuruAngle;*/
igor_v 3:ed8744c5f67a 380 // Spi.ADC1=Spi.ADC1*0.000061;
igor_v 3:ed8744c5f67a 381
igor_v 3:ed8744c5f67a 382
igor_v 3:ed8744c5f67a 383
igor_v 3:ed8744c5f67a 384
igor_v 3:ed8744c5f67a 385 /*
igor_v 3:ed8744c5f67a 386
igor_v 3:ed8744c5f67a 387 sprintf(BuffTemp,"\n\r<%05d><%05d><%05d><%05d><%05d>",Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5);
igor_v 3:ed8744c5f67a 388 SendToBuffStr(BuffTemp);
igor_v 3:ed8744c5f67a 389
igor_v 3:ed8744c5f67a 390 */
igor_v 3:ed8744c5f67a 391
igor_v 3:ed8744c5f67a 392 /* sprintf(BuffTemp,"<%d>",(FrecTemp));
igor_v 3:ed8744c5f67a 393 SendToBuffStr(BuffTemp);
igor_v 3:ed8744c5f67a 394 for (y = 0; y < 32; y++ )
igor_v 3:ed8744c5f67a 395 {
igor_v 3:ed8744c5f67a 396 sprintf(BuffTemp," <%07d>", (Buff_16PointD [y]-65535));
igor_v 3:ed8744c5f67a 397 SendToBuffStr(BuffTemp);
igor_v 3:ed8744c5f67a 398 } */
igor_v 15:f5191a1c3805 399
igor_v 3:ed8744c5f67a 400 }
igor_v 3:ed8744c5f67a 401
igor_v 3:ed8744c5f67a 402
igor_v 3:ed8744c5f67a 403
igor_v 3:ed8744c5f67a 404
igor_v 0:8ad47e2b6f00 405
igor_v 0:8ad47e2b6f00 406
igor_v 0:8ad47e2b6f00 407
igor_v 0:8ad47e2b6f00 408
igor_v 0:8ad47e2b6f00 409 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 410 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 411 //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
igor_v 0:8ad47e2b6f00 412
igor_v 0:8ad47e2b6f00 413
igor_v 0:8ad47e2b6f00 414
igor_v 3:ed8744c5f67a 415
igor_v 3:ed8744c5f67a 416 LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED
igor_v 3:ed8744c5f67a 417
igor_v 0:8ad47e2b6f00 418
igor_v 3:ed8744c5f67a 419 Curr_Cnt_Vib = LPC_QEI->POS; // �������� � ���������� Curr_Cnt_Vib ������� ��������� ��������. (������� ���������� ���������)
igor_v 3:ed8744c5f67a 420 Latch_Event(); //����������� �������
igor_v 3:ed8744c5f67a 421
igor_v 3:ed8744c5f67a 422 clc_Pulses(); // ������� ���������. RATE_REPER_OR_REFMEANDR ��� RATE_VIBRO_1
igor_v 0:8ad47e2b6f00 423
igor_v 0:8ad47e2b6f00 424
igor_v 3:ed8744c5f67a 425 //ADC_Input(); // �������� ������ ���������� ������ � ������� Thermo1, Thermo2, HF_out � ����� Input.ArrayIn[n].
igor_v 3:ed8744c5f67a 426 //DAC_ADC_Exchange();// �������� ������ ���������� ������ � ����� � ����.
igor_v 3:ed8744c5f67a 427 ServiceTime();//��������� ������.
igor_v 3:ed8744c5f67a 428 clc_ThermoSensors();//������ ������� ����������� �� �������
igor_v 3:ed8744c5f67a 429 clc_HFO(); //������ �������� ��� �������� � ������ ���(�� ���).
igor_v 3:ed8744c5f67a 430 clc_PLC();
igor_v 3:ed8744c5f67a 431 // clc_Dith_regulator();
igor_v 3:ed8744c5f67a 432 clc_OutFreq_regulator();
igor_v 3:ed8744c5f67a 433 Output.Str.WP_sin = clc_WP_sin();
igor_v 3:ed8744c5f67a 434 contrl_GLD();
igor_v 3:ed8744c5f67a 435 G_Photo_Exchange();
igor_v 3:ed8744c5f67a 436 // Output.Str.T_Vibro = paramV*48;
igor_v 0:8ad47e2b6f00 437
igor_v 3:ed8744c5f67a 438
igor_v 3:ed8744c5f67a 439 Line_1_Rcv();
igor_v 3:ed8744c5f67a 440 decode_CMD();
igor_v 3:ed8744c5f67a 441 transm_DAT();
igor_v 12:74bd0ecf7f83 442 //îòêëþ÷åíèå ïîäæèãà.
igor_v 3:ed8744c5f67a 443
igor_v 3:ed8744c5f67a 444
igor_v 13:e2a1d18677b8 445 // data_Rdy &= ~RESET_PERIOD;
igor_v 0:8ad47e2b6f00 446
igor_v 0:8ad47e2b6f00 447
igor_v 3:ed8744c5f67a 448 LPC_PWM1->IR = 0x0001; //e. clear interrupt flag
igor_v 13:e2a1d18677b8 449 LPC_GPIO2->FIOCLR |= 0x0000004; // turn off the LED
igor_v 0:8ad47e2b6f00 450
igor_v 0:8ad47e2b6f00 451 // WDTFeed();
igor_v 0:8ad47e2b6f00 452 //SPI_Exchange();
igor_v 3:ed8744c5f67a 453
igor_v 3:ed8744c5f67a 454 }
igor_v 3:ed8744c5f67a 455
igor_v 3:ed8744c5f67a 456 } while ( 1 ); // main infinie loop
igor_v 0:8ad47e2b6f00 457 }
igor_v 0:8ad47e2b6f00 458
igor_v 0:8ad47e2b6f00 459 /******************************************************************************
igor_v 0:8ad47e2b6f00 460 ** End Of File
igor_v 0:8ad47e2b6f00 461 ******************************************************************************/
igor_v 0:8ad47e2b6f00 462
igor_v 0:8ad47e2b6f00 463