123
Fork of LG by
host/Source/App/main.c
- Committer:
- Kovalev_D
- Date:
- 2016-02-03
- Revision:
- 22:12e6183f04d4
File content as of revision 22:12e6183f04d4:
/****************************************Copyright (c)**************************************************** **--------------File Info--------------------------------------------------------------------------------- ** File name: main.c ** Last modified Date: 2011-10-24 ** Last Version: V1.00 ** Descriptions: The main() function ** **-------------------------------------------------------------------------------------------------------- ** Created by: Electrooptica Incorp. ** Created date: 2011-08-22 ** Version: V1.00 ** Descriptions: **-------------------------------------------------------------------------------------------------------- *********************************************************************************************************/ #include "SIP.h" #include "el_lin.h" #include "CyclesSync.h" #include "Parameters.h" #include "Dither_Reg.h" #include "commandset.h" #include "CntrlGLD.h" #include "InputOutput.h" #include <math.h> #include "stdlib.h" #include "console.h" #include "vibro.h" #include "QEI.h" #include "MTimer.h" #include "Global.h" #include "SPI.h" #include "uart_m.h" #include "command.h" #include "Global.h" ///ÕÅÐÍß /****************************************************************************** ** Main Function main() ******************************************************************************/ extern uint32_t CMD_Mode; ////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////// int i1 =0; //extern unsigned int Buff_QEI[256]; volatile unsigned int IRQ_Counter=0; volatile uint32_t timer1_counter = 0; int temp111=0,temp=0; int y = 0; int CuruAngleOld=0; unsigned int LightUpCount,BackLightCount,secPuls,CountBI,CmmandIn,tt,th; unsigned int paramV; 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); } 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); } } 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(); ///* //êîíôèãóðèðîâàíèå ñèãíàëà ïîäæèãà 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<<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); ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// /* //êîíôèãóðèðîâàíèå ñèãíàëà ïîäæèãà îòîðâàíàÿ íîãà (ïîäæèã íà 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(); // èíèöèàëèçàöèÿ âíåøíåé çàùåëêè. //----------------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; Temp_AMP=0; Temp_ADC_2=0; Temp_ADC_3=0; Temp_ADC_4=0; Temp_ADC_5=0; 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; } 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++; 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"); */ /* 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); } */ } ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// 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; Line_1_Rcv(); decode_CMD(); transm_DAT(); // data_Rdy &= ~RESET_PERIOD; LPC_PWM1->IR = 0x0001; //e. clear interrupt flag LPC_GPIO2->FIOCLR |= 0x0000004; // turn off the LED // WDTFeed(); //SPI_Exchange(); } } while ( 1 ); // main infinie loop } /****************************************************************************** ** End Of File ******************************************************************************/