fork

Dependencies:   mbed

Fork of LG by igor Apu

MTimer.c

Committer:
Kovalev_D
Date:
2017-09-04
Revision:
217:15cd8752bb6c
Parent:
216:189b0ea1dc38
Child:
218:b4067cac75c0

File content as of revision 217:15cd8752bb6c:

#include "MTimer.h"
#include "LPC17xx.h"
#include "MTimer.h"
#include "vibro.h"
#include "QEI.h"
#include "Global.h"
#include "SPI.h"
#include "InputOutput.h"

unsigned int CountV64=0;
unsigned int CountV31=0;
unsigned int CountV255=0;
unsigned int CountV511=0;
unsigned int f,MODCount=0;
int loop=0;
int t;
/////////////////////////////////////////////////////
/////////////////////EVENT///////////////////////////
/////////////////////////////////////////////////////
/////////////////////////////////////////////////////
///////////////////// 1250Hz ///////////////////////////
/////////////////////////////////////////////////////
void Event_1250Hz(void)// событие раз в 1,25 КГц
{
	if(Event1250Hz)
	{
		Gyro.EvenRate7=1;
	
		Event1250Hz--;

	}
}
/////////////////////////////////////////////////////
///////////////////// 1Hz ///////////////////////////
/////////////////////////////////////////////////////
void Event_1Hz(void)// событие раз в 1 Гц
{ static int tempdac=0,tempdac1;
    if (Event1Hz)	
    {

       /* SinMns=0;    
        SinPls=0; */ 		 
     //BuffADC_64Point[CountV64] = ADC_64Point;
    // BuffADC_32PointD[CountV64] =  ADC_32PointD;
     /* for(int q=0; q<64; q++)
            		{
                    sprintf((Time)," %d ", Buff_Restored_Mod[q]);  
               		WriteCon(Time);         		 	
                	}
                	sprintf((Time)," \r\n ");
                	WriteCon(Time);
                	 for(int q=0; q<64; q++)
            		{
            	    sprintf((Time)," %d ", BuffADC_64Point[q]);  
               		WriteCon(Time);         		 	
                	}
                	sprintf((Time)," \r\n ");
                	WriteCon(Time); */
                  /* for(int q=0; q<64; q++)
            		{
            	    sprintf((Time)," %d  ", BuffADC_32PointD[q]);  
               		WriteCon(Time);         		 	
                	}
                	sprintf((Time),"\r\n ");
	 				WriteCon(Time);  
    				*/
    
  /*  Check(BuffTemp, 8);
    WriteConN (BuffTemp,8);*/
    		   /*  sprintf((Time),"   %d \r\n",  Gyro.PLC_regul);
                 WriteCon(Time);*/
    /*    if(Gyro.RgConA&0x8)
				{
		      	 if(Gyro.PLC_regul>0){Spi.DAC_B-=Gyro.PLC_regul*Gyro.PLC_Gain;}
		      	 else 			   	 {Spi.DAC_B+=Gyro.PLC_regul*Gyro.PLC_Gain;}
		      	}
		      	Gyro.PLC_regul=0;*/
  /* sprintf((Time)," %d 	 %d \r\n", Spi.DAC_A,Gyro.DacIn);
   WriteCon(Time);*/
      if(Gyro.LogMod==1) ShowMod2();
      Discharg();
      BackLight();
      Gyro.Rate1_Event = 1; 
      Event1Hz--;
      Time1Hz++; 
  //    sprintf((Time),"%d \r\n",Gyro.ModeOut );
 //     WriteCon(Time);
      
	}
}
/////////////////////////////////////////////////////
///////////////////// 1kHz //////////////////////////
/////////////////////////////////////////////////////
void Event_1KHz(void)// событие раз в 1 кГц
{     if (Event1K) 
    {
       if(Gyro.PLCDelay) Gyro.PLCDelay--;
        Event1K --;

        Time1K++;//первый ++ работает каждые 125 (event100kHz)второй был в 100 кГц
        if (Time1K > 1000) 
        {
            Time1K -=1000;
            Event1Hz ++;
        }
        
    }
}

