Diff: SPI.c

Revision:

202:c03b7b128e11

Parent:

201:76f4123bf22a

--- a/SPI.c	Wed Nov 02 14:05:24 2016 +0000
+++ b/SPI.c	Fri Nov 18 06:07:37 2016 +0000
@@ -2,16 +2,15 @@
 struct SPI Spi;
 //unsigned int Temp_AMP;
 unsigned int Temp_AMP64P;
-int ttt=1;
+int TempShift=1;
 unsigned int Count_AMP, ADD_AMP, Cur_Amp;
-int Znak_Amp;
 int AD_Regul = 0;
 int temp9,tempADC5;
 int AD_MAX=0;
-int k=0,l=0,r=0,n=0;//счетчики для регулировки периметра
+int k=0,l=0,r=0;//счетчики для регулировки периметра
 int flagmod=0,Bdelta;
 int start=1;
-int dispersion=0,side=1,tempstrafe=15000;
+int flagPLC=0,templm=0;
 unsigned int Temp_ADC_2;
 unsigned int Temp_ADC_3;
 unsigned int Temp_ADC_4;
@@ -19,7 +18,7 @@
 unsigned int TempA;
 unsigned int TempTermLM;
 
-int ADC5Old,ADCDIF=0;
+int ADC5Old,ADCDIF=0,ADCDIFconsol=0;
 int DACModReg;
 int SinPls=0,SinMns=0;
 unsigned int ADC5New;
@@ -47,7 +46,6 @@
 unsigned int TypeMod=0;
 unsigned int ModArraySin	  [64] = {50,55,59,64,68,73,77,81,85,88,91,94,96,98,99,99,100,99,99,98,96,94,91,88,85,81,77,73,68,64,59,55,50,45,41,36,32,27,23,19,16,12,9,7,4,2,1,1,0,1,1,2,4,7,9,12,16,19,23,27,32,36,41,45};
 unsigned int ModArrayTriangle [64];
-unsigned int ModArraySaw	  [64];
 unsigned int Mod=0;                                           
 
 void InitMOD(void)
@@ -57,48 +55,53 @@
    	 if(i<32)   { ModArrayTriangle[i]=Mod; Mod+=3;}
    	 else       { ModArrayTriangle[i]=Mod; Mod-=3;}
      }
