Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
MTimer.c
- Committer:
- Kovalev_D
- Date:
- 2017-09-25
- Revision:
- 218:b4067cac75c0
- Parent:
- 216:189b0ea1dc38
- Child:
- 220:04c54405b82d
File content as of revision 218:b4067cac75c0:
#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", Spi.DAC_A); 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", Spi.DAC_B, Gyro.Debag, Spi.DAC_A, Gyro.Debag2); 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== 10000) { Time2K=0; //Time100K = 0; Event2K ++; } if (Time500Hz > 200) { // LoopOn Time500Hz -= 200; Event500Hz ++; } if (Time250Hz > 6) { // LoopOn Time250Hz -= 6; Event250Hz ++; } //LoopOff }