Diff: CyclesSync.c

Revision:

0:8ad47e2b6f00

Child:

21:bc8c1cec3da6

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/CyclesSync.c	Sat Jan 30 13:00:39 2016 +0000
@@ -0,0 +1,425 @@
+
+/**--------------File Info---------------------------------------------------------------------------------
+** File name:           CycleSync.c
+** Last modified Date:  2011-09-06
+** Last Version:        V1.00
+** Descriptions:        
+**
+**--------------------------------------------------------------------------------------------------------
+** Created by:          Electrooptica Inc.
+** Created date:        2011-09-06
+** Version:             V1.00
+** Descriptions:        There is the routines for device synchronization
+**
+**--------------------------------------------------------------------------------------------------------       
+*********************************************************************************************************/
+#include "CyclesSync.h"
+#include "CntrlGLD.h"
+#include "SIP.h"
+#include "el_lin.h"
+#include "InputOutput.h"
+
+uint32_t 	Sys_Clock;      //e. counter of system ticks //r. �������  ��������� ����� �������
+uint32_t 	Seconds = 0;    //e. seconds from power on //r. ����� ������ �� ������� ��������� �������
+int32_t 	time_1_Sec = DEVICE_SAMPLE_RATE_uks;     //e. pseudosecond timer //r. ��������������� ������
+uint32_t 	trm_cycl;
+uint32_t	count;
+ int32_t	PrevPeriod = 0;
+uint32_t	num;
+volatile uint32_t	Latch_Rdy = 0;
+
+ int32_t    LatchPhase = INT32_MAX;
+uint32_t 	Ext_Latch_ResetEnable = 1;
+volatile uint32_t 	data_Rdy = 0;
+
+uint32_t	Delay_UART_Enbl = DELAY_UART_ENBL;
+//uint32_t	Delay_UART_Disbl = DELAY_UART_ENBL;
+
+uint32_t 	main_cycle_latch = 0; 
+uint32_t 	Out_main_cycle_latch; //e. counter of main cycles between external latch pulse appearence
+uint32_t 	T_latch, Out_T_latch, temp_T_latch;
+
+/******************************************************************************
+** Function name:		Latch_Event
+**
+** Descriptions:		Routine for latch appearing
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+void Latch_Event()
+{
+  static unsigned PreLatch = 0;
+//  static int cc = 0;
+	if (LatchPhase < INT32_MAX)  //���� LatchPhase(���� �������) < ������ ������������� 32-� ������� ���� (��� ������������� int32_t    LatchPhase = INT32_MAX;) ��: 
+	    {	
+		  Latch_Rdy = 1;		   //e. ���������� ���� ��� ��������� ����
+			if (RgConB)			   //���� RgConB (�������������� ������� ����������, ���������� � ������� ��� ������������� � �����) ��������� � ������� ��:
+			{
+		  	    if (PreLatch)		   //e. ���� �� ����������� �������
+		     	  PreLatch = 0;
+						
+		  	     else if ((LatchPhase < LPC_PWM1->TC) && (num == Sys_Clock)) //e. latch have appeared in current cycle
+		  	    	{			
+		  		    	Latch_Rdy = 0;	//e. bring it to the next cycle	
+				      	PreLatch = 1;
+		  		    }						  			
+			} 
+		}
+	  else
+		Latch_Rdy = 0;				//e. latch is absent
+ //---------------------------temp-------------------------------
+ /*	Latch_Rdy = 0;				//e. latch is absent  
+	if (cc++ == 19)
+	{
+	  cc = 0;
+	  Latch_Rdy = 1; 
+	  LatchPhase = 2500; 
+	} 	*/
+	//----------------------temp--------------------------------
+}
+
+/******************************************************************************
+** Function name:		QEI_IRQHandler
+**
+** Descriptions:		Latch counters by reference meander
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+ __irq void QEI_IRQHandler (void) 
+ {
+   static uint32_t halfQEIPeriod = 0;
+
+	 Cnt_curr =  LPC_QEI->POS;		//e. read accumulated value of counter
+	 if (LPC_QEI->INTSTAT & 0x0008)
+	 {
+	   data_Rdy = 0x0004;			//e. data for Cnt_Pls or Cnt_Mns calculation are ready
+
+	  if (++halfQEIPeriod & 0x0001)	//e. period elapsed, we can calculate Cnt_Dif
+	   {
+	    data_Rdy = 0x000C;	
+	   }
+   }
+	  LPC_QEI->CLR = 0x1fff;			//e. reset interrupt request //r. �������� ������ ����������
+ }
+/******************************************************************************
+** Function name:		SetIntLatch
+**
+** Descriptions:		Set timer for accumulation period
+**
+** parameters:			Period of accumulation
+** Returned value:		None
+** 
+******************************************************************************/
+void SetIntLatch(uint32_t cycle)
+{
+ LPC_TIM3->TCR = 0x2;							//switch off and reset timer3
+ if (cycle != 0)
+ {
+ 	LPC_TIM3->MR0 = (cycle<<2);						//load new value
+ 	LPC_TIM3->TCR = 1;							//switch on timer3
+ }
+}
+/******************************************************************************
+** Function name:		SwitchRefMeandInt
+**
+** Descriptions:		Enable/disable interrupt from reference meander
+**
+** parameters:			switcher
+** Returned value:		None
+** 
+******************************************************************************/
+void SwitchRefMeandInt(uint32_t s)
+{
+  LPC_QEI->CLR = 0x1fff; 			//e. reset all interrupts //r. �������� ��� ����������
+ if (s)
+  LPC_QEI->IEC = 0x1fff;			//e.  disable direction changing interrupt //r. ��������� ���������� ��� ��������� �����������
+ else
+  LPC_QEI->IES = 0x0008;			//e.  enable direction changing interrupt //r. ��������� ���������� ��� ��������� �����������
+}
+/******************************************************************************
+** Function name:		ExtLatch_IRQHandler
+**
+** Descriptions:		Routine for external latch appearence processing
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+ __irq void EINT3_IRQHandler (void) 
+ {
+ //LPC_GPIO2->FIOSET = 0x00000020;		//e. turn on the LED 
+ 	LatchPhase = LPC_PWM1->TC;			//e. read moment of latch
+	LPC_TIM0->TCR = 1;					//e. start Mltdrop delay timer
+	LPC_GPIOINT->IO0IntClr |= 0x0000800;//e. clean interrupt request
+ //LPC_GPIO2->FIOCLR = 0x00000020;		//e. turn off the LED 
+ }
+ /******************************************************************************
+** Function name:		IntLatch_IRQHandler
+**
+** Descriptions:		Routine for Internal latch appearence processing
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+ __irq void IntLatch_IRQHandler (void) 
+ {
+ //LPC_GPIO2->FIOSET |= 0x00000080;		// turn on the LED 
+ 	LatchPhase =(int)LPC_PWM1->TC;			//e. read moment of latch
+  LPC_TIM3->IR = 0x0001;				//e. clear interrupt flag 
+	num = Sys_Clock;
+//	count++;					
+ //LPC_GPIO2->FIOCLR |= 0x00000080;		// turn off the LED 
+ }
+
+ /******************************************************************************
+** Function name:		SwitchMode
+**
+** Descriptions:		Switch mode of device functionality
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+int SwitchMode()
+{
+ //-----------------------disable latch sources ---------------------
+      SetIntLatch(0); 	   					//e. disable internal latch
+	  LPC_TIM3->IR = 0x0001;				//e. clear internal latch interrupt request
+
+   	  LPC_GPIOINT->IO0IntEnR &= ~0x0000800;	//e. disable external latch
+	  LPC_GPIOINT->IO0IntClr |=  0x0000800;	//e. clean external latch interrupt request
+
+   	  LPC_TIM0->TCR = 2;						//e. stop and reset the multidrop delay timer
+	  LPC_TIM0->IR = 0x03F;				//e. clear internal latch interrupt request
+//----------------------wait while UART and DMA are active-------------									 	
+	if ( LPC_GPDMACH1->CConfig & DMA_BUSY)				//e. if DMA channel is busy, wait //r. ���� ����� �������� �����, �����
+	  return 0;	
+	LPC_GPDMACH1->CConfig &=  ~DMAChannelEn;			//e. disable DMA for UART transmition
+	LPC_GPDMACH2->CConfig &=  ~DMAChannelEn;
+
+	if (!(LPC_UART1->LSR & TRANS_SHIFT_BUF_EMPTY))      //e. transmit buffer is not empty //r. ���������� ����� �� ����
+	 return 0;
+	LPC_UART1->FCR |= 0x4;								//e. reset TX FIFO
+
+	LPC_TIM0->IR = 0x3F;				 		//e. clear all interrupt flags 
+//---------------------configure a new exchanging parameters------------
+   if (Device_Mode > 3)		   					//e. external latch mode enabled
+   {
+    LPC_TIM0->MR0 = 10;	
+	LPC_TIM0->MR1 = 50;						//e. /10 = delay before enable signal (us)
+ //   LPC_UART1->FCR &= ~0x08;  					//e. TX FIFO is not source for DMA request
+
+// 	LPC_SC->DMAREQSEL = 0xC;						//e. external latch delay timer is source for DMA request
+//	LPC_GPIOINT->IO0IntEnR |= 0x0000800;	//e. enable rising edge interrupt
+   }
+   else						   				//e. internal latch mode enabled
+   {
+   	LPC_TIM0->MR0 = 10;	
+	LPC_TIM0->MR1 = 5000;						//e. /10 = delay before enable signal (us)
+//	LPC_SC->DMAREQSEL = 0x3;   				//e. FIFO generate DMA request
+
+//	LPC_SC->EXTINT = 0x8;					//e. clean interrupt request
+   }
+ 
+   UART_SwitchSpeed(SRgR & 0x0030);
+
+   if (Device_Mode == DM_INT_LATCH_DELTA_PS)
+   	 SetIntLatch(50000);
+   return 1;
+}
+
+ /******************************************************************************
+** Function name:		ServiceTime
+**
+** Descriptions:		Routine for pseudoseconds counting
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+ void ServiceTime(void)// ��������������� �������.
+{
+  time_1_Sec -= PrevPeriod;
+
+   if (time_1_Sec < (PrevPeriod>>1)) //1 sec elapsed with accurate 0.5 of main period
+	{
+		time_1_Sec = DEVICE_SAMPLE_RATE_uks;
+		Seconds++;
+	}
+	if (Seconds == 3) { Seconds++;close_all_loops();}	
+	Sys_Clock++; //e. increment of the system clock register //r. ��������� �������� ��������� ����� �������
+	PrevPeriod = LPC_PWM1->MR0;
+} // ServiceTime
+
+/******************************************************************************
+** Function name:		WDTFeed
+**
+** Descriptions:		Feed watchdog timer to prevent it from timeout
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+void WDTFeed( void )
+{
+  LPC_WDT->FEED = 0xAA;		/* Feeding sequence */
+  LPC_WDT->FEED = 0x55;
+  return;
+}
+
+/******************************************************************************
+** Function name:		CounterIquiryCycle_Init
+**
+** Descriptions:		CounterIquiryCycle_Init setup demanded GPIOs for PWM1,
+**						reset counter, all latches are enabled, interrupt
+**						on PWMMR0, install PWM interrupt to the VIC table.
+**
+** parameters:			
+** Returned value:		
+** 
+******************************************************************************/
+void CounterIquiryCycle_Init(uint32_t cycle)
+{ 
+  										//PWM1 enabled after reset by default
+	LPC_SC->PCLKSEL0 &= ~(3<<12);	
+ 	LPC_SC->PCLKSEL0 |=  (1<<12);	 	//PWM1 is synchronized by CCLK (100 MHz)(CCLK) PCLKSEL0 - Peripheral Clock Selection registers.
+  
+	LPC_PWM1->TCR = TCR_RESET;	/* Counter Reset */ //#define TCR_RESET		0x00000002 ���������������� ������� ��� �������� �������� ���.
+	LPC_PWM1->MCR = PWMMR0I |PWMMR0R; 	//generate interrupt and reset timer counter ( PWMMR0I - ���������� ������������ ����� PWMMR0 ��������� �� ��������� PWMTC. )
+	                                    //                                           ( PWMMR0R - ���������� PWMTC ��� ���������� PWMTC � PWMMR0. )
+	
+	LPC_PWM1->CCR = 0x1;				//��������� ���������� ������ ��� ���������� PWMTC � PWMMR0	 (��� ��� �� ������� � ��������� ��)					   
+					
+
+	PrevPeriod = 10000;
+	LPC_PWM1->MR0 = PrevPeriod;		/* set PWM cycle */// ������� ������� ������ ��������.
+	LPC_PWM1->PCR = PWMENA1;  			//e. single edge control mode, PWM1 out enabled only ��������� ������ ��� 1.
+	LPC_PWM1->LER = LER0_EN ;  			//e. enable updating of register
+	LPC_PWM1->TCR = TCR_CNT_EN | TCR_PWM_EN;	/* counter enable, PWM enable */ //��������� �������� � ���
+
+ 	NVIC_DisableIRQ(PWM1_IRQn);//��������� ����������.
+
+
+  return ;
+}
+
+__irq void TIMER0_IRQHandler()
+{
+  int val = LPC_TIM0->IR;
+  LPC_TIM0->IR |= 3;
+
+  if (val & 1)	//MAT 1.0 interrupt
+  {
+    LPC_GPIO2->FIOSET |= 1<<6;		// turn on the LED 	
+	LPC_TIM0->IR |= 1;
+	 return;
+  }
+  if (val & 2)	 //MAT 1.1 interrupt
+  {
+	LPC_GPIO2->FIOCLR |= 1<<6;		// turn on the LED 	
+	LPC_TIM0->IR |= 2;
+	 return;
+  }
+   if (val & 4)	//MAT 0.2 interrupt
+  {
+//    LPC_GPIO0->FIOSET2 |= 0xFF;				//set P0.23
+//	LPC_GPIO2->FIOSET |= 0x00000040;		// turn on the LED 	
+//	LPC_TIM0->IR |= 4; 
+	return;
+  }			 
+ return;
+}
+
+/******************************************************************************
+** Function name:		ExtLatch_Init
+**
+** Descriptions:		Initialization of external latch 
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+void ExtLatch_Init() 
+{
+	LPC_PINCON->PINSEL4 &= ~0xC000000;		//e. ������������ P2.13 ��� GPIO.
+  LPC_PINCON->PINSEL0 &= ~0x0C00000;		//e. ������������ P0.11 ��� GPIO.
+	LPC_GPIO0->FIODIR   &= ~0x0000800;		//e. ������������ P0.11 �����.
+	LPC_GPIOINT->IO0IntEnR &= ~0x0000800;	//e. ��������� ���������� �������.
+	LPC_GPIOINT->IO0IntClr |=  0x0000800;	//e. �������� ������� �� ����������
+
+	NVIC_EnableIRQ(EINT3_IRQn);	          // ��������� ����������.
+
+//+++++++ initialization of timer for multidrop delay generation+++++++++++++++++++++++
+										 //e.  TIMER0 enabled by default   
+	LPC_SC->PCLKSEL0 &= ~(3<<2);		 //e. �������� ������� ������� 0
+  LPC_SC->PCLKSEL0 |= (3<<2);		 	 //e. ���������� ������� ������� 0 �� CLK/8.
+	LPC_TIM0->PR = 0;					       //e. ���������� �������� ������� � 0.
+	LPC_TIM0->IR = 0x3F;				     //e. �������� ����� ����������. 
+	LPC_TIM0->MCR = 1 |(1<<3)|MR1_RESET |MR1_STOP; //e. �������� � ���������� ������ ����� ����������  MR1 � TC.
+	LPC_TIM0->CCR = 0; 			 		 //e. ���������� ������� ����������� ��� ��������� ��������� ������ �������.
+	LPC_TIM0->CTCR = 0; 				 //e. timer0 � ������ �������.
+	
+	LPC_TIM0->MR0 = /*Device_blk.Address**/10;	 		//e. delay before UART transmitter loading
+	LPC_TIM0->MR1 = /*Device_blk.Address**/5000;		//e. delay before UART transmitter start
+									//e. set first empty) event of timer
+	NVIC_DisableIRQ(TIMER0_IRQn);		 
+}
+/******************************************************************************
+** Function name:		IntLatch_Init
+**
+** Descriptions:		Initialization of iternal latch cycle generation
+**
+** parameters:			None
+** Returned value:		None
+** 
+******************************************************************************/
+void IntLatch_Init() 
+{
+    LPC_SC->PCONP |= (1<<23);  //������� TIME3(������)
+	//e. by default timer3 mode is not counter (T3CTCR[1,0]=0) 
+   
+  	LPC_SC->PCLKSEL1 &= SYNC_CLCK4;	 // ������� �������� ������� ����� CLCK/4
+  	LPC_SC->PCLKSEL1 |= (1<<14);		 // timer 3 input frequency equal to CLCK/4
+	
+//	LPC_PINCON->PINSEL1 |= (3<<16);	      //e. CAP 3.1 is connected to P0.24
+	//e. by default CAP3.0 is connected to timer3
+	LPC_TIM3->PR = 0;					                          //e. ���������� ������������ �������3 �� 0.
+	LPC_TIM3->IR = 0x0001;			                      	//e. �������� ����� ����������. 
+	LPC_TIM3->MCR = MR0_RESET |MR0_INT_EN |MR0_NO_STOP;	// ��������� ������ ���������� ������� ����������� ��� ���������� ������� � ��R.
+	LPC_TIM3->CCR = 0x0001; 			                      //���������� �������� ����������� �� ������� ��������� ������ �������.
+	
+	NVIC_EnableIRQ(TIMER3_IRQn);	                      //��������� ����������.
+}
+/*****************************************************************************
+** Function name:		WDTInit
+**
+** Descriptions:		Initialize watchdog timer, install the
+**						watchdog timer interrupt handler
+**
+** parameters:			None
+** Returned value:		true or false, return false if the VIC table
+**				is full and WDT interrupt handler can be
+**				installed.
+** 
+*****************************************************************************/
+uint32_t WDTInit( void )
+{
+  NVIC_DisableIRQ(WDT_IRQn);
+
+  LPC_WDT->TC = WDT_FEED_VALUE;	// once WDEN is set, the WDT will start after feeding 
+  LPC_WDT->MOD = WDEN;
+
+  LPC_WDT->FEED = 0xAA;		// Feeding sequence
+  LPC_WDT->FEED = 0x55;  
+    
+  return 1;
+}
+/******************************************************************************
+**                            End Of File
+******************************************************************************/
+