-    
-     for (int i = 0; i < 64; i++ ) 
- 	 { 
-      ModArraySaw[i]=Mod;
-      Mod+=2;
-     }
 }
 void Modulator(void)
 {
 	switch(TypeMod) 
 		{
 	    case 0: LPC_DAC->DACR = (ModArraySin		[CountV64]*Gyro.ModAmp);    break;
-	    case 1: LPC_DAC->DACR = (ModArraySaw		[CountV64]*Gyro.ModAmp);  	break;
 	    case 2: LPC_DAC->DACR = (ModArrayTriangle	[CountV64]*Gyro.ModAmp);  	break;
 	    }
 }
 void  PLCRegul(void)
 {
- 
- if (CountV64 == 63) 
-        {
-          for (int i = 0; i < 32; i++ )
-                {
-                	SinPls+=  BuffADC_64Point[i];
-                }
-           for (int i = 32; i < 64; i++ )
-                {
-                	SinMns+=  BuffADC_64Point[i];
-                }
-        ADCDIF = SinPls - SinMns;    
-  	
-       /* if(ADCDIF>0) Spi.DAC_B-=3;
-        else Spi.DAC_B+=3;*/
-        Spi.DAC_B -= ADCDIF>>7;
-        if      ( Spi.DAC_B < 15300 )	Spi.DAC_B = 32000;            //проверка на переваливание за границу.  
-        else if ( Spi.DAC_B > 53000 ) 	Spi.DAC_B = 32000;
-
-      /*sprintf((Time),"%d %d %d %d %d \r\n", SinPls, SinMns, Gyro.Start, Gyro.Termo, Spi.DAC_B);//выдаем в терминал для постройки граффика регулировки периметра.
-          WriteCon(Time);*/
-   		SinPls=0;
-   		SinMns=0;
+ if(Gyro.Start==200)
+ 	{//           +25 С°
+ 	  if(flagPLC==0)
+ 	    {  //Spi.DAC_B=32767;
+    		templm = (Gyro.TermoNKU-Gyro.Termo); //дельта температуры от нку
+      		Spi.DAC_B+=templm; //сдвиг начальной точки цап
+    		flagPLC=1;//выставка флага для начала регулирования
+    	}
+    }
+   if(Gyro.LogPLC)//Gyro.LogPLC=1-без выдачи, 2 - с выдачей, 0 - дисперсионка.
+    {
+ 	  if(flagPLC)
+ 		{
+ 			if (CountV64 == 63) //прошло 2 такта виброподвеса 200Hz
+       			 {
+	        	  for (int i = 0; i < 31; i++ )//считаем сумму амплитуд по положительной полуволне
+	           	      {
+	           			SinPls+=  BuffADC_64Point[i];
+	               	  }
+			      for (int i = 32; i < 63; i++ )
+	           		  {
+			        	SinMns+=  BuffADC_64Point[i];//по отрицательной полуволне
+			          }		
+       			  ADCDIF = SinPls - SinMns;    // разница между полуволнами
+/* if(ADCDIF>0) Spi.DAC_B-=3;
+else Spi.DAC_B+=3;*/
+    			  Spi.DAC_B -= ADCDIF>>9;// регулировка периметра в зависимости от величины разници двух полуволн.
+       			  ADCDIFconsol+=ADCDIF>>9;
+       			 
+       			  if      ( Spi.DAC_B < 15300 )	Spi.DAC_B = 32000;            //проверка на переваливание за границу.  
+        		  else if ( Spi.DAC_B > 53000 ) Spi.DAC_B = 32000;
+   				  SinPls=0;
+   				  SinMns=0;
+                 }
         }
+     }   
 }
 
 
@@ -138,16 +141,16 @@
 void SPI_Exchange(void)  // новая функция чтения, в нецй не должно быть ничего лишнего
 { 
     unsigned int DummySPI;
-  /*  
-    if(Gyro.Start>2000) DummySPI = LPC_SSP0->DR;*/
-    //unsigned int ADC5Dif;
-    
+ 
+  //  BackLightON
     ADC5New = LPC_SSP0->DR;// Чтение АЦП
   //Spi.ADC5_Accum += LPC_SSP0->DR;
     Spi.ADC4_Accum += LPC_SSP0->DR;
     Spi.ADC3_Accum += LPC_SSP0->DR;
     Spi.ADC2_Accum += LPC_SSP0->DR;
     Spi.ADC1_Accum += LPC_SSP0->DR;
+    
+    
     Spi.ADC5_Accum += ADC5New;	
    
        
@@ -155,6 +158,7 @@
     DummySPI = LPC_SSP0->DR;   //если буфер SPI не пуст.//очистить буфер.
     }
     DAC_OutPut();
+    
     if (CountV31 == 0) {						// просто фильтруем по 32 точкам.
          										// выставояем бит, что есть новы данные
         Spi.ADC1 = Spi.ADC1_Accum >> 5;			// подгоотавливаем данные (в той эе сетке) те 	 ADC1  0..65535
@@ -172,8 +176,33 @@
         BuffADC_64Point[CountV64]=ADC5New;
         Buff_ADC_5[CountV255] = (0x7fff-ADC5New)<<2;
         PLCRegul();
+      // BackLightOFF
 }
 
+
+void ShowMod(void)//технологическая функция для просмотра в ориджине мод на всем диапазпне цап
+{
+	
+    //////////////////////////////////////////////////////////////////////////////////////////////////
+    //////////////////////////////////смотрим все моды/////////////////////////////////////////////////
+    ///////////////////////////////////////////////////////////////////////////////////////////////////
+   
+      if( (Gyro.PLC_Lern<60000)&&(Gyro.PLC_Error2Mode >1))//пробигаем по нескольким значениям цап(60*0х3с=0хВВ8) для определения максимальной амплитуды.
+        {
+          Gyro.PLC_Error2Mode--;
+          Gyro.PLC_Lern++;
+          Spi.DAC_B += 40;
+        } 
+      else {Gyro.LogPLC=1;}  
+     
+      sprintf((Time),"%d %d %d %d \r\n", Gyro.CuruAngle, Spi.DAC_B, Gyro.AD_Slow, Gyro.Termo);
+      Gyro.CuruAngle=0;
+      WriteCon(Time);
+}
+
+
+
+/*
 void ShowMod(void)//технологическая функция для просмотра в ориджине мод на всем диапазпне цап
 {
 	
@@ -199,9 +228,7 @@
       Gyro.CuruAngle=0;
       WriteCon(Time);
 }
-
-
-
+*/
 
 
 void PlcRegul(void)		
@@ -213,13 +240,13 @@
     int tempDac;
     if(start<=5)
     {
-    	if(ttt)
+    	if(TempShift)
     	{//           +25 С°
     	templm = (Gyro.TermoNKU-Gyro.Termo); //дельта 
     	if(templm>0) Gyro.Ktermo=1;
     	else Gyro.Ktermo=0;
     	Spi.DAC_B+=templm;
-    	ttt=0;
+    	TempShift=0;
     	}
     }
  
@@ -333,13 +360,13 @@
     //////////лог//////////
     ///////////////////////
     if(Gyro.LogPLC==1) {
-       // LoopOn
+
         sprintf((Time),"%d %d  %d %d %d %d %d %d %d \r\n",Gyro.CuruAngle, Gyro.Frq, Gyro.MaxAmp, Spi.DAC_B, tempDac,  flagmod, AD_MAX, PLC_In, Gyro.Termo);//выдаем в терминал для постройки граффика регулировки периметра.
         Gyro.CuruAngle=0;
         Gyro.tempdelta=0;
         Gyro.tempdelta2=0;
         WriteCon(Time);
-      //  LoopOff     
+      //       
     }
 }
 
