Dmitry Kovalev
forkd
Fork of
LG2
by 
Dmitry Kovalev
Diff: host/Source/App/main.c
- Revision:
- 23:12e6183f04d4
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/host/Source/App/main.c Wed Feb 03 10:44:42 2016 +0300
@@ -0,0 +1,415 @@
+/****************************************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
+******************************************************************************/
+