mirror of
https://github.com/dragonpilot/dragonpilot.git
synced 2026-09-15 03:53:43 +08:00
Vehicle Researcher
36 lines
845 B
C
36 lines
845 B
C
void fan_init(void){
|
|
// Init PWM speed control
|
|
pwm_init(TIM3, 3);
|
|
|
|
// Init TACH interrupt
|
|
SYSCFG->EXTICR[0] = SYSCFG_EXTICR1_EXTI2_PD;
|
|
EXTI->IMR |= (1U << 2);
|
|
EXTI->RTSR |= (1U << 2);
|
|
EXTI->FTSR |= (1U << 2);
|
|
NVIC_EnableIRQ(EXTI2_IRQn);
|
|
}
|
|
|
|
void fan_set_power(uint8_t percentage){
|
|
pwm_set(TIM3, 3, percentage);
|
|
}
|
|
|
|
uint16_t fan_tach_counter = 0U;
|
|
uint16_t fan_rpm = 0U;
|
|
|
|
// Can be way more acurate than this, but this is probably good enough for our purposes.
|
|
|
|
// Call this every second
|
|
void fan_tick(void){
|
|
// 4 interrupts per rotation
|
|
fan_rpm = fan_tach_counter * 15U;
|
|
fan_tach_counter = 0U;
|
|
}
|
|
|
|
// TACH interrupt handler
|
|
void EXTI2_IRQHandler(void) {
|
|
volatile unsigned int pr = EXTI->PR & (1U << 2);
|
|
if ((pr & (1U << 2)) != 0U) {
|
|
fan_tach_counter++;
|
|
}
|
|
EXTI->PR = (1U << 2);
|
|
} |