@@ -445,8 +472,10 @@
 */
 
 void DAC_OutPut(void)//выдача в цапы
-{
-    Modulator();
+{  
+    if(Gyro.LogPLC) Modulator();
+    
+
     LPC_SSP0->DR=0x5555;
     LPC_SSP0->DR=0x5555;
     LPC_SSP0->DR=0x5555;
@@ -454,35 +483,14 @@
     if (CountV31 & 1) {                      	//если нечетный такт то
         LPC_SSP0->DR = WRITE_DAC0;   			//e.команда для ЦАП_0 передавать.
         LPC_SSP0->DR = (Spi.DAC_A);         	//e. передача 12 бит
-    } else { //если такт четный.
-        LPC_SSP0->DR = WRITE_DAC1 ; //e.команда для ЦАП_1 передавать.
-
-        switch( Gyro.StrayPLC_flag) {
-
-            case 0://режим без воздействия
-                LPC_SSP0->DR = (Spi.DAC_B);
-                temp9=Spi.DAC_B;
-                break;
-/*
-            case 1://малое воздействие +
-                temp9=Spi.DAC_B + Gyro.StrayPLC_Pls;
-                LPC_SSP0->DR = temp9;
-                break;
-
-            case 3://малое воздействие -
-                temp9=Spi.DAC_B + Gyro.StrayPLC_Mns;
-                LPC_SSP0->DR = temp9;
-                break;
-
-            case 2://большое воздействие +
-                temp9=Spi.DAC_B + Gyro.StrayPLC_2Mode;
-                LPC_SSP0->DR = temp9;//вгоняем в многомодовый режим
-                break;
-*/
+    } 
+    else { //если такт четный.
+        LPC_SSP0->DR = WRITE_DAC1; //e.команда для ЦАП_1 передавать.
+        LPC_SSP0->DR = (Spi.DAC_B);
+        temp9=Spi.DAC_B;
         }
-        // LPC_SSP0->DR = Spi.DAC_B;        	//e. передача 12 бит
-
-    }
+    
+   
 }