![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
fork
Fork of LG by
MTimer.c
- Committer:
- Kovalev_D
- Date:
- 2017-07-26
- Revision:
- 213:9953db9543d6
- Parent:
- 211:ac8251b067d2
- Child:
- 214:4c70e452c491
File content as of revision 213:9953db9543d6:
#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/////////////////////////// ///////////////////////////////////////////////////// ///////////////////////////////////////////////////// ///////////////////// 1Hz /////////////////////////// ///////////////////////////////////////////////////// void Event_1Hz(void)// событие раз в 1 Гц { int tempdac,tempdac1; if (Event1Hz) { if(Gyro.LogMod==1) ShowMod2(); Discharg(); BackLight(); Gyro.Rate1_Event = 1; Event1Hz--; Time1Hz++; /* sprintf((Time),"%i %i %i %i %d\r\n",Spi.DAC_A, Gyro.HFO_Min, Gyro.HFO_Max,Gyro.RgConA ); WriteCon(Time); */ /* sprintf((Time)," %d %d %d \r\n", Gyro.PLC_Eror, Spi.DAC_B , Gyro.PLCDelay ,Gyro.RgConA); Gyro.CuruAngle=0; WriteCon(Time);*/ if(Gyro.CuruAngleLog) { /* sprintf((Time),"%d %d %d %d \r\n", Gyro.CuruAngle, Gyro.CuruAngle64, Gyro.CuruAngle96, Gyro.CuruAngle128); WriteCon(Time);*/ /* Gyro.CuruAngle = 0; Gyro.CuruAngle64 = 0; Gyro.CuruAngle96 = 0; Gyro.CuruAngle128 = 0; */ } /* for(int i=0; i<32;i++) { sprintf((Time),"%d ", Buff_Restored_sin[i]); WriteCon(Time); } sprintf((Time),"\r\n"); WriteCon(Time); for(int i=0; i<32;i++) { sprintf((Time)," %d ", Buff_1Point[i-7]); WriteCon(Time); } sprintf((Time),"\r\n"); 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 кГц { if (Event2K) { if(Gyro.LogMod==2) { sprintf((Time),"%d %d %d %d \r\n", Spi.DAC_A, tempDeltaRegul, Spi.DAC_B, Gyro.CuruAngle); WriteCon(Time); Gyro.CuruAngle=0; } 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_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 ++; Time500Hz++; Time250Hz++; Time100K++; Time2K++; //Time2K++; // Time250Hz++; if (Time100K == 100) { Time100K = 0; Event1K ++; } if (Time2K== 2000) { Time2K=0; //Time100K = 0; Event2K ++; } if (Time500Hz > 200) { // LoopOn Time500Hz -= 200; Event500Hz ++; } if (Time250Hz > 6) { // LoopOn Time250Hz -= 6; Event250Hz ++; } //LoopOff }