2017-04-16 06:40:46 -07:00
|
|
|
#include "stm32_gpio.h"
|
|
|
|
|
2017-04-17 03:37:05 -07:00
|
|
|
TIM_HandleTypeDef *handle;
|
2017-04-16 06:40:46 -07:00
|
|
|
|
|
|
|
static uint32_t counter;
|
|
|
|
static uint32_t period;
|
|
|
|
|
|
|
|
#define min(a,b) ((a)<(b)?(a):(b))
|
|
|
|
|
|
|
|
stm32_pwm_disable_callback_func stm32_pwm_disable_callback = NULL;
|
|
|
|
|
2017-04-17 03:37:05 -07:00
|
|
|
void (*pwm_callback_func)();
|
|
|
|
|
|
|
|
void pwm_callback();
|
|
|
|
|
2017-04-16 06:40:46 -07:00
|
|
|
typedef struct {
|
|
|
|
GPIO_TypeDef *port;
|
|
|
|
uint32_t pin_mask;
|
|
|
|
uint16_t frequency;
|
|
|
|
uint16_t duty_cycle;
|
|
|
|
} stm32_pwm_type;
|
|
|
|
|
2017-04-17 03:37:05 -07:00
|
|
|
static stm32_pwm_type pwm_config[sizeof(port_pin_list) / sizeof(port_pin_list[0])];
|
2017-04-16 06:40:46 -07:00
|
|
|
|
|
|
|
void stm32_pwm_disable(GPIO_TypeDef *port, uint32_t pin);
|
|
|
|
|
|
|
|
void analogWrite(uint8_t pin, int value) {
|
2017-04-17 03:37:05 -07:00
|
|
|
static TIM_HandleTypeDef staticHandle;
|
|
|
|
|
|
|
|
if (handle == NULL) {
|
|
|
|
handle = &staticHandle;
|
|
|
|
pwm_callback_func = &pwm_callback;
|
|
|
|
|
2017-04-16 06:40:46 -07:00
|
|
|
stm32_pwm_disable_callback = &stm32_pwm_disable;
|
|
|
|
|
|
|
|
__HAL_RCC_TIM2_CLK_ENABLE();
|
|
|
|
HAL_NVIC_SetPriority(TIM2_IRQn, 0, 0);
|
|
|
|
HAL_NVIC_EnableIRQ(TIM2_IRQn);
|
|
|
|
|
2017-04-17 03:37:05 -07:00
|
|
|
handle->Instance = TIM2;
|
|
|
|
handle->Init.Prescaler = 999;
|
|
|
|
handle->Init.CounterMode = TIM_COUNTERMODE_UP;
|
2017-04-16 06:40:46 -07:00
|
|
|
period = 256;
|
2017-04-17 03:37:05 -07:00
|
|
|
handle->Init.Period = period;
|
|
|
|
handle->Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
|
|
|
HAL_TIM_Base_Init(handle);
|
2017-04-16 06:40:46 -07:00
|
|
|
|
2017-04-17 03:37:05 -07:00
|
|
|
HAL_TIM_Base_Start_IT(handle);
|
2017-04-16 06:40:46 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
for(int i=0; i<sizeof(pwm_config) / sizeof(pwm_config[0]); i++) {
|
|
|
|
if (pwm_config[i].port == NULL ||
|
|
|
|
(pwm_config[i].port == port_pin_list[pin].port
|
|
|
|
&& pwm_config[i].pin_mask == port_pin_list[pin].pin_mask)) {
|
|
|
|
|
|
|
|
if (pwm_config[i].port == NULL) {
|
|
|
|
pinMode(pin, OUTPUT);
|
|
|
|
}
|
|
|
|
|
|
|
|
pwm_config[i].port = port_pin_list[pin].port;
|
|
|
|
pwm_config[i].pin_mask = port_pin_list[pin].pin_mask;
|
|
|
|
pwm_config[i].frequency = 255;
|
|
|
|
pwm_config[i].duty_cycle = value;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void stm32_pwm_disable(GPIO_TypeDef *port, uint32_t pin_mask) {
|
|
|
|
for(int i=0; i<sizeof(pwm_config) / sizeof(pwm_config[0]); i++) {
|
|
|
|
if (pwm_config[i].port == NULL) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (pwm_config[i].port == port && pwm_config[i].pin_mask == pin_mask) {
|
|
|
|
|
|
|
|
for(int j = i + 1; j < sizeof(pwm_config) / sizeof(pwm_config[0]); j++) {
|
|
|
|
if (pwm_config[j].port == NULL) {
|
|
|
|
pwm_config[i].port = pwm_config[j - 1].port;
|
|
|
|
pwm_config[i].pin_mask = pwm_config[j - 1].pin_mask;
|
|
|
|
|
|
|
|
pwm_config[j - 1].port = NULL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-04-17 03:37:05 -07:00
|
|
|
void pwm_callback() {
|
2017-04-16 06:40:46 -07:00
|
|
|
counter += period;
|
|
|
|
period = 256;
|
|
|
|
|
|
|
|
for(int i=0; i<sizeof(pwm_config); i++) {
|
|
|
|
if (pwm_config[i].port != NULL) {
|
|
|
|
if (pwm_config[i].duty_cycle > counter % pwm_config[i].frequency) {
|
|
|
|
pwm_config[i].port->BSRR = pwm_config[i].pin_mask;
|
|
|
|
period = min(period, pwm_config[i].duty_cycle - (counter % pwm_config[i].frequency));
|
|
|
|
} else {
|
|
|
|
pwm_config[i].port->BSRR = pwm_config[i].pin_mask << 16;
|
|
|
|
period = min(period, 256 - counter % pwm_config[i].frequency);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!period) {
|
|
|
|
period = 256;
|
|
|
|
}
|
2017-04-17 03:37:05 -07:00
|
|
|
__HAL_TIM_SET_AUTORELOAD(handle, period);
|
|
|
|
}
|
|
|
|
|
|
|
|
extern void TIM2_IRQHandler(void) {
|
|
|
|
HAL_TIM_IRQHandler(handle);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
extern void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) {
|
|
|
|
if (pwm_callback_func != NULL) {
|
|
|
|
(*pwm_callback_func)();
|
|
|
|
}
|
2017-04-16 06:40:46 -07:00
|
|
|
}
|