fork

Dependencies:   mbed

Fork of LG by igor Apu

Revision:
98:95b8e79f13e1
Parent:
96:1c8536458119
Child:
99:3d8f206ceac2
--- a/Global.c	Mon Mar 28 15:32:21 2016 +0000
+++ b/Global.c	Tue Mar 29 09:51:17 2016 +0000
@@ -57,7 +57,7 @@
     ///////////расчета значений буферов ВП///////////////
     /////////////////////////////////////////////////////
     /////////////инициализация переменных в структ вибро/////////////////
-    Gyro.FrqHZ=449;
+    Gyro.FrqHZ=250;
     Gyro.Frq = Gyro.FrqHZ<<16;
     Gyro.AmpPer=20;
     Gyro.AmpPerDel=10;
@@ -168,6 +168,7 @@
     LPC_PINCON->PINSEL3 |= 0x4100;	  //P1.20, p1.23 установить как входы кв.э
     LPC_PINCON->PINMODE3 |= 0x3C300;	  //P1.20, p1.23 
 
+ 
     LPC_QEI->MAXPOS = MAX_QEI_CNT;	//LPC_QEI->"регистор максимального положения" = 2147483646
     LPC_QEI->FILTER = 2;		    // фильтр( ?? )
     LPC_QEI->CON = 0xF;				//сбросить в ноль все счетчики кв.э. (скорость, направление, позицию и тд)
@@ -176,8 +177,8 @@
     LPC_QEI->CLR = 0x1fff; 			 //r. сбросить все прерывания
     LPC_QEI->IEC = 0x1fff;			 //r. запретить прерывание при изменении направления
 
-    NVIC_SetPriority(QEI_IRQn, 0);
-    NVIC_EnableIRQ(QEI_IRQn);
+  /*NVIC_SetPriority(QEI_IRQn, 0);
+  NVIC_EnableIRQ(QEI_IRQn);*/
     //////////////////////////////////////////////////////
     //////////////////////////////////////////////////////
 
@@ -276,8 +277,10 @@
     /////////////////////////////////////////////////////
     //////////////отладочный светодиод///////////////////
     /////////////////////////////////////////////////////
-    LPC_PINCON->PINSEL0 = (0x00<<28);   // а нужно, ведь по умолчаниб у них 0 функция. попробоввать без них потом убрать
-    LPC_PINCON->PINMODE0 = (0x3<<28);
+    
+    LPC_PINCON->PINSEL0  &= ~(0x00<<28);
+    LPC_PINCON->PINSEL0  |= (0x00<<28);   // а нужно, ведь по умолчаниб у них 0 функция. попробоввать без них потом убрать
+    LPC_PINCON->PINMODE0 |= (0x3<<28);
     LPC_GPIO1->FIODIR   |= (1<<30);
     /////////////////////////////////////////////////////
     /////////////////////////////////////////////////////
@@ -295,8 +298,8 @@
     /////////////////////////////////////////////////////
     ///////////////////////поджиг////////////////////////
     /////////////////////////////////////////////////////
-    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_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 как выход)
     /////////////////////////////////////////////////////
     /////////////////////////////////////////////////////
@@ -306,14 +309,16 @@
     /////////////////////////////////////////////////////
     /////////////////////вибро 1/////////////////////////
     /////////////////////////////////////////////////////
-    LPC_PINCON->PINSEL3   = (0x00<<18);       //e. P1.25 is GPIO pin
+    LPC_PINCON->PINSEL3  &= ~(0x00<<18);       //e. P1.25 is GPIO pin
+    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);
     //////////////////////////////////////////////////////
     //////////////////////вибро 2/////////////////////////
     //////////////////////////////////////////////////////
-    LPC_PINCON->PINSEL3   = (0x00<<24);       //e. P1.28 is GPIO pin
+    LPC_PINCON->PINSEL3   &= ~(0x00<<24);       //e. P1.28 is GPIO pin
+    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);
@@ -325,7 +330,8 @@
     /////////////////////////////////////////////////////
     /////////////инициализация подсветки/////////////////
     /////////////////////////////////////////////////////
-    LPC_PINCON->PINSEL2   = (0x00<<24);     //e. P2.12 is GPIO pin
+    LPC_PINCON->PINSEL2   &= ~(0x00<<24); 
+    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);