mirror of
https://gitee.com/dlmu-cone/half-steering-basic-framework
synced 2026-10-23 17:42:20 +08:00
修改RectifyRCjoystick()改了左摇杆限幅
This commit is contained in:
@@ -20,13 +20,32 @@ static DaemonInstance *rc_daemon_instance;
|
||||
* @brief 矫正遥控器摇杆的值,超过660或者小于-660的值都认为是无效值,置0
|
||||
*
|
||||
*/
|
||||
static void RectifyRCjoystick()
|
||||
// static void RectifyRCjoystick()
|
||||
// {
|
||||
// for (uint8_t i = 0; i < 5; ++i)
|
||||
// if (abs(*(&rc_ctrl[TEMP].rc.rocker_l_ + i)) > 660)
|
||||
// *(&rc_ctrl[TEMP].rc.rocker_l_ + i) = 0;
|
||||
// }
|
||||
static void RectifyRCjoystick()//左遥杆水平向右限幅不够,因为下面的+3,将+3删除就用上面的
|
||||
{
|
||||
int16_t *rocker_ptr = &rc_ctrl[TEMP].rc.rocker_l_;
|
||||
for (uint8_t i = 0; i < 5; ++i)
|
||||
if (abs(*(&rc_ctrl[TEMP].rc.rocker_l_ + i)) > 660)
|
||||
*(&rc_ctrl[TEMP].rc.rocker_l_ + i) = 0;
|
||||
{
|
||||
if (i == 0) // 左遥杆水平方向
|
||||
{
|
||||
// 增加右向最大值到700,左向保持660不变
|
||||
if (rocker_ptr[i] > 700)
|
||||
rocker_ptr[i] = 700;
|
||||
else if (rocker_ptr[i] < -660)
|
||||
rocker_ptr[i] = -660;
|
||||
}
|
||||
else // 其他通道保持原限制
|
||||
{
|
||||
if (abs(rocker_ptr[i]) > 660)
|
||||
rocker_ptr[i] = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief 遥控器数据解析
|
||||
*
|
||||
|
||||
Reference in New Issue
Block a user