void Event_2KHz(void)// событие раз в 1 кГц
{int temp=0;

    if (Event2K) 
    {   
      if(Gyro.LogMod)   
          {  
    	     /*  sprintf((Time)," %d     %d           %d            %d \r\n",   TSinMns, TSinPls, TSinMns - TSinPls, Gyro.PLC_Eror_count);
               WriteCon(Time);*/
    	  }
        Event2K --;
        //Gyro.Rate3_Event++;  
    }
}
void Event_500Hz(void)// событие раз в 500 Гц
{
	if(Event500Hz)
	{     
	   /*        if(Gyro.LogMod==5) 
   		  { 
           } 	  */
	 Event500Hz--;
	 Gyro.Event_500Hz=1;// Event 500Гц  выдачи данных для постройки графика управления вибро
	}
}
void Event_250Hz(void)
{
	if(Event250Hz)
	{        

    // Gyro.CuruAngle=0;
	  Event250Hz--;
	  MODCount++;
	  if((MODCount&0x3f)==0)
		 {/*
		 	sprintf((Time),"%d      %d      %d\r\n", Spi.DAC_B, (0xffff - Spi.ADC5), Gyro.CuruAngle);
    		WriteCon(Time);
    	 	Gyro.CuruAngle		=	0;
		 	Gyro.CaunMinRate 	= 	0;
            Gyro.CaunPlusRate	= 	0;
            */
    	 }
    	      
	 if(MODFlag==2)
	 	{
	 	/* BuffADC_64Point[MODCount&0x3f]=ADC5New;*/
		 LPC_DAC->DACR = (ModArraySin[MODCount&0x3f] * Gyro.ModAmp);
		
		 if((MODCount&0x3f)==0) PLCRegul250();
	 	}
	  }
}
/////////////////////////////////////////////////////
///////////////////// 100kHz //////////////////////////
/////////////////////////////////////////////////////
void Event_100KHz(void)// событие раз в 100 кГц
{
        
    if (Event100K)	{
       
        Event100K --;
      
        if (OutBufCon1Count)OutBufCon1Count--;  // обратный отсчет для управления ногой и формирование задержки на выдачу
       
         PinCheng();	// чтение регистра состояния выводов(вибро, полсветка, поджиг, LED) и управление выводами.
    }
}
/////////////////////////////////////////////////////
//////////////////vibro EVENT////////////////////////
/////////////////////////////////////////////////////
void Event_Vibro(void)// событие от вибр
{
    if (EventVibro)	{
        EventVibro --;
    }
}
/////////////////////////////////////////////////////
/////////////////////////////////////////////////////
/////////////////////////////////////////////////////


//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////TIMER1////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

//////////////////////////////////////////////////////////////////////
/////////////////////инициализация таймера 1 /////////////////////////
//////////////////////////////////////////////////////////////////////

unsigned int Init_TIM1 (unsigned int TimerInterval )
{
   // LPC_SC->PCLKSEL0 |= (1<<4);
    LPC_TIM1->MR0 = TimerInterval;
    LPC_TIM1->MCR = 3;				/* Interrupt and Reset on MR1 */
    NVIC_EnableIRQ(TIMER1_IRQn);
}


//////////////////////////////////////////////////////////////////////
/////////////////////////включение таймера 1//////////////////////////
//////////////////////////////////////////////////////////////////////
void enable_timer1( void )
{
    LPC_TIM1->TCR = 1;
    return;
}


/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
/////////////////////////////////////////////////TIMER2//////////////////////////////////////////////////////////////////////////////////
/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

//////////////////////////////////////////////////////////////////////
/////////////////////инициализация таймера 2 /////////////////////////
//////////////////////////////////////////////////////////////////////
unsigned int Init_TIM2 (void)
{
    LPC_TIM2->MR0 = 257;
    LPC_TIM2->MCR = 3;				/* Interrupt and Reset on MR0 */
    NVIC_EnableIRQ(TIMER2_IRQn);
    return 1;
}

//////////////////////////////////////////////////////////////////////
/////////////////////////включение таймера 2//////////////////////////
//////////////////////////////////////////////////////////////////////
void enable_timer2(void)
{
    LPC_TIM2->TCR = 1;
    LPC_TIM2->TCR = 0x01;
}


//////////////////////////////////////////////////////////////////////
/////////////////////////прерывание таймера 1//////////////////////////
//////////////////////////////////////////////////////////////////////
__irq void TIMER1_IRQHandler (void)//13.27 kHz(vibro*32)
{   

    
    ResetCS(ADC);					  	 	//prepare ADC for sampling
    SetDAC(DAC);
    Global_Time++;
    CountV255++;							// инкремент счеттчика
    CountV511++;
    CountV255 &= 0xff;						// ОБРЕЗАНИЕ СЧЕТЧИКА 
    CountV511 &= 0x1ff;
    CountV64 = CountV255 & 0x3f;
    CountV31 = CountV255 & 0x1f;			// малый счетчик
   
    D_QEI();								//чтение данных по счетчику
    cheng();		             			// выставление флагов в 32 тактном цикле.


    SetCS(ADC);					    		//start ADC sampling
    ResetDAC(DAC);
	SPI_Exchange(); 						//Чтение ADC_SPI

    LPC_TIM1->IR = 1;   
    
}

///////////////////////////////////////////////////////////////////////
/////////////////////////прерывание таймера 2//////////////////////////
///////////////////////////////////////////////////////////////////////
__irq void TIMER2_IRQHandler (void)
{   
   /// LoopOn
    LPC_TIM2->IR = 1;
	if (Gyro.UARTFlag)
		{
   		 if(Time_UART) Time_UART--;
   		}
   	//	 

    Time_vibro++;
   // VibroOut();
    Gyro.VibroOutF=1;
    Event100K ++; 
    Time1250Hz++; 
    Time500Hz++;
    Time250Hz++;
    Time100K++;
    Time2K++;
    //Time2K++;
 //   Time250Hz++;
 
        if (Time1250Hz > 79)
         {  
            Time1250Hz -= 80;
            Event1250Hz ++;
         }
        if (Time100K == 100)
         { // LoopOn
            Time100K = 0;
            Event1K ++;
             // LoopOn
         }
         
         if (Time2K== 20000)
         {  Time2K=0;
           //Time100K = 0;
            Event2K ++;
         }
         
        if (Time500Hz > 200) 
         { // LoopOn
            Time500Hz -= 200;
            Event500Hz ++;     
         }
         
           if (Time250Hz > 6) 
         { // LoopOn
            Time250Hz -= 6;
            Event250Hz ++;     
         }
   
    //LoopOff
}