59 lines
1.6 KiB
C
59 lines
1.6 KiB
C
|
/*
|
||
|
|
Flipper devices inc.
|
||
|
|
|
||
|
|
GPIO and HAL implementations
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "main.h"
|
||
|
|
#include "gpio.h"
|
||
|
|
|
||
|
|
void app_gpio_init(GpioPin gpio, GpioMode mode) {
|
||
|
|
if(gpio.pin != 0) {
|
||
|
|
GPIO_InitTypeDef GPIO_InitStruct;
|
||
|
|
|
||
|
|
GPIO_InitStruct.Pin = gpio.pin;
|
||
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||
|
|
|
||
|
|
switch(mode) {
|
||
|
|
case GpioModeInput:
|
||
|
|
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case GpioModeOutput:
|
||
|
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
||
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_MEDIUM;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case GpioModeOpenDrain:
|
||
|
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_OD;
|
||
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_MEDIUM;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
HAL_GPIO_Init(gpio.port, &GPIO_InitStruct);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// TODO delay from timer
|
||
|
|
void delay_us(uint32_t time) {
|
||
|
|
time *= 11.8;
|
||
|
|
|
||
|
|
while(time--) {}
|
||
|
|
}
|
||
|
|
|
||
|
|
void pwm_set(float value, float freq, TIM_HandleTypeDef* tim, uint32_t channel) {
|
||
|
|
tim->Init.CounterMode = TIM_COUNTERMODE_UP;
|
||
|
|
tim->Init.Period = (uint32_t)((SystemCoreClock/tim->Init.Prescaler)/freq);
|
||
|
|
tim->Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
|
||
|
|
tim->Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
||
|
|
HAL_TIM_PWM_Init(tim);
|
||
|
|
|
||
|
|
TIM_OC_InitTypeDef sConfigOC;
|
||
|
|
|
||
|
|
sConfigOC.OCMode = TIM_OCMODE_PWM1;
|
||
|
|
sConfigOC.Pulse = (uint16_t)(291 * value);
|
||
|
|
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
|
||
|
|
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
|
||
|
|
HAL_TIM_PWM_ConfigChannel(tim, &sConfigOC, channel);
|
||
|
|
HAL_TIM_PWM_Start(tim, channel);
|
||
|
|
}
|