68 lines
2.0 KiB
C
68 lines
2.0 KiB
C
/* Includes ----------------------------------------------------------------- */
|
||
#include "bsp\pwm.h"
|
||
|
||
#include <main.h>
|
||
#include <tim.h>
|
||
|
||
/* Private define ----------------------------------------------------------- */
|
||
/* Private macro ------------------------------------------------------------ */
|
||
/* Private typedef ---------------------------------------------------------- */
|
||
/* Private variables -------------------------------------------------------- */
|
||
/* Private function -------------------------------------------------------- */
|
||
/* Exported functions ------------------------------------------------------- */
|
||
int8_t BSP_PWM_Start(BSP_PWM_Channel_t ch) {
|
||
switch (ch) {
|
||
case BSP_PWM_IMU_HEAT:
|
||
HAL_TIM_PWM_Start(&htim10, TIM_CHANNEL_1);
|
||
break;
|
||
case BSP_PWM_SHOOT_SERVO:
|
||
HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
|
||
break;
|
||
}
|
||
return BSP_OK;
|
||
}
|
||
|
||
int8_t BSP_PWM_Set(BSP_PWM_Channel_t ch, float duty_cycle) {
|
||
if (duty_cycle > 1.0f) return BSP_ERR;
|
||
if (duty_cycle < 0.0f) duty_cycle = 0.f;
|
||
|
||
uint16_t pulse;
|
||
|
||
/* 通过PWM通道对应定时器重载值和给定占空比,计算PWM周期值 */
|
||
switch (ch) {
|
||
case BSP_PWM_IMU_HEAT:
|
||
pulse = (uint16_t)(duty_cycle * (float)__HAL_TIM_GET_AUTORELOAD(&htim10));
|
||
break;
|
||
case BSP_PWM_SHOOT_SERVO:
|
||
pulse = (uint16_t)(duty_cycle * (float)__HAL_TIM_GET_AUTORELOAD(&htim1));
|
||
break;
|
||
}
|
||
|
||
if (pulse > 0) {
|
||
switch (ch) {
|
||
case BSP_PWM_IMU_HEAT:
|
||
__HAL_TIM_SET_COMPARE(&htim10, TIM_CHANNEL_1, pulse);
|
||
break;
|
||
case BSP_PWM_SHOOT_SERVO:
|
||
__HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, pulse);
|
||
break;
|
||
}
|
||
} else {
|
||
BSP_PWM_Stop(ch);
|
||
}
|
||
return BSP_OK;
|
||
}
|
||
|
||
int8_t BSP_PWM_Stop(BSP_PWM_Channel_t ch) {
|
||
switch (ch) {
|
||
case BSP_PWM_IMU_HEAT:
|
||
HAL_TIM_PWM_Stop(&htim10, TIM_CHANNEL_1);
|
||
break;
|
||
case BSP_PWM_SHOOT_SERVO:
|
||
HAL_TIM_PWM_Stop(&htim1, TIM_CHANNEL_1);
|
||
break;
|
||
}
|
||
HAL_GPIO_WritePin(IMU_HEAT_PWM_GPIO_Port, IMU_HEAT_PWM_Pin, GPIO_PIN_RESET);
|
||
return BSP_OK;
|
||
}
|