fork

Dependencies:   mbed

Fork of LG by igor Apu

Revision:
30:17c84ed091b3
Parent:
29:f9174eac3dee
Child:
31:c783288001b5
--- a/main.c	Fri Feb 05 08:02:55 2016 +0000
+++ b/main.c	Fri Feb 05 23:21:54 2016 +0000
@@ -12,6 +12,9 @@
 ** Version:             V1.00
 ** Descriptions:
 **--------------------------------------------------------------------------------------------------------
+последнии изменения
+//2016_02_03_17_47
+//2016_02_06
 *********************************************************************************************************/
 
 
@@ -20,14 +23,6 @@
 
 
 
-
-//проба верси
-//2016_02_03_17_47
-
-
-
-
-
 /******************************************************************************
 **   Main Function  main()
 ******************************************************************************/
@@ -35,13 +30,12 @@
 //////////////////////////////////////////////////////////////////////////////////////////////////////////
 //////////////////////////////////////////////////////////////////////////////////////////////////////////
 int i1 =0;
-//extern unsigned int Buff_QEI[256];
-volatile unsigned int IRQ_Counter=0;
-volatile uint32_t timer1_counter = 0;
+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  secPuls,CountBI,CmmandIn,tt,th;
 
 unsigned int paramV;
 
@@ -81,80 +75,79 @@
     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;
+    Gyro.Firmware_Version	=0x15;
+    Gyro.GLD_Serial 		= 0x20;
+    Gyro.My_Addres			= 0;
+
+    secPuls =0;
     Pulse_midl = 0;
     PulseHalf = 0;
     CuruAngle = 0;
-    Spi.DAC_A=0x7fff;
+    Spi.DAC_A = 0x7fff;
     Spi.DAC_B = 0x7fff;
     //инициализация
-  SystemInit();  // Инициализация системы
-  Led_init();
+    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.
+
+
+    DAC_ADC_Exchange_Init();  // инициализация  обмена АЦП и ЦАП.
+    DACInit();                // инициализация ЦАП.
+    SOI_Init(); 			      	// Инициализация квадратурного энкодера.
+
+    IntLatch_Init();			// инициализация внутренней защелки.
+    ExtLatch_Init();			// инициализация внешней защелки.
 
 //----------------debug-------------------------
     //LPC_GPIO2->FIODIR = 0x5C;		// P2.0...P2.7 defined as Outputs
@@ -170,11 +163,11 @@
 //  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)
+    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
@@ -295,20 +288,10 @@
             }
 
             Time_1kHz-=100;
-            if(LightUpCount) {
-                LightUpCount--;
-                LightUpON
-            }
 
-            else {
-                LightUpOFF;
-            }
-            if(BackLightCount) {
-                BackLightCount--;
-                BackLightON
-            } else {
-                BackLightOFF;
-            }
+           
+            
+ 
         }
         ButtonLightUP();
         //Device_blk.Str.
@@ -351,9 +334,9 @@
                 	SendToBuffStr(BuffTemp);
                 */
                 /*
-                WriteConByte (Main.T_Vib&0xff00);
-                WriteConByte (Main.T_Vib&0x00ff);
-                WriteConByte (Main.T_Vib);
+                WriteConByte (Gyro.T_Vib&0xff00);
+                WriteConByte (Gyro.T_Vib&0x00ff);
+                WriteConByte (Gyro.T_Vib);
                 */
                 /*
 
@@ -365,13 +348,13 @@
 
                 */
                 /*
-                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)));
+                Gyro.T_Vib=((7680000*16/Gyro.Frq)*4096);
+                         th=   Gyro.T_Vib&0xff00;
+                         tt=   Gyro.T_Vib&0x00ff;
+                            sprintf(BuffTemp,"<%07d  >",( (Gyro.T_Vib&0xff00)));
                 						SendToBuffStr(BuffTemp);
 
-                						sprintf(BuffTemp,"<%07d  >",( ( Main.T_Vib&0x00ff)));
+                						sprintf(BuffTemp,"<%07d  >",( ( Gyro.T_Vib&0x00ff)));
                 						SendToBuffStr(BuffTemp);
 
                 						CuruAngleOld=CuruAngle;*/