Diff: SPI.c

Revision:

99:3d8f206ceac2

Parent:

96:1c8536458119

Child:

104:ab1cb4ff56b2

--- a/SPI.c	Tue Mar 29 09:51:17 2016 +0000
+++ b/SPI.c	Tue Mar 29 17:00:59 2016 +0000
@@ -3,6 +3,9 @@
 unsigned int Temp_AMP;
 unsigned int Temp_AMP64P;
 
+unsigned int Count_AMP, ADD_AMP, Cur_Amp;
+int Znak_Amp;
+
 unsigned int Temp_ADC_2;
 unsigned int Temp_ADC_3;
 unsigned int Temp_ADC_4;
@@ -28,6 +31,8 @@
 void SPI_Exchange(void)
 {
     unsigned int DummySPI;
+   	int Delta;
+
 
     Spi.ADC5 = LPC_SSP0->DR;
     Spi.ADC4 = LPC_SSP0->DR;
@@ -49,7 +54,8 @@
         LPC_SSP0->DR = (Spi.DAC_B); 	        	//e. передача 12 бит
     }
 
-  LPC_DAC->CR = (((SinPLC[CountV64]*35)+24300));// модулятор
+//  LPC_DAC->CR = (((SinPLC[CountV64]*35/5)+24300));// модулятор
+//  LPC_DAC->CR = (((SinPLC[CountV64]*35/5)+24300));// модулятор
     while (LPC_SSP0->SR & RX_SSP_notEMPT)  		                //если буфер SPI не пуст.
     DummySPI = LPC_SSP0->DR;	                                //очистить буфер.
 
@@ -70,6 +76,33 @@
      Temp_AMP += Buff_ADC_5[(CountV255-64) & 0xff];									//
      Temp_AMP -= Buff_ADC_5[(CountV255-96) & 0xff];									// з
      Buff_AMP[CountV255] = (unsigned int) (Temp_AMP);
+     
+     ADD_AMP+=Spi.ADC5;
+     Count_AMP++; 
+
+
+     if(Count_AMP>=(64*200)) 
+     {
+		Delta = ADD_AMP - Cur_Amp;
+		if 		( Delta > 30000000 ) 	Spi.DAC_B += 1000;
+		else if ( Delta < (-3000000) ) Spi.DAC_B += 1000;
+ 	   	else if ((Delta * Znak_Amp) > 0)  
+		{
+			Spi.DAC_B +=   2 ; 
+			Znak_Amp = 1;
+		}
+		else
+		{
+			Spi.DAC_B -=  2; 
+			Znak_Amp = -1;
+		}
+     	Cur_Amp=ADD_AMP; Count_AMP=0; ADD_AMP=0;
+
+
+	 }
+    
+
+
 
 
     Temp_AMP64P += Buff_ADC_5[CountV255];