Diff: Global.c

Revision:

214:4c70e452c491

Parent:

211:ac8251b067d2

Child:

215:b58b887fd367

--- a/Global.c	Wed Jul 26 13:24:39 2017 +0000
+++ b/Global.c	Wed Aug 16 09:00:25 2017 +0000
@@ -10,6 +10,7 @@
 unsigned int 	Event250Hz;
 unsigned int 	Event500Hz;
 unsigned int 	Event1K;
+unsigned int 	Event1250Hz;
 unsigned int 	Event2K;
 unsigned int 	Event100K;
 unsigned int 	EventVibro;
@@ -19,6 +20,7 @@
 
 unsigned int 	Time100K;
 unsigned int 	Time1K;
+unsigned int 	Time1250Hz;
 unsigned int 	Time2K;
 unsigned int 	Time500Hz;
 unsigned int 	Time250Hz;
@@ -47,6 +49,7 @@
     Time_UART	= 0;
     Time_Sec	= 0;
     Time_vibro	= 0;
+    Time1250Hz  = 0;
     Time_1kHz   = 0;
     Event1Hz 	= 0;
     Event1K 	= 0;
@@ -118,8 +121,8 @@
                 Gyro.PLC_Phase          = GyroP.Str.PLC_Phase;
     			Gyro.ModAmp				= GyroP.Str.ModAmp;
                 Gyro.FrqPhase			= GyroP.Str.FrqPhase;
-    			Gyro.AmpPer				= GyroP.Str.AmpPer;
-    			Gyro.Amp    			= GyroP.Str.AmpPer<<16;
+    			Gyro.AmpPer				= 700;//GyroP.Str.AmpPer*100;
+    			Gyro.Amp    			=(GyroP.Str.AmpPer<<17);
     		    Gyro.AmpSpeed 			= GyroP.Str.AmpSpeed;
     			Gyro.AmpPerDel			= GyroP.Str.AmpPerDel;
     			temp=((GyroP.Str.VB_Fdf_Hi<<16) | GyroP.Str.VB_Fdf_Lo);
@@ -129,8 +132,14 @@
     			Gyro.AmpPerMax 			= GyroP.Str.AmpPerMax;
     			Gyro.AmpMin 			= GyroP.Str.AmpMin;
     			Gyro.AmpTD  			= GyroP.Str.AmpTD;
-    			
-               
+    		    F_vib=(103200000<<5)/((Gyro.Frq)>>10);//периуд вибро.
+                T_vibP = F_vib/10000;
+                T_vib_1 = Gyro.AmpPer * T_vibP;
+        	 	T_vib_2 = T_vibP * (10000-Gyro.AmpPer);
+        LPC_MCPWM->LIM1 = F_vib;
+        LPC_MCPWM->LIM2 = F_vib;
+        LPC_MCPWM->MAT1 =  T_vib_1;
+        LPC_MCPWM->MAT2 =  T_vib_2;
                 if(Gyro.LG_Type==1){ 
                  Gyro.HFO_Max=((int)(GyroP.Str.DAC_current_Work*0.67)-2000);
                  Gyro.HFO_Min=((int)(GyroP.Str.DAC_current_Start*0.67)-2000);
@@ -189,6 +198,15 @@
     Gyro.DAC_current_Work	=50000;							//3
 	Gyro.DAC_current_Start	=41000;      
 
+
+		    F_vib=(103200000<<5)/((Gyro.Frq)>>10);//периуд вибро.
+                T_vibP = F_vib/10000;
+                T_vib_1 = Gyro.AmpPer * T_vibP;
+        	 	T_vib_2 = T_vibP * (10000-Gyro.AmpPer);
+        LPC_MCPWM->LIM1 = F_vib;
+        LPC_MCPWM->LIM2 = F_vib;
+        LPC_MCPWM->MAT1 =   T_vib_1;
+        LPC_MCPWM->MAT2 =  T_vib_2;
     }
   	Spi.DAC_B=Gyro.PLC_Start;
     switch(Gyro.My_Addres){//смещение поджига и подсветки в зависимости от адреса ГЛД
@@ -238,10 +256,18 @@
 }
 
 void GLD_Init(void)
-{    int Dummy; // инициализация мусорки для очистки буфера приема.
+{    
+				int Dummy; // инициализация мусорки для очистки буфера приема.
+              
+
+
+
+
+
     /////////////////////////////////////////////////////
     /////////////инициализация энкодера//////////////////
     /////////////////////////////////////////////////////
+    
     LPC_SC->PCONP |= (1<<18);//0x00040000;		включение квадратурного энкодера.
     LPC_SC->PCLKSEL1 |= 0x00000001;	   // выбор частоты для кв.э. CLK=103MHz
     LPC_PINCON->PINSEL3 &= ~0x4100;
@@ -252,7 +278,7 @@
     LPC_QEI->MAXPOS = MAX_QEI_CNT;	//LPC_QEI->"регистор максимального положения" = 2147483646
     LPC_QEI->FILTER = 2;		    // фильтр( ?? )
     LPC_QEI->CON = 0xF;				//сбросить в ноль все счетчики кв.э. (скорость, направление, позицию и тд)
-    LPC_QEI->CONF = (0<<2) |(0<<1);	//Quadrature inputs, no inverting,only A pulses are counted
+    LPC_QEI->CONF = (1<<2) |(0<<1);	//Quadrature inputs, no inverting,only A pulses are counted
 
     LPC_QEI->CLR = 0x1fff; 			 //r. сбросить все прерывания
     LPC_QEI->IEC = 0x1fff;			 //r. запретить прерывание при изменении направления
@@ -365,7 +391,7 @@
     /////////////////////////////////////////////////////
     
     LPC_PINCON->PINSEL0  &= ~(0x00<<28);
-    LPC_PINCON->PINSEL0  |=  (0x00<<28);   // а нужно, ведь по умолчаниб у них 0 функция. попробоввать без них потом убрать
+    LPC_PINCON->PINSEL0  |=  (0x00<<28);   
     LPC_PINCON->PINMODE0 |=  (0x3<<28);
     LPC_GPIO1->FIODIR    |=  (1<<30);
     /////////////////////////////////////////////////////