forkd

Dependencies:   mbed

Fork of LG2 by Dmitry Kovalev

MTimer.c

Committer:
Kovalev_D
Date:
2017-10-20
Revision:
220:04c54405b82d
Parent:
218:b4067cac75c0
Child:
222:7de7b3bf3a1d

File content as of revision 220:04c54405b82d:

#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)	
    {       /*sprintf((Time),"%d %d  %d\r\n",Spi.DAC_B,AMPSUM_DESP,Spi.DAC_A);
            WriteCon(Time);*/
    	if(Gyro.ShowMod2)
    	{
    		sprintf((Time),"%d %d  %d\r\n",Spi.DAC_B,AMPSUM_DESP,Spi.DAC_A);
            WriteCon(Time);
    		Spi.DAC_B+=200;
    	}
      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) 
    {  
        Event2K --;
    }
}
void Event_500Hz(void)// событие раз в 500 Гц
{
	if(Event500Hz)
	{     
	 Event500Hz--;
	 Gyro.Event_500Hz=1;// Event 500Гц  выдачи данных для постройки графика управления вибро
	}
}
void Event_250Hz(void)
{
	if(Event250Hz)
	{        
      
    // Gyro.CuruAngle=0;
	  Event250Hz--;
	  MODCount++;
	  }
}
/////////////////////////////////////////////////////
///////////////////// 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== 10000)
         {  Time2K=0;
           //Time100K = 0;
            Event2K ++;
         }
         
        if (Time500Hz > 200) 
         { // LoopOn
            Time500Hz -= 200;
            Event500Hz ++;     
         }
         
           if (Time250Hz > 6) 
         { // LoopOn
            Time250Hz -= 6;
            Event250Hz ++;     
         }
   
    //LoopOff
}