From 68c43c5adef03f00836d83b37cb83a294d8b0354 Mon Sep 17 00:00:00 2001
From: yincheng.zhong <634916154@qq.com>
Date: 星期四, 13 十一月 2025 17:04:28 +0800
Subject: [PATCH] 晚上SBUS信号解析，成功控制车走
---
STM32H743/FML/pwm_ctrol.c | 114 ++++++++++++++++++++++++++++++++++++++------------------
1 files changed, 77 insertions(+), 37 deletions(-)
diff --git a/STM32H743/FML/pwm_ctrol.c b/STM32H743/FML/pwm_ctrol.c
index fefdff0..263c44c 100644
--- a/STM32H743/FML/pwm_ctrol.c
+++ b/STM32H743/FML/pwm_ctrol.c
@@ -10,6 +10,7 @@
#include "DBG.h"
#include "Uart.h"
#include "HIDO_Util.h"
+#include "SBUS.h"
#define STATE_WAIT_RISING 0
#define STATE_WAIT_FALLING 1
@@ -21,7 +22,7 @@
-// 设置所有电机到指定占空比
+// 锟斤拷锟斤拷锟斤拷锟叫碉拷锟斤拷锟街革拷锟秸硷拷毡锟�
void set_all_pwm(uint16_t duty)
{
__HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, duty);
@@ -34,45 +35,45 @@
__HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_2, duty);
}
-// 向左：前轮左转，后轮右转
+// 锟斤拷锟斤拷前锟斤拷锟斤拷转锟斤拷锟斤拷锟斤拷锟斤拷转
void set_pwm_left()
{
- __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, 1000); // 前左
- __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, 2000); // 前右
- __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, 2000); // 后左
- __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_2, 1000); // 后右
+ __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, 1000); // 前锟斤拷
+ __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, 2000); // 前锟斤拷
+ __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, 2000); // 锟斤拷锟斤拷
+ __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_2, 1000); // 锟斤拷锟斤拷
}
-// 向右：前轮右转，后轮左转
+// 锟斤拷锟揭ｏ拷前锟斤拷锟斤拷转锟斤拷锟斤拷锟斤拷锟斤拷转
void set_pwm_right()
{
- __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, 2000); // 前左
- __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, 1000); // 前右
- __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, 1000); // 后左
- __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_2, 2000); // 后右
+ __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, 2000); // 前锟斤拷
+ __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, 1000); // 前锟斤拷
+ __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, 1000); // 锟斤拷锟斤拷
+ __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_2, 2000); // 锟斤拷锟斤拷
}
-// 映射函数：将 [-100,100] 映射到 [1000,2000]
+// 映锟戒函锟斤拷锟斤拷锟斤拷 [-100,100] 映锟戒到 [1000,2000]
uint32_t Map(int16_t input, int16_t in_min, int16_t in_max, uint32_t out_min, uint32_t out_max)
{
return (input - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
}
-// 设置电机 PWM（前进/后退）
+// 锟斤拷锟矫碉拷锟� PWM锟斤拷前锟斤拷/锟斤拷锟剿ｏ拷
void Set_Motor_PWM(int16_t speed)
{
static HIDO_UINT8 l_Motor[50];
- uint32_t pulse = Map(speed, -100, 100, 1000, 2000); // -100~100 → 1000~2000
+ uint32_t pulse = Map(speed, -100, 100, 1000, 2000); // -100~100 锟斤拷 1000~2000
__HAL_TIM_SetCompare(&MOTOR_TIM, MOTOR_CHANNEL, pulse);
HIDO_UtilSnprintf((HIDO_CHAR *)l_Motor, sizeof(l_Motor), "Motor cortrol:speed=%d,pulse=%d\r\n", speed,pulse);
Uart_Send(UART_ID_DBG, (HIDO_UINT8 *)l_Motor, strlen(l_Motor));
}
-// 设置转向 PWM（左转/右转）
+// 锟斤拷锟斤拷转锟斤拷 PWM锟斤拷锟斤拷转/锟斤拷转锟斤拷
void Set_Steering_PWM(int16_t steer)
{
static HIDO_UINT8 l_Steering[50];
- uint32_t pulse = Map(steer, -100, 100, 1000, 2000); // -100~100 → 1000~2000
+ uint32_t pulse = Map(steer, -100, 100, 1000, 2000); // -100~100 锟斤拷 1000~2000
__HAL_TIM_SetCompare(&STEERING_TIM, STEERING_CHANNEL, pulse);
HIDO_UtilSnprintf((HIDO_CHAR *)l_Steering, sizeof(l_Steering), "Steering cortrol:steer=%d,pulse=%d\r\n", steer,pulse);
Uart_Send(UART_ID_DBG, (HIDO_UINT8 *)l_Steering, strlen(l_Steering));
@@ -89,40 +90,79 @@
if (capture_state == STATE_WAIT_RISING)
{
- // 当前是上升沿 → 记录并切换到等待下降沿
+ // 锟斤拷前锟斤拷锟斤拷锟斤拷锟斤拷 锟斤拷 锟斤拷录锟斤拷锟叫伙拷锟斤拷锟饺达拷锟铰斤拷锟斤拷
rising_time = current_time;
- // 切换为下降沿触发
- htim->Instance->CCER &= ~TIM_CCER_CC1P; // 上升沿
- htim->Instance->CCER |= TIM_CCER_CC1NP; // 加上 NP 表示非反相？实际应使用极性控制函数
+ // 锟叫伙拷为锟铰斤拷锟截达拷锟斤拷
+ htim->Instance->CCER &= ~TIM_CCER_CC1P; // 锟斤拷锟斤拷锟斤拷
+ htim->Instance->CCER |= TIM_CCER_CC1NP; // 锟斤拷锟斤拷 NP 锟斤拷示锟角凤拷锟洁？实锟斤拷应使锟矫硷拷锟皆匡拷锟狡猴拷锟斤拷
- // 更推荐使用 HAL 函数设置极性
+ // 锟斤拷锟狡硷拷使锟斤拷 HAL 锟斤拷锟斤拷锟斤拷锟矫硷拷锟斤拷
__HAL_TIM_SET_CAPTUREPOLARITY(htim, TIM_CHANNEL_1, TIM_INPUTCHANNELPOLARITY_FALLING);
capture_state = STATE_WAIT_FALLING;
}
else if (capture_state == STATE_WAIT_FALLING)
{
- // 当前是下降沿 → 计算高电平宽度
+ // 锟斤拷前锟斤拷锟铰斤拷锟斤拷 锟斤拷 锟斤拷锟斤拷叩锟狡斤拷锟斤拷锟�
uint32_t pulse_width = current_time - rising_time;
- if (pulse_width > 65535) // 超过最大合理值
+ if (pulse_width > 65535) // 锟斤拷锟斤拷锟斤拷锟斤拷锟斤拷值
{
- pulse_width = 0; // 或者标记为无效
+ pulse_width = 0; // 锟斤拷锟竭憋拷锟轿拷锟叫�
}
- //printf("High Pulse Width: %lu μs\n", pulse_width);
+ //printf("High Pulse Width: %lu 锟斤拷s\n", pulse_width);
HIDO_UtilSnprintf((HIDO_CHAR *)l_pulse_width, sizeof(l_pulse_width), "pulse_width=%d\r\n", pulse_width);
Uart_Send(UART_ID_DBG, (HIDO_UINT8 *)l_pulse_width, strlen(l_pulse_width));
- // 切回上升沿触发
+ // 锟叫伙拷锟斤拷锟斤拷锟截达拷锟斤拷
__HAL_TIM_SET_CAPTUREPOLARITY(htim, TIM_CHANNEL_1, TIM_INPUTCHANNELPOLARITY_RISING);
capture_state = STATE_WAIT_RISING;
}
- // 清除中断标志
+ // 锟斤拷锟斤拷卸媳锟街�
__HAL_TIM_CLEAR_IT(htim, TIM_IT_CC1);
}
}
+uint32_t steering_pulse,motor_pulse;
+void SBUS_Control_PWM(void)
+{
+ ST_SBUSData sbusData;
+
+ // 鑾峰彇 SBUS 鏁版嵁
+ if (SBUS_GetData(&sbusData) != HIDO_TRUE)
+ {
+ return; // 娌℃湁鏈夋晥鏁版嵁
+ }
+
+ // CH0: 杞悜閫氶亾 (200-1800) -> (1000-2000us)
+ uint16_t ch0 = sbusData.m_au16Channels[0];
+ if (ch0 < 200) ch0 = 200;
+ if (ch0 > 1800) ch0 = 1800;
+ steering_pulse = ((ch0 - 200) * 1000) / 1600 + 1000;
+
+ // CH1: 琛岃繘閫氶亾 (200-1800) -> (1000-2000us)
+ uint16_t ch1 = sbusData.m_au16Channels[1];
+ if (ch1 < 200) ch1 = 200;
+ if (ch1 > 1800) ch1 = 1800;
+ motor_pulse = ((ch1 - 200) * 1000) / 1600 + 1000;
+
+ // 璁剧疆 PWM 杈撳嚭
+ __HAL_TIM_SetCompare(&STEERING_TIM, STEERING_CHANNEL, steering_pulse);
+ __HAL_TIM_SetCompare(&MOTOR_TIM, MOTOR_CHANNEL, motor_pulse);
+}
+// 鐩存帴璁剧疆鑴夊锛堝井绉掞級
+void Set_Steering_Pulse(uint32_t pulse_us)
+{
+ steering_pulse = pulse_us;
+ __HAL_TIM_SetCompare(&STEERING_TIM, STEERING_CHANNEL, steering_pulse);
+}
+
+void Set_Motor_Pulse(uint32_t pulse_us)
+{
+ motor_pulse = pulse_us;
+ __HAL_TIM_SetCompare(&MOTOR_TIM, MOTOR_CHANNEL, motor_pulse);
+}
#if 0
/**
* @brief Update Callback (for overflow protection)
@@ -131,10 +171,10 @@
{
if (htim->Instance == TIM4)
{
- // 只在长时间无响应时才重置状态
+ // 只锟节筹拷时锟斤拷锟斤拷锟斤拷应时锟斤拷锟斤拷锟斤拷状态
static uint32_t last_reset_ms = 0;
- if (HAL_GetTick() - last_reset_ms > 100) // 100ms 超时
+ if (HAL_GetTick() - last_reset_ms > 100) // 100ms 锟斤拷时
{
capture_state = 0;
__HAL_TIM_SET_CAPTUREPOLARITY(htim, TIM_CHANNEL_1, TIM_INPUTCHANNELPOLARITY_RISING);
@@ -154,30 +194,30 @@
if (capture_state == 0)
{
- // 上升沿：记录起始时间
+ // 锟斤拷锟斤拷锟截ｏ拷锟斤拷录锟斤拷始时锟斤拷
rising_time = current_value;
printf("Rising Edge: %lu\r\n", rising_time);
- // 切换为下降沿检测
+ // 锟叫伙拷为锟铰斤拷锟截硷拷锟�
__HAL_TIM_SET_CAPTUREPOLARITY(htim, TIM_CHANNEL_1, TIM_INPUTCHANNELPOLARITY_FALLING);
capture_state = 1;
}
else if (capture_state == 1)
{
- // 下降沿：计算脉宽
+ // 锟铰斤拷锟截ｏ拷锟斤拷锟斤拷锟斤拷锟斤拷
falling_time = current_value;
pulse_width_us = falling_time - rising_time;
- // 防止负数（防止溢出）
- if (pulse_width_us > 65535) // 超过最大合理值
+ // 锟斤拷止锟斤拷锟斤拷锟斤拷锟斤拷止锟斤拷锟斤拷锟�
+ if (pulse_width_us > 65535) // 锟斤拷锟斤拷锟斤拷锟斤拷锟斤拷值
{
- pulse_width_us = 0; // 或者标记为无效
+ pulse_width_us = 0; // 锟斤拷锟竭憋拷锟轿拷锟叫�
}
printf("Falling Edge: %lu\r\n", falling_time);
- printf("Pulse Width: %lu μs\r\n", pulse_width_us);
+ printf("Pulse Width: %lu 锟斤拷s\r\n", pulse_width_us);
- // 重新设置为上升沿，等待下一个周期
+ // 锟斤拷锟斤拷锟斤拷锟斤拷为锟斤拷锟斤拷锟截ｏ拷锟饺达拷锟斤拷一锟斤拷锟斤拷锟斤拷
__HAL_TIM_SET_CAPTUREPOLARITY(htim, TIM_CHANNEL_1, TIM_INPUTCHANNELPOLARITY_RISING);
capture_state = 0;
}
--
Gitblit v1.9.3