Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
MTimer.c
- Committer:
- Kovalev_D
- Date:
- 2017-08-16
- Revision:
- 214:4c70e452c491
- Parent:
- 213:9953db9543d6
- Child:
- 215:b58b887fd367
File content as of revision 214:4c70e452c491:
#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 f,MODCount=0; int loop=0; int t; ///////////////////////////////////////////////////// /////////////////////EVENT/////////////////////////// ///////////////////////////////////////////////////// ///////////////////////////////////////////////////// ///////////////////// 1250Hz /////////////////////////// ///////////////////////////////////////////////////// void Event_1250Hz(void)// событие раз в 1,25 КГц { if(Event1250Hz) { Gyro.EvenRate7=1; LoopOn LoopOn LoopOn LoopOn Event1250Hz--; LoopOff } } ///////////////////////////////////////////////////// ///////////////////// 1Hz /////////////////////////// ///////////////////////////////////////////////////// void Event_1Hz(void)// событие раз в 1 Гц { static int tempdac=0,tempdac1; if (Event1Hz) { /* Check(BuffTemp, 8); WriteConN (BuffTemp,8);*/ /* 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==2) { temp=((((Spi.DAC_A/0.6667) - 30000))-0x7fff); sprintf((Time),"%i %d %i %f %i %d \r\n", (Spi.DAC_B - 0x7fff), Gyro.LG_Type, Spi.DAC_A ,(Spi.DAC_A/0.6667),temp, Gyro.PLC_Eror_count ); WriteCon(Time); Gyro.PLC_Eror_count=0; Gyro.LG_Type=1; } Event2K --; Gyro.Rate3_Event++; } } 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++; 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 { ResetCS(ADC); //prepare ADC for sampling SetDAC(DAC); Global_Time++; CountV255++; // инкремент счеттчика CountV255 &= 0xff; // ОБРЕЗАНИЕ СЧЕТЧИКА 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== 2000) { Time2K=0; //Time100K = 0; Event2K ++; } if (Time500Hz > 200) { // LoopOn Time500Hz -= 200; Event500Hz ++; } if (Time250Hz > 6) { // LoopOn Time250Hz -= 6; Event250Hz ++; } //LoopOff }