2014-01-09 06:20:26 -08:00
|
|
|
/*
|
|
|
|
Copyright 2012-2014 Benjamin Vedder benjamin@vedder.se
|
|
|
|
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "ch.h"
|
|
|
|
#include "hal.h"
|
|
|
|
#include <stm32f4xx.h>
|
|
|
|
#include "stm32f4xx_conf.h"
|
|
|
|
#include "main.h"
|
|
|
|
#include "mcpwm.h"
|
|
|
|
#include "servo.h"
|
|
|
|
#include "comm.h"
|
|
|
|
#include "servo_dec.h"
|
|
|
|
|
|
|
|
CH_IRQ_HANDLER(TIM7_IRQHandler) {
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_PROLOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
TIM_ClearITPendingBit(TIM7, TIM_IT_Update);
|
|
|
|
servo_irq();
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_EPILOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
}
|
|
|
|
|
2014-04-01 10:26:46 -07:00
|
|
|
CH_IRQ_HANDLER(TIM1_UP_IRQHandler) {
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_PROLOGUE();
|
2014-04-01 10:26:46 -07:00
|
|
|
TIM_ClearITPendingBit(TIM1, TIM_IT_Update);
|
|
|
|
mcpwm_update_int_handler();
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_EPILOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
}
|
|
|
|
|
|
|
|
CH_IRQ_HANDLER(ADC1_2_3_IRQHandler) {
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_PROLOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
ADC_ClearITPendingBit(ADC1, ADC_IT_JEOC);
|
|
|
|
mcpwm_adc_inj_int_handler();
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_EPILOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
}
|
|
|
|
|
|
|
|
CH_IRQ_HANDLER(EXTI3_IRQHandler) {
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_PROLOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
if (EXTI_GetITStatus(EXTI_Line3) != RESET) {
|
|
|
|
EXTI_ClearITPendingBit(EXTI_Line3);
|
|
|
|
servodec_int_handler();
|
|
|
|
}
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_EPILOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
}
|
|
|
|
|
|
|
|
CH_IRQ_HANDLER(EXTI15_10_IRQHandler) {
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_PROLOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
if (EXTI_GetITStatus(EXTI_Line13) != RESET) {
|
|
|
|
EXTI_ClearITPendingBit(EXTI_Line13);
|
|
|
|
servodec_int_handler();
|
|
|
|
}
|
|
|
|
|
|
|
|
if (EXTI_GetITStatus(EXTI_Line14) != RESET) {
|
|
|
|
EXTI_ClearITPendingBit(EXTI_Line14);
|
|
|
|
servodec_int_handler();
|
|
|
|
}
|
2014-02-15 14:36:50 -08:00
|
|
|
CH_IRQ_EPILOGUE();
|
2014-01-09 06:20:26 -08:00
|
|
|
}
|
2014-04-02 11:23:27 -07:00
|
|
|
|
|
|
|
CH_IRQ_HANDLER(EXTI9_5_IRQHandler) {
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
if (EXTI_GetITStatus(EXTI_Line5) != RESET) {
|
|
|
|
EXTI_ClearITPendingBit(EXTI_Line5);
|
|
|
|
servodec_int_handler();
|
|
|
|
}
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|