109 lines
3.3 KiB
C++
109 lines
3.3 KiB
C++
/*
|
|
* FanControl.cpp
|
|
*
|
|
* Created on: 27.07.2023
|
|
* Author: Carst
|
|
*/
|
|
|
|
#include <stm32g0xx_ll_bus.h>
|
|
#include <stm32g0xx_ll_gpio.h>
|
|
#include <stm32g0xx_ll_tim.h>
|
|
#include "FanControl.hpp"
|
|
|
|
static std::uint32_t fan_speed;
|
|
|
|
extern "C" void TIM14_IRQHandler(void)
|
|
{
|
|
LL_TIM_ClearFlag_UPDATE(TIM14);
|
|
|
|
fan_speed = LL_TIM_GetCounter(TIM2) / 2UL;
|
|
LL_TIM_SetCounter(TIM2, 0UL);
|
|
}
|
|
|
|
namespace ElektronischeLast
|
|
{
|
|
FanControl::FanControl(void)
|
|
{
|
|
/* TIM3 PWM-Output
|
|
* 25kHz (Vorgabe Intel). Geschwindigkeit wird über Tastverhältnis geregelt.
|
|
*/
|
|
LL_TIM_InitTypeDef TIM_InitStruct = {
|
|
.Prescaler = 0UL,
|
|
.CounterMode = LL_TIM_COUNTERMODE_UP,
|
|
.Autoreload = 2559UL,
|
|
.ClockDivision = LL_TIM_CLOCKDIVISION_DIV1,
|
|
};
|
|
LL_TIM_Init(TIM3, &TIM_InitStruct);
|
|
|
|
LL_TIM_DisableARRPreload(TIM3);
|
|
LL_TIM_OC_EnablePreload(TIM3, LL_TIM_CHANNEL_CH1);
|
|
LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {
|
|
.OCMode = LL_TIM_OCMODE_PWM1,
|
|
.OCState = LL_TIM_OCSTATE_ENABLE,
|
|
.OCNState = LL_TIM_OCSTATE_DISABLE,
|
|
.CompareValue = 0UL,
|
|
.OCPolarity = LL_TIM_OCPOLARITY_HIGH,
|
|
};
|
|
LL_TIM_OC_Init(TIM3, LL_TIM_CHANNEL_CH1, &TIM_OC_InitStruct);
|
|
LL_TIM_OC_DisableFast(TIM3, LL_TIM_CHANNEL_CH1);
|
|
LL_TIM_SetTriggerOutput(TIM3, LL_TIM_TRGO_RESET);
|
|
LL_TIM_DisableMasterSlaveMode(TIM3);
|
|
|
|
/* TIM2 Input Capture zur Messung der Geschwindigkeit.
|
|
*/
|
|
TIM_InitStruct.Prescaler = 0;
|
|
TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
|
|
TIM_InitStruct.Autoreload = 0;
|
|
TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV1;
|
|
LL_TIM_Init(TIM2, &TIM_InitStruct);
|
|
LL_TIM_DisableARRPreload(TIM2);
|
|
LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
|
|
LL_TIM_SetTriggerOutput(TIM2, LL_TIM_TRGO_RESET);
|
|
LL_TIM_DisableMasterSlaveMode(TIM2);
|
|
LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ACTIVEINPUT_DIRECTTI);
|
|
LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ICPSC_DIV1);
|
|
LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_FILTER_FDIV1);
|
|
LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_POLARITY_RISING);
|
|
|
|
/* TIM14 1s ISR */
|
|
TIM_InitStruct.Prescaler = 15999;
|
|
TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
|
|
TIM_InitStruct.Autoreload = 999;
|
|
TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV4;
|
|
LL_TIM_Init(TIM14, &TIM_InitStruct);
|
|
LL_TIM_DisableARRPreload(TIM14);
|
|
|
|
/* TIM3 GPIO Configuration
|
|
* PC6 ------> TIM3_CH1
|
|
*/
|
|
LL_GPIO_InitTypeDef GPIO_InitStruct = {
|
|
.Pin = LL_GPIO_PIN_6,
|
|
.Mode = LL_GPIO_MODE_ALTERNATE,
|
|
.Speed = LL_GPIO_SPEED_FREQ_LOW,
|
|
.OutputType = LL_GPIO_OUTPUT_PUSHPULL,
|
|
.Pull = LL_GPIO_PULL_NO,
|
|
.Alternate = LL_GPIO_AF_1,
|
|
};
|
|
LL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
/*T IM2 GPIO Configuration
|
|
* PA15 ------> TIM2_CH1
|
|
*/
|
|
GPIO_InitStruct.Pin = LL_GPIO_PIN_15;
|
|
GPIO_InitStruct.Pull = LL_GPIO_PULL_UP;
|
|
GPIO_InitStruct.Alternate = LL_GPIO_AF_2;
|
|
LL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
|
|
LL_TIM_EnableCounter(TIM3);
|
|
|
|
this->compare_value = 0UL;
|
|
|
|
NVIC_SetPriority(TIM14_IRQn, 0);
|
|
NVIC_EnableIRQ(TIM14_IRQn);
|
|
}
|
|
|
|
void FanControl::run(std::uint32_t temp)
|
|
{
|
|
LL_TIM_OC_SetCompareCH1(TIM3, this->compare_value);
|
|
}
|
|
}
|