Egor Syomin
/
LG
test fork
Fork of LG by
Diff: main.c
- Revision:
- 3:ed8744c5f67a
- Parent:
- 0:8ad47e2b6f00
- Child:
- 4:c0bab7b13f3a
diff -r 2d0b80ed9216 -r ed8744c5f67a main.c --- a/main.c Sun Jan 31 05:30:23 2016 +0000 +++ b/main.c Sun Jan 31 11:54:32 2016 +0000 @@ -10,28 +10,22 @@ ** Created by: Electrooptica Incorp. ** Created date: 2011-08-22 ** Version: V1.00 -** Descriptions: -**-------------------------------------------------------------------------------------------------------- +** Descriptions: +**-------------------------------------------------------------------------------------------------------- *********************************************************************************************************/ #include "Global.h" - - - //#include <math.h> - - /****************************************************************************** ** Main Function main() ******************************************************************************/ extern uint32_t CMD_Mode; ////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////// - - int i1 =0; +int i1 =0; //extern unsigned int Buff_QEI[256]; volatile unsigned int IRQ_Counter=0; volatile uint32_t timer1_counter = 0; @@ -48,300 +42,292 @@ void Led_init() { - LPC_PINCON->PINSEL0 = (0x00<<28); - LPC_GPIO1->FIODIR = (0x1<<30); - LPC_PINCON->PINMODE0 = (0x3<<28); - // LPC_GPIO1->FIOSET = (0x0<<30); - // LPC_GPIO0->FIOSET = (1<<4); + LPC_PINCON->PINSEL0 = (0x00<<28); + LPC_GPIO1->FIODIR = (0x1<<30); + LPC_PINCON->PINMODE0 = (0x3<<28); + // LPC_GPIO1->FIOSET = (0x0<<30); + // LPC_GPIO0->FIOSET = (1<<4); } + int flag=0, TIME=0,t=0, Sec=0,tmpSec=0,SEC=0, mSec=0; int tempsec=0; float DACF, K_DAC; + void Led_Blink() { - - if (flag == 0) - { - LPC_GPIO1->FIOSET = (0x1<<30); - flag=1; - } - else - { - flag =0; - LPC_GPIO1->FIOCLR = (0x01<<30); - } + if (flag == 0) { + LPC_GPIO1->FIOSET = (0x1<<30); + flag=1; + } else { + flag =0; + LPC_GPIO1->FIOCLR = (0x01<<30); + } } long LED_TEMP=0; - - - int main (void) { - -{ - K_DAC=65535.0/(65535.0+(deltaDAC+deltaDAC/2)); - K_DAC=0.8; - Main.Firmware_Version=0x15; - Main.GLD_Serial = 0x20; - Main.My_Addres=0; - LightUpCount=1000; - BackLightCount=5000; - secPuls=0; - Pulse_midl = 0; - PulseHalf = 0; - CuruAngle = 0; - Spi.DAC_A=0x7fff; - Spi.DAC_B=0x7fff; - //������������� - SystemInit(); // ������������� ������� - Led_init(); + { + K_DAC=65535.0/(65535.0+(deltaDAC+deltaDAC/2)); + K_DAC=0.8; + Main.Firmware_Version=0x15; + Main.GLD_Serial = 0x20; + Main.My_Addres=0; + LightUpCount=1000; + BackLightCount=5000; + secPuls=0; + Pulse_midl = 0; + PulseHalf = 0; + CuruAngle = 0; + Spi.DAC_A=0x7fff; + Spi.DAC_B=0x7fff; + //������������� + SystemInit(); // ������������� ������� + Led_init(); - ///* - //���������������� ������� ������� - LPC_PINCON->PINSEL0 &= ~(3<<8); //e. P0.4 is GPIO pin (������ ( 00 ) � 9:8 ��� PISEL0 ����� P0.4 ��� GPIO) - LPC_PINCON->PINMODE0 |= (3<<8); //e. P0.4 is GPIO pin (������ ( 11 ) � 9:8 ��� PINMODE0 "��� ��������� �������������� ���������") - LPC_GPIO0->FIODIR |= (1<<4); //e. P0.4 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.4 ��� �����) - LightUpON //e. P0.4 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.4 ������ ������� �������) - /* - LPC_PINCON->PINSEL0 &= ~(3<<10); //e. P0.4 is GPIO pin (������ ( 00 ) � 9:8 ��� PISEL0 ����� P0.4 ��� GPIO) - LPC_PINCON->PINMODE0 |= (3<<10); //e. P0.4 is GPIO pin (������ ( 11 ) � 9:8 ��� PINMODE0 "��� ��������� �������������� ���������") - LPC_GPIO0->FIODIR |= (1<<5); //e. P0.4 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.4 ��� �����) - LPC_GPIO0->FIOCLR |= (1<<5); //e. P0.4 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.4 ������ ������� �������)*/ -/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// + ///* + //���������������� ������� ������� + LPC_PINCON->PINSEL0 &= ~(3<<8); //e. P0.4 is GPIO pin (������ ( 00 ) � 9:8 ��� PISEL0 ����� P0.4 ��� GPIO) + LPC_PINCON->PINMODE0 |= (3<<8); //e. P0.4 is GPIO pin (������ ( 11 ) � 9:8 ��� PINMODE0 "��� ��������� �������������� ���������") + LPC_GPIO0->FIODIR |= (1<<4); //e. P0.4 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.4 ��� �����) + LightUpON //e. P0.4 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.4 ������ ������� �������) + /* + LPC_PINCON->PINSEL0 &= ~(3<<10); //e. P0.4 is GPIO pin (������ ( 00 ) � 9:8 ��� PISEL0 ����� P0.4 ��� GPIO) + LPC_PINCON->PINMODE0 |= (3<<10); //e. P0.4 is GPIO pin (������ ( 11 ) � 9:8 ��� PINMODE0 "��� ��������� �������������� ���������") + LPC_GPIO0->FIODIR |= (1<<5); //e. P0.4 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.4 ��� �����) + LPC_GPIO0->FIOCLR |= (1<<5); //e. P0.4 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.4 ������ ������� �������)*/ +/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// - - LPC_PINCON->PINSEL3 = (0x00<<18); //e. P1.25 is GPIO pin - LPC_PINCON->PINMODE3 |= (3<<18); //e. P1.25 (��������e �������������� ���������") - LPC_GPIO1->FIODIR |= (1<<25); //e. P0.5 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) - LPC_GPIO1->FIOCLR |= (1<<25); - - + + LPC_PINCON->PINSEL3 = (0x00<<18); //e. P1.25 is GPIO pin + LPC_PINCON->PINMODE3 |= (3<<18); //e. P1.25 (��������e �������������� ���������") + LPC_GPIO1->FIODIR |= (1<<25); //e. P0.5 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) + LPC_GPIO1->FIOCLR |= (1<<25); + + ///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// - - LPC_PINCON->PINSEL3 = (0x00<<24); //e. P1.28 is GPIO pin - LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (������ ( 11 ) � ��� PINMODE0 "��� ��������� �������������� ���������") - LPC_GPIO1->FIODIR |= (1<<28); //e. P1.28 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) - LPC_GPIO1->FIOCLR |= (1<<28); -// init_timer(TIME_INTERVAL ); // 10ms - // enable_timer1(); + + LPC_PINCON->PINSEL3 = (0x00<<24); //e. P1.28 is GPIO pin + LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (������ ( 11 ) � ��� PINMODE0 "��� ��������� �������������� ���������") + LPC_GPIO1->FIODIR |= (1<<28); //e. P1.28 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) + LPC_GPIO1->FIOCLR |= (1<<28); +// init_timer(TIME_INTERVAL ); // 10ms +// enable_timer1(); ///������������� ��������� - LPC_PINCON->PINSEL2 = (0x00<<24); //e. P2.12 is GPIO pin - LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (������ ( 11 ) � ��� PINMODE0 "��� ��������� �������������� ���������") - LPC_GPIO2->FIODIR |= (1<<12); //e. P1.28 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) - LPC_GPIO2->FIOCLR |= (1<<12); - + LPC_PINCON->PINSEL2 = (0x00<<24); //e. P2.12 is GPIO pin + LPC_PINCON->PINMODE3 |= (3<<24); //e. P1.28 is GPIO pin (������ ( 11 ) � ��� PINMODE0 "��� ��������� �������������� ���������") + LPC_GPIO2->FIODIR |= (1<<12); //e. P1.28 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) + LPC_GPIO2->FIOCLR |= (1<<12); + +////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// -////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// -/* - //���������������� ������� ������� ��������� ���� (������ �� 80 ���� ������ 81) - LPC_PINCON->PINSEL0 = (0x00<<10); //e. P0.5 is GPIO pin (������ ( 00 ) � 11:10 ��� PISEL0 ����� P0.5 ��� GPIO) - LPC_PINCON->PINMODE0 |= (3<<10); //e. P0.5 is GPIO pin (������ ( 11 ) � 11:10 ��� PINMODE0 "��� ��������� �������������� ���������") - LPC_GPIO0->FIODIR |= (1<<5); //e. P0.5 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) - LPC_GPIO0->FIOCLR |= (1<<5); //e. P0.5 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.5 ������ ������� �������) - */ - DMA_Init(); // ������������� DMA - FlashDMA_Init(); // �������� ���������� � ���� - - SystemCoreClockUpdate(); // ������ ��������� ������� ��� UART. - UARTInit(); // ������������� UART0 �� �������� 38400. - UART1_Init(); // ������������� UART1 �� �������� 38400. - - - DAC_ADC_Exchange_Init(); // ������������� ������ ��� � ���. - DACInit(); // ������������� ���. - SOI_Init(); // ������������� ������������� ��������. - - IntLatch_Init(); // ������������� ���������� �������. - ExtLatch_Init(); // ������������� ������� �������. + /* + //���������������� ������� ������� ��������� ���� (������ �� 80 ���� ������ 81) + LPC_PINCON->PINSEL0 = (0x00<<10); //e. P0.5 is GPIO pin (������ ( 00 ) � 11:10 ��� PISEL0 ����� P0.5 ��� GPIO) + LPC_PINCON->PINMODE0 |= (3<<10); //e. P0.5 is GPIO pin (������ ( 11 ) � 11:10 ��� PINMODE0 "��� ��������� �������������� ���������") + LPC_GPIO0->FIODIR |= (1<<5); //e. P0.5 is output (������ ( 1 ) � 5 ��� FIODIR ����� P0.5 ��� �����) + LPC_GPIO0->FIOCLR |= (1<<5); //e. P0.5 is output (������ ( 1 ) � 5 ��� CLR ������������� �� P0.5 ������ ������� �������) + */ + DMA_Init(); // ������������� DMA + FlashDMA_Init(); // �������� ���������� � ���� + + SystemCoreClockUpdate(); // ������ ��������� ������� ��� UART. + UARTInit(); // ������������� UART0 �� �������� 38400. + UART1_Init(); // ������������� UART1 �� �������� 38400. + -//----------------debug------------------------- - //LPC_GPIO2->FIODIR = 0x5C; // P2.0...P2.7 defined as Outputs - //LPC_GPIO2->FIOCLR = 0x5C; // turn off all the LEDs -//----------------debug------------------------- - + DAC_ADC_Exchange_Init(); // ������������� ������ ��� � ���. + DACInit(); // ������������� ���. + SOI_Init(); // ������������� ������������� ��������. + + IntLatch_Init(); // ������������� ���������� �������. + ExtLatch_Init(); // ������������� ������� �������. - LoadFlashParam(FromFLASH); //�������� ����������. - UART_DMA_Init(); //������������� DMA ��� UART. - G_Photo_Init(); //������������� ���������� I2C ��� �������������. - Out_G_photo(60, 60); //������ � ����� ������� �������� �� ������� ������ (60,60) � ��������� ����� ������ �������� � ������� ����. +//----------------debug------------------------- + //LPC_GPIO2->FIODIR = 0x5C; // P2.0...P2.7 defined as Outputs + //LPC_GPIO2->FIOCLR = 0x5C; // turn off all the LEDs +//----------------debug------------------------- + + + LoadFlashParam(FromFLASH); //�������� ����������. + UART_DMA_Init(); //������������� DMA ��� UART. + G_Photo_Init(); //������������� ���������� I2C ��� �������������. + Out_G_photo(60, 60); //������ � ����� ������� �������� �� ������� ������ (60,60) � ��������� ����� ������ �������� � ������� ����. // WDTInit(); - open_all_loops(); //#define open_all_loops() RgConA = 0 (�������� ������� ���������� ���������� (0 - ��������, 1 - ���������)). - Output.Str.HF_reg = Device_blk.Str.HF_min; //HFO output voltage = ������������ ���������� �� ���. - init_PLC(); //������������� ���(����������� ���������) - init_Dither_reg(); //������������� ������������ - RgConB = RATE_VIBRO_1; // �������������� ������� ���������� = �������� �������������� ����� ������� ������.��������(#define RATE_VIBRO_1 0x0001) - init_Vibro(); - init_timer(TIME_INTERVAL ); // 10ms - enable_timer1(); - Init_TIM2(); - enable_timer2(); - close_all_loops(); - - LPC_GPIO0->FIOCLR = (1<<5); - } - - - Pulse_8Point = 0; - Pulse_16Point = 0; - Pulse_32Point = 0; + open_all_loops(); //#define open_all_loops() RgConA = 0 (�������� ������� ���������� ���������� (0 - ��������, 1 - ���������)). + Output.Str.HF_reg = Device_blk.Str.HF_min; //HFO output voltage = ������������ ���������� �� ���. + init_PLC(); //������������� ���(����������� ���������) + init_Dither_reg(); //������������� ������������ + RgConB = RATE_VIBRO_1; // �������������� ������� ���������� = �������� �������������� ����� ������� ������.��������(#define RATE_VIBRO_1 0x0001) + init_Vibro(); + init_timer(TIME_INTERVAL ); // 10ms + enable_timer1(); + Init_TIM2(); + enable_timer2(); + close_all_loops(); - Temp_AMP=0; - Temp_ADC_2=0; - Temp_ADC_3=0; - Temp_ADC_4=0; - Temp_ADC_5=0; - + LPC_GPIO0->FIOCLR = (1<<5); + } + - -for (y = 0; y < 256; y++ ) - { - Buff_16Point [y] = 0xffff; - Buff_8Point [y] = 0xffff; - Buff_32Point [y] = 0xffff; - Buff_ADC_1 [y] = 0;// ���� ���. - Buff_ADC_2 [y] = 0; - Buff_ADC_3 [y] = 0; - Buff_ADC_4 [y] = 0; - Buff_ADC_5 [y] = 0; - - } - - + Pulse_8Point = 0; + Pulse_16Point = 0; + Pulse_32Point = 0; -SendToBuffStr ("\n\r ....... "); -OutBufConCount =0; - WriteCon("\n\r ...WriteCon1.... "); - do //�������� ����. - { - + Temp_AMP=0; + Temp_ADC_2=0; + Temp_ADC_3=0; + Temp_ADC_4=0; + Temp_ADC_5=0; - if (OutBufConCount) OutBufConCount--; - Concol (); - // Concol1 (); - Read_CMD(); - - // VibroOut(); + - - if(Time_1kHz>100) - { - - SEC++; - if(Rate_Flag==1&&SEC>500) - { - SEC-=500; - CMD_Rate(); - } - - Time_1kHz-=100; - if(LightUpCount){LightUpCount--;LightUpON} - - else - { - LightUpOFF; - } - if(BackLightCount){BackLightCount--;BackLightON} - else - { - BackLightOFF; - } - } - ButtonLightUP(); - //Device_blk.Str. - TakeFromBuff(); - - //���������� �������. - - // paramV=TakeParam(1); + for (y = 0; y < 256; y++ ) { + Buff_16Point [y] = 0xffff; + Buff_8Point [y] = 0xffff; + Buff_32Point [y] = 0xffff; + Buff_ADC_1 [y] = 0;// ���� ���. + Buff_ADC_2 [y] = 0; + Buff_ADC_3 [y] = 0; + Buff_ADC_4 [y] = 0; + Buff_ADC_5 [y] = 0; - + } - if (LPC_PWM1->IR & 0x0001) // ���� � �������� ���������� ���1 (������� PWM1IR) ���� ���� ���������� ���������� �������� � ����� (lim0 ?) ��: - { - /* ResetCS(ADC); //prepare ADC for sampling - SetDAC(DAC); - LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED - LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED - LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED - SetCS(ADC); //start ADC sampling - ResetDAC(DAC); //start DAC prepearing for writing + SendToBuffStr ("\n\r ....... "); + OutBufConCount =0; + WriteCon("\n\r ...WriteCon1.... "); + do { //�������� ����. + + + if (OutBufConCount) OutBufConCount--; + Concol (); +// Concol1 (); + Read_CMD(); + + // VibroOut(); + + + if(Time_1kHz>100) { + + SEC++; + if(Rate_Flag==1&&SEC>500) { + SEC-=500; + CMD_Rate(); + } + + Time_1kHz-=100; + if(LightUpCount) { + LightUpCount--; + LightUpON + } -*/ + else { + LightUpOFF; + } + if(BackLightCount) { + BackLightCount--; + BackLightON + } else { + BackLightOFF; + } + } + ButtonLightUP(); + //Device_blk.Str. + TakeFromBuff(); + + //���������� �������. + + // paramV=TakeParam(1); + + + + + + if (LPC_PWM1->IR & 0x0001) { // ���� � �������� ���������� ���1 (������� PWM1IR) ���� ���� ���������� ���������� �������� � ����� (lim0 ?) ��: + /* ResetCS(ADC); //prepare ADC for sampling + SetDAC(DAC); + LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED + LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED + LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED + SetCS(ADC); //start ADC sampling + ResetDAC(DAC); //start DAC prepearing for writing + + */ +////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// -////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// - + + + secPuls++; + tmpSec++; + mSec++; - secPuls++; - tmpSec++; - mSec++; - - i1++; - if(i1>10000) - //if(CountV31>30) - { - i1=0; - /* - SendToBuffStr("\n\r"); - // if (Buff_ADC_1 [y] > 65535)SendToBuffStr(" 0 "); else SendToBuffStr(" 1 "); - 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); - // sprintf (BuffTemp,"<%07d> <%07d> <%07d> <%07d> <%07d>", Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5); - SendToBuffStr(BuffTemp); - */ - /* - WriteConByte (Main.T_Vib&0xff00); - WriteConByte (Main.T_Vib&0x00ff); - WriteConByte (Main.T_Vib); - */ - /* + i1++; + if(i1>10000) + //if(CountV31>30) + { + i1=0; + /* + SendToBuffStr("\n\r"); + // if (Buff_ADC_1 [y] > 65535)SendToBuffStr(" 0 "); else SendToBuffStr(" 1 "); + 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); + // sprintf (BuffTemp,"<%07d> <%07d> <%07d> <%07d> <%07d>", Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5); + SendToBuffStr(BuffTemp); + */ + /* + WriteConByte (Main.T_Vib&0xff00); + WriteConByte (Main.T_Vib&0x00ff); + WriteConByte (Main.T_Vib); + */ + /* + + for (y = 0; y < 32; y++ ) + { + + WriteCon(BuffTemp); + } WriteCon("\n\r"); - for (y = 0; y < 32; y++ ) - { - - WriteCon(BuffTemp); - } WriteCon("\n\r"); - - */ -/* -Main.T_Vib=((7680000*16/Main.Frq)*4096); - th= Main.T_Vib&0xff00; - tt= Main.T_Vib&0x00ff; - sprintf(BuffTemp,"<%07d >",( (Main.T_Vib&0xff00))); - SendToBuffStr(BuffTemp); - - sprintf(BuffTemp,"<%07d >",( ( Main.T_Vib&0x00ff))); - SendToBuffStr(BuffTemp); - /* - CuruAngleOld=CuruAngle;*/ - // Spi.ADC1=Spi.ADC1*0.000061; - - - - - /* - - sprintf(BuffTemp,"\n\r<%05d><%05d><%05d><%05d><%05d>",Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5); - SendToBuffStr(BuffTemp); - - */ - - /* sprintf(BuffTemp,"<%d>",(FrecTemp)); - SendToBuffStr(BuffTemp); - for (y = 0; y < 32; y++ ) - { - sprintf(BuffTemp," <%07d>", (Buff_16PointD [y]-65535)); - SendToBuffStr(BuffTemp); - } */ - } - - - - + */ + /* + Main.T_Vib=((7680000*16/Main.Frq)*4096); + th= Main.T_Vib&0xff00; + tt= Main.T_Vib&0x00ff; + sprintf(BuffTemp,"<%07d >",( (Main.T_Vib&0xff00))); + SendToBuffStr(BuffTemp); + + sprintf(BuffTemp,"<%07d >",( ( Main.T_Vib&0x00ff))); + SendToBuffStr(BuffTemp); + /* + CuruAngleOld=CuruAngle;*/ + // Spi.ADC1=Spi.ADC1*0.000061; + + + + + /* + + sprintf(BuffTemp,"\n\r<%05d><%05d><%05d><%05d><%05d>",Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5); + SendToBuffStr(BuffTemp); + + */ + + /* sprintf(BuffTemp,"<%d>",(FrecTemp)); + SendToBuffStr(BuffTemp); + for (y = 0; y < 32; y++ ) + { + sprintf(BuffTemp," <%07d>", (Buff_16PointD [y]-65535)); + SendToBuffStr(BuffTemp); + } */ + } + + + + @@ -352,51 +338,51 @@ - - LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED + + LPC_GPIO2->FIOSET |= 0x0000004; // turn on the LED + - - Curr_Cnt_Vib = LPC_QEI->POS; // �������� � ���������� Curr_Cnt_Vib ������� ��������� ��������. (������� ���������� ���������) - Latch_Event(); //����������� ������� - - clc_Pulses(); // ������� ���������. RATE_REPER_OR_REFMEANDR ��� RATE_VIBRO_1 - - - //ADC_Input(); // �������� ������ ���������� ������ � ������� Thermo1, Thermo2, HF_out � ����� Input.ArrayIn[n]. - //DAC_ADC_Exchange();// �������� ������ ���������� ������ � ����� � ����. - ServiceTime();//��������� ������. - clc_ThermoSensors();//������ ������� ����������� �� ������� - clc_HFO(); //������ �������� ��� �������� � ������ ���(�� ���). - clc_PLC(); - // clc_Dith_regulator(); - clc_OutFreq_regulator(); - Output.Str.WP_sin = clc_WP_sin(); - contrl_GLD(); - G_Photo_Exchange(); - // Output.Str.T_Vibro = paramV*48; + Curr_Cnt_Vib = LPC_QEI->POS; // �������� � ���������� Curr_Cnt_Vib ������� ��������� ��������. (������� ���������� ���������) + Latch_Event(); //����������� ������� + + clc_Pulses(); // ������� ���������. RATE_REPER_OR_REFMEANDR ��� RATE_VIBRO_1 - Line_1_Rcv(); - decode_CMD(); - transm_DAT(); + //ADC_Input(); // �������� ������ ���������� ������ � ������� Thermo1, Thermo2, HF_out � ����� Input.ArrayIn[n]. + //DAC_ADC_Exchange();// �������� ������ ���������� ������ � ����� � ����. + ServiceTime();//��������� ������. + clc_ThermoSensors();//������ ������� ����������� �� ������� + clc_HFO(); //������ �������� ��� �������� � ������ ���(�� ���). + clc_PLC(); + // clc_Dith_regulator(); + clc_OutFreq_regulator(); + Output.Str.WP_sin = clc_WP_sin(); + contrl_GLD(); + G_Photo_Exchange(); + // Output.Str.T_Vibro = paramV*48; - + + Line_1_Rcv(); + decode_CMD(); + transm_DAT(); + + // data_Rdy &= ~RESET_PERIOD; -LPC_PWM1->IR = 0x0001; //e. clear interrupt flag + LPC_PWM1->IR = 0x0001; //e. clear interrupt flag -LPC_GPIO2->FIOCLR |= 0x0000004; // turn off the LED + LPC_GPIO2->FIOCLR |= 0x0000004; // turn off the LED // WDTFeed(); - - + + //SPI_Exchange(); - - } - - } while ( 1 ); // main infinie loop + + } + + } while ( 1 ); // main infinie loop } /******************************************************************************