目录前言一、移动机器人底盘控制的核心逻辑1.1 上位机给底盘发送什么1.2 底盘控制器做什么二、两轮差速底盘运动学模型2.1 两轮差速基本原理2.2 差速底盘速度分解代码2.3 轮子线速度转电机 RPM2.3.1 轮子线速度与轮子转速的关系2.3.2 每秒转速转换为每分钟转速2.3.3 考虑减速比后的电机 RPM2.3.4 公式含义总结2.3.5 C 代码实现2.3.6 注意事项三、四轮差速与履带底盘模型3.1 四轮差速底盘简化模型3.2 四轮差速控制注意点3.3 履带底盘控制模型四、阿克曼底盘运动学模型4.1 阿克曼底盘基本模型4.2 阿克曼底盘控制代码4.3 阿克曼底盘工程注意点五、麦克纳姆轮底盘运动学模型5.1 麦克纳姆轮速度分解5.2 麦克纳姆轮代码示例5.3 麦克纳姆轮调试顺序六、里程计计算与工程总结6.1 差速底盘里程计6.2 编码器距离计算6.3 编码器 IMU 融合思路6.4 不同底盘控制难点总结七、总结前言在上一篇文章《一文搞懂移动机器人底盘结构模型》中我们已经对常见移动机器人底盘进行了整体梳理包括两轮差速、四轮差速、履带式、阿克曼、麦克纳姆轮、全向轮以及舵轮 AGV 等典型结构。链接如下一文搞懂移动机器人底盘结构模型-CSDN博客https://blog.csdn.net/m0_58954356/article/details/161477629通过上一章的学习我们主要解决的是一个问题不同移动机器人底盘在结构上有什么区别但是仅仅知道底盘结构还不够。真正进行机器人控制时我们还需要进一步回答机器人想要以某个速度运动时每个轮子到底应该怎么转也就是说移动机器人底盘控制的核心并不是直接控制机器人“往前走”或“向左转”而是要通过运动学模型将机器人整体速度指令转换为每个轮子的速度、角速度、转向角或电机 RPM。本文将围绕常见底盘的运动学建模方法展开重点介绍差速底盘、四轮差速、履带底盘、阿克曼底盘、麦克纳姆轮底盘等模型的速度分解关系、公式推导思路、C 代码实现以及工程调试注意事项。通过本章内容可以帮助读者从“认识底盘结构”进一步过渡到“理解底盘如何运动、如何控制、如何把速度指令转换成电机指令”为后续学习机器人里程计、路径跟踪、导航控制和 ROS 底盘驱动开发打下基础。阿克曼底盘基本模型简化为自行车模型相关推导见之前博客链接运动学模型推导 离散化 工程化版本适用于前方单舵轮 AGV / 自动驾驶 / MPC_lqr 单舵轮模型路径跟随-CSDN博客https://blog.csdn.net/m0_58954356/article/details/154836547一、移动机器人底盘控制的核心逻辑1.1 上位机给底盘发送什么在移动机器人系统中上位机一般不会直接控制每个电机而是发送机器人整体速度指令。常见速度指令为vx // x 方向线速度 vy // y 方向线速度 wz // 绕 z 轴角速度不同底盘使用的速度量不同。两轮差速底盘通常只需要vx wz麦克纳姆轮底盘通常需要vx vy wz阿克曼底盘通常需要v delta其中v表示车辆前进速度delta表示前轮转角。1.2 底盘控制器做什么底盘控制器通常负责以下工作1接收上位机速度指令2解析通信协议3根据底盘模型进行运动学逆解4计算每个轮子的目标速度5将轮速转换为电机转速6发送控制指令给电机驱动器7读取编码器反馈8计算里程计9上传电池、电机、故障和传感器状态。二、两轮差速底盘运动学模型2.1 两轮差速基本原理两轮差速底盘由左右两个主动轮控制运动。当左右轮速度相同机器人直行当左右轮速度不同机器人转弯当左右轮速度大小相等、方向相反机器人原地旋转。设V // 机器人中心线速度 W // 机器人角速度 VL // 左轮线速度 VR // 右轮线速度 L // 左右轮间距则V (VR VL) / 2 W (VR - VL) / L反过来VR V W * L / 2 VL V - W * L / 22.2 差速底盘速度分解代码#include iostream using namespace std; struct DiffWheelSpeed { double left; double right; }; DiffWheelSpeed diff_inverse_kinematics(double v, double w, double wheel_base) { DiffWheelSpeed speed; speed.right v w * wheel_base / 2.0; speed.left v - w * wheel_base / 2.0; return speed; } int main() { double v 0.5; // 机器人线速度 m/s double w 0.3; // 机器人角速度 rad/s double wheel_base 0.6; // 左右轮间距 m DiffWheelSpeed speed diff_inverse_kinematics(v, w, wheel_base); cout left wheel speed speed.left m/s endl; cout right wheel speed speed.right m/s endl; return 0; }2.3 轮子线速度转电机 RPM在移动机器人底盘控制中我们通常会先根据底盘运动学模型计算出左右轮的线速度例如但是在实际电机控制时电机驱动器往往不能直接接收“线速度”而是需要接收电机的转速指令例如也就是每分钟转多少圈。因此需要将轮子的线速度换算成电机转速。2.3.1 轮子线速度与轮子转速的关系设v_wheel // 轮子线速度单位 m/s D // 轮子直径单位 m gear_ratio // 减速比 rpm // 电机转速单位 r/min轮子转动一圈机器人前进的距离等于轮子的周长。2.3.2 每秒转速转换为每分钟转速这个结果表示的是轮子本身的转速还不是电机转速。2.3.3 考虑减速比后的电机 RPM实际机器人底盘中电机通常不会直接驱动车轮而是通过减速器带动车轮运动。也可以写成代码形式rpm v_wheel * 60 * gear_ratio / (PI * D);2.3.4 公式含义总结因此这个公式的本质就是轮子线速度 - 轮子转速 - 电机转速2.3.5 C 代码实现下面给出一个简单的 C 示例用于将轮子线速度转换为电机 RPM。#include iostream #include cmath using namespace std; double wheel_speed_to_rpm(double v_wheel, double wheel_diameter, double gear_ratio) { const double PI 3.1415926; double rpm v_wheel * 60.0 * gear_ratio / (PI * wheel_diameter); return rpm; } int main() { // 轮子线速度单位 m/s double v_wheel 0.5; // 轮子直径单位 m double wheel_diameter 0.15; // 减速比例如 30:1 double gear_ratio 30.0; double rpm wheel_speed_to_rpm(v_wheel, wheel_diameter, gear_ratio); cout motor rpm rpm endl; return 0; }程序运行后输出结果大约为motor rpm 1909.86这表示当轮子线速度为 0.5m/s、轮子直径为 0.15m、减速比为 30:1 时电机大约需要输出1909.86rpm2.3.6 注意事项三、四轮差速与履带底盘模型3.1 四轮差速底盘简化模型四轮差速可以简化成左右两侧差速模型。设V_left // 左侧轮组平均速度 V_right // 右侧轮组平均速度 L // 左右轮距则V (V_right V_left) / 2 W (V_right - V_left) / L反解为V_right V W * L / 2 V_left V - W * L / 2如果四个轮子独立驱动则可以简单分配为front_left V_left rear_left V_left front_right V_right rear_right V_right3.2 四轮差速控制注意点四轮差速和两轮差速公式看起来很像但工程效果不完全一样。原因是四轮差速转弯时四个轮子的理论运动轨迹并不完全一致。特别是原地旋转时轮胎必须发生一定滑移。所以四轮差速调试时要注意1电机功率要足够2轮胎不能太软3地面摩擦不能过大4速度不要突然变化5原地旋转不要频繁长时间执行6编码器里程计需要结合 IMU 修正。3.3 履带底盘控制模型履带底盘本质上也是左右差速控制。设V_left 左履带速度 V_right 右履带速度则V (V_right V_left) / 2 W (V_right - V_left) / L履带底盘的问题是滑移更严重所以编码器里程计误差通常更大。四、阿克曼底盘运动学模型4.1 阿克曼底盘基本模型阿克曼底盘类似汽车结构一般由前轮转向后轮驱动。设x // 车辆 x 坐标 y // 车辆 y 坐标 theta // 车辆航向角 v // 车辆速度 delta // 前轮转角 L // 轴距简化自行车模型为x_dot v * cos(theta) y_dot v * sin(theta) theta_dot v / L * tan(delta)转弯半径为R L / tan(delta)角速度为w v / L * tan(delta)如果已知期望角速度w和速度v可以反求前轮转角delta atan(w * L / v)4.2 阿克曼底盘控制代码#include iostream #include cmath using namespace std; double calculate_steering_angle(double v, double w, double wheel_base) { if (fabs(v) 1e-6) { return 0.0; } return atan(w * wheel_base / v); } int main() { double v 1.0; // 车辆速度 m/s double w 0.3; // 期望角速度 rad/s double wheel_base 1.2; // 轴距 m double delta calculate_steering_angle(v, w, wheel_base); cout steering angle delta rad endl; cout steering angle delta * 180.0 / 3.1415926 deg endl; return 0; }4.3 阿克曼底盘工程注意点阿克曼底盘不能像差速底盘一样直接原地旋转。当速度v很小时不能简单用delta atan(wL/v)否则会出现除零或者转角过大的问题。所以工程中一般要限制最大前轮转角最大角速度最大横向加速度最小转弯半径最大转向角速度。五、麦克纳姆轮底盘运动学模型5.1 麦克纳姆轮速度分解麦克纳姆轮底盘可以实现平面三自由度运动。设vx // 车体 x 方向速度 vy // 车体 y 方向速度 wz // 车体绕 z 轴角速度 r // 轮子半径 lx // 左右半轮距 ly // 前后半轮距设四个轮子编号为w1左前轮 w2右前轮 w3左后轮 w4右后轮一种常见模型为w1 (vx - vy - (lx ly) * wz) / r w2 (vx vy (lx ly) * wz) / r w3 (vx vy - (lx ly) * wz) / r w4 (vx - vy (lx ly) * wz) / r注意不同资料中轮子编号、坐标系方向和滚子安装方向可能不同所以公式正负号也可能不同。5.2 麦克纳姆轮代码示例#include iostream using namespace std; struct MecanumWheelSpeed { double w1; double w2; double w3; double w4; }; MecanumWheelSpeed mecanum_inverse_kinematics( double vx, double vy, double wz, double r, double lx, double ly) { double k lx ly; MecanumWheelSpeed speed; speed.w1 (vx - vy - k * wz) / r; speed.w2 (vx vy k * wz) / r; speed.w3 (vx vy - k * wz) / r; speed.w4 (vx - vy k * wz) / r; return speed; } int main() { double vx 0.5; double vy 0.2; double wz 0.3; double r 0.075; double lx 0.25; double ly 0.20; MecanumWheelSpeed speed mecanum_inverse_kinematics(vx, vy, wz, r, lx, ly); cout w1 speed.w1 endl; cout w2 speed.w2 endl; cout w3 speed.w3 endl; cout w4 speed.w4 endl; return 0; }5.3 麦克纳姆轮调试顺序麦轮底盘调试时建议不要一开始就测试复杂运动而是按照以下顺序1单独测试每个电机方向2测试四轮同时前进3测试四轮同时后退4测试左右横移5测试原地旋转6测试斜向移动7测试复合运动。最常见问题有轮子编号错电机方向反滚子安装方向错坐标系定义不一致左右轮距或前后轮距参数填错。六、里程计计算与工程总结6.1 差速底盘里程计机器人位姿通常表示为pose (x, y, theta)其中x表示世界坐标系 x 方向位置y表示世界坐标系 y 方向位置theta表示航向角。如果机器人线速度为v角速度为w控制周期为dt则delta_s v * dt delta_theta w * dt位姿更新x x delta_s * cos(theta) y y delta_s * sin(theta) theta theta delta_theta代码示例#include iostream #include cmath using namespace std; struct Pose2D { double x; double y; double theta; }; void update_odometry(Pose2D pose, double v, double w, double dt) { pose.x v * dt * cos(pose.theta); pose.y v * dt * sin(pose.theta); pose.theta w * dt; } int main() { Pose2D pose{0.0, 0.0, 0.0}; double v 0.5; double w 0.2; double dt 0.02; for (int i 0; i 100; i) { update_odometry(pose, v, w, dt); } cout x pose.x endl; cout y pose.y endl; cout theta pose.theta endl; return 0; }6.2 编码器距离计算如果使用编码器需要先把编码器脉冲转换成轮子移动距离。设N // 编码器每圈脉冲数 r // 轮子半径 delta_n // 当前周期编码器增量则单个脉冲对应的距离为distance_per_pulse 2πr / N当前周期轮子运动距离为delta_s delta_n * distance_per_pulse如果考虑减速比distance_per_pulse 2πr / (N * gear_ratio)6.3 编码器 IMU 融合思路仅靠编码器会受到轮子打滑影响。仅靠 IMU 会受到漂移影响。所以工程中常用编码器计算位移IMU 修正航向角激光 SLAM 或视觉定位修正全局位置。常见组合方式轮式里程计 IMU 轮式里程计 激光 SLAM 轮式里程计 IMU EKF 轮式里程计 IMU UWB 轮式里程计 IMU 视觉定位6.4 不同底盘控制难点总结底盘类型控制难点里程计难点两轮差速左右轮速度同步打滑和轮距误差四轮差速转弯滑移控制原地旋转误差大履带底盘滑移严重编码器误差大阿克曼底盘转角限制和最小转弯半径低速转向模型不稳定麦克纳姆轮四轮速度解算和安装方向横移误差大全向轮底盘坐标变换和轮速分配地面摩擦影响大舵轮底盘舵角和轮速同步标定复杂七、总结移动机器人底盘控制的本质是把机器人整体速度指令转换成每个轮子的速度、角度或电机转速。对于差速底盘核心是左右轮速度差对于四轮差速和履带底盘核心是左右两侧速度差对于阿克曼底盘核心是车辆速度和前轮转角对于麦克纳姆轮底盘核心是将vx、vy、wz分解到四个轮子对于舵轮底盘核心是同时控制每个轮子的转向角和驱动速度。
移动机器人底盘运动学模型全解析
目录前言一、移动机器人底盘控制的核心逻辑1.1 上位机给底盘发送什么1.2 底盘控制器做什么二、两轮差速底盘运动学模型2.1 两轮差速基本原理2.2 差速底盘速度分解代码2.3 轮子线速度转电机 RPM2.3.1 轮子线速度与轮子转速的关系2.3.2 每秒转速转换为每分钟转速2.3.3 考虑减速比后的电机 RPM2.3.4 公式含义总结2.3.5 C 代码实现2.3.6 注意事项三、四轮差速与履带底盘模型3.1 四轮差速底盘简化模型3.2 四轮差速控制注意点3.3 履带底盘控制模型四、阿克曼底盘运动学模型4.1 阿克曼底盘基本模型4.2 阿克曼底盘控制代码4.3 阿克曼底盘工程注意点五、麦克纳姆轮底盘运动学模型5.1 麦克纳姆轮速度分解5.2 麦克纳姆轮代码示例5.3 麦克纳姆轮调试顺序六、里程计计算与工程总结6.1 差速底盘里程计6.2 编码器距离计算6.3 编码器 IMU 融合思路6.4 不同底盘控制难点总结七、总结前言在上一篇文章《一文搞懂移动机器人底盘结构模型》中我们已经对常见移动机器人底盘进行了整体梳理包括两轮差速、四轮差速、履带式、阿克曼、麦克纳姆轮、全向轮以及舵轮 AGV 等典型结构。链接如下一文搞懂移动机器人底盘结构模型-CSDN博客https://blog.csdn.net/m0_58954356/article/details/161477629通过上一章的学习我们主要解决的是一个问题不同移动机器人底盘在结构上有什么区别但是仅仅知道底盘结构还不够。真正进行机器人控制时我们还需要进一步回答机器人想要以某个速度运动时每个轮子到底应该怎么转也就是说移动机器人底盘控制的核心并不是直接控制机器人“往前走”或“向左转”而是要通过运动学模型将机器人整体速度指令转换为每个轮子的速度、角速度、转向角或电机 RPM。本文将围绕常见底盘的运动学建模方法展开重点介绍差速底盘、四轮差速、履带底盘、阿克曼底盘、麦克纳姆轮底盘等模型的速度分解关系、公式推导思路、C 代码实现以及工程调试注意事项。通过本章内容可以帮助读者从“认识底盘结构”进一步过渡到“理解底盘如何运动、如何控制、如何把速度指令转换成电机指令”为后续学习机器人里程计、路径跟踪、导航控制和 ROS 底盘驱动开发打下基础。阿克曼底盘基本模型简化为自行车模型相关推导见之前博客链接运动学模型推导 离散化 工程化版本适用于前方单舵轮 AGV / 自动驾驶 / MPC_lqr 单舵轮模型路径跟随-CSDN博客https://blog.csdn.net/m0_58954356/article/details/154836547一、移动机器人底盘控制的核心逻辑1.1 上位机给底盘发送什么在移动机器人系统中上位机一般不会直接控制每个电机而是发送机器人整体速度指令。常见速度指令为vx // x 方向线速度 vy // y 方向线速度 wz // 绕 z 轴角速度不同底盘使用的速度量不同。两轮差速底盘通常只需要vx wz麦克纳姆轮底盘通常需要vx vy wz阿克曼底盘通常需要v delta其中v表示车辆前进速度delta表示前轮转角。1.2 底盘控制器做什么底盘控制器通常负责以下工作1接收上位机速度指令2解析通信协议3根据底盘模型进行运动学逆解4计算每个轮子的目标速度5将轮速转换为电机转速6发送控制指令给电机驱动器7读取编码器反馈8计算里程计9上传电池、电机、故障和传感器状态。二、两轮差速底盘运动学模型2.1 两轮差速基本原理两轮差速底盘由左右两个主动轮控制运动。当左右轮速度相同机器人直行当左右轮速度不同机器人转弯当左右轮速度大小相等、方向相反机器人原地旋转。设V // 机器人中心线速度 W // 机器人角速度 VL // 左轮线速度 VR // 右轮线速度 L // 左右轮间距则V (VR VL) / 2 W (VR - VL) / L反过来VR V W * L / 2 VL V - W * L / 22.2 差速底盘速度分解代码#include iostream using namespace std; struct DiffWheelSpeed { double left; double right; }; DiffWheelSpeed diff_inverse_kinematics(double v, double w, double wheel_base) { DiffWheelSpeed speed; speed.right v w * wheel_base / 2.0; speed.left v - w * wheel_base / 2.0; return speed; } int main() { double v 0.5; // 机器人线速度 m/s double w 0.3; // 机器人角速度 rad/s double wheel_base 0.6; // 左右轮间距 m DiffWheelSpeed speed diff_inverse_kinematics(v, w, wheel_base); cout left wheel speed speed.left m/s endl; cout right wheel speed speed.right m/s endl; return 0; }2.3 轮子线速度转电机 RPM在移动机器人底盘控制中我们通常会先根据底盘运动学模型计算出左右轮的线速度例如但是在实际电机控制时电机驱动器往往不能直接接收“线速度”而是需要接收电机的转速指令例如也就是每分钟转多少圈。因此需要将轮子的线速度换算成电机转速。2.3.1 轮子线速度与轮子转速的关系设v_wheel // 轮子线速度单位 m/s D // 轮子直径单位 m gear_ratio // 减速比 rpm // 电机转速单位 r/min轮子转动一圈机器人前进的距离等于轮子的周长。2.3.2 每秒转速转换为每分钟转速这个结果表示的是轮子本身的转速还不是电机转速。2.3.3 考虑减速比后的电机 RPM实际机器人底盘中电机通常不会直接驱动车轮而是通过减速器带动车轮运动。也可以写成代码形式rpm v_wheel * 60 * gear_ratio / (PI * D);2.3.4 公式含义总结因此这个公式的本质就是轮子线速度 - 轮子转速 - 电机转速2.3.5 C 代码实现下面给出一个简单的 C 示例用于将轮子线速度转换为电机 RPM。#include iostream #include cmath using namespace std; double wheel_speed_to_rpm(double v_wheel, double wheel_diameter, double gear_ratio) { const double PI 3.1415926; double rpm v_wheel * 60.0 * gear_ratio / (PI * wheel_diameter); return rpm; } int main() { // 轮子线速度单位 m/s double v_wheel 0.5; // 轮子直径单位 m double wheel_diameter 0.15; // 减速比例如 30:1 double gear_ratio 30.0; double rpm wheel_speed_to_rpm(v_wheel, wheel_diameter, gear_ratio); cout motor rpm rpm endl; return 0; }程序运行后输出结果大约为motor rpm 1909.86这表示当轮子线速度为 0.5m/s、轮子直径为 0.15m、减速比为 30:1 时电机大约需要输出1909.86rpm2.3.6 注意事项三、四轮差速与履带底盘模型3.1 四轮差速底盘简化模型四轮差速可以简化成左右两侧差速模型。设V_left // 左侧轮组平均速度 V_right // 右侧轮组平均速度 L // 左右轮距则V (V_right V_left) / 2 W (V_right - V_left) / L反解为V_right V W * L / 2 V_left V - W * L / 2如果四个轮子独立驱动则可以简单分配为front_left V_left rear_left V_left front_right V_right rear_right V_right3.2 四轮差速控制注意点四轮差速和两轮差速公式看起来很像但工程效果不完全一样。原因是四轮差速转弯时四个轮子的理论运动轨迹并不完全一致。特别是原地旋转时轮胎必须发生一定滑移。所以四轮差速调试时要注意1电机功率要足够2轮胎不能太软3地面摩擦不能过大4速度不要突然变化5原地旋转不要频繁长时间执行6编码器里程计需要结合 IMU 修正。3.3 履带底盘控制模型履带底盘本质上也是左右差速控制。设V_left 左履带速度 V_right 右履带速度则V (V_right V_left) / 2 W (V_right - V_left) / L履带底盘的问题是滑移更严重所以编码器里程计误差通常更大。四、阿克曼底盘运动学模型4.1 阿克曼底盘基本模型阿克曼底盘类似汽车结构一般由前轮转向后轮驱动。设x // 车辆 x 坐标 y // 车辆 y 坐标 theta // 车辆航向角 v // 车辆速度 delta // 前轮转角 L // 轴距简化自行车模型为x_dot v * cos(theta) y_dot v * sin(theta) theta_dot v / L * tan(delta)转弯半径为R L / tan(delta)角速度为w v / L * tan(delta)如果已知期望角速度w和速度v可以反求前轮转角delta atan(w * L / v)4.2 阿克曼底盘控制代码#include iostream #include cmath using namespace std; double calculate_steering_angle(double v, double w, double wheel_base) { if (fabs(v) 1e-6) { return 0.0; } return atan(w * wheel_base / v); } int main() { double v 1.0; // 车辆速度 m/s double w 0.3; // 期望角速度 rad/s double wheel_base 1.2; // 轴距 m double delta calculate_steering_angle(v, w, wheel_base); cout steering angle delta rad endl; cout steering angle delta * 180.0 / 3.1415926 deg endl; return 0; }4.3 阿克曼底盘工程注意点阿克曼底盘不能像差速底盘一样直接原地旋转。当速度v很小时不能简单用delta atan(wL/v)否则会出现除零或者转角过大的问题。所以工程中一般要限制最大前轮转角最大角速度最大横向加速度最小转弯半径最大转向角速度。五、麦克纳姆轮底盘运动学模型5.1 麦克纳姆轮速度分解麦克纳姆轮底盘可以实现平面三自由度运动。设vx // 车体 x 方向速度 vy // 车体 y 方向速度 wz // 车体绕 z 轴角速度 r // 轮子半径 lx // 左右半轮距 ly // 前后半轮距设四个轮子编号为w1左前轮 w2右前轮 w3左后轮 w4右后轮一种常见模型为w1 (vx - vy - (lx ly) * wz) / r w2 (vx vy (lx ly) * wz) / r w3 (vx vy - (lx ly) * wz) / r w4 (vx - vy (lx ly) * wz) / r注意不同资料中轮子编号、坐标系方向和滚子安装方向可能不同所以公式正负号也可能不同。5.2 麦克纳姆轮代码示例#include iostream using namespace std; struct MecanumWheelSpeed { double w1; double w2; double w3; double w4; }; MecanumWheelSpeed mecanum_inverse_kinematics( double vx, double vy, double wz, double r, double lx, double ly) { double k lx ly; MecanumWheelSpeed speed; speed.w1 (vx - vy - k * wz) / r; speed.w2 (vx vy k * wz) / r; speed.w3 (vx vy - k * wz) / r; speed.w4 (vx - vy k * wz) / r; return speed; } int main() { double vx 0.5; double vy 0.2; double wz 0.3; double r 0.075; double lx 0.25; double ly 0.20; MecanumWheelSpeed speed mecanum_inverse_kinematics(vx, vy, wz, r, lx, ly); cout w1 speed.w1 endl; cout w2 speed.w2 endl; cout w3 speed.w3 endl; cout w4 speed.w4 endl; return 0; }5.3 麦克纳姆轮调试顺序麦轮底盘调试时建议不要一开始就测试复杂运动而是按照以下顺序1单独测试每个电机方向2测试四轮同时前进3测试四轮同时后退4测试左右横移5测试原地旋转6测试斜向移动7测试复合运动。最常见问题有轮子编号错电机方向反滚子安装方向错坐标系定义不一致左右轮距或前后轮距参数填错。六、里程计计算与工程总结6.1 差速底盘里程计机器人位姿通常表示为pose (x, y, theta)其中x表示世界坐标系 x 方向位置y表示世界坐标系 y 方向位置theta表示航向角。如果机器人线速度为v角速度为w控制周期为dt则delta_s v * dt delta_theta w * dt位姿更新x x delta_s * cos(theta) y y delta_s * sin(theta) theta theta delta_theta代码示例#include iostream #include cmath using namespace std; struct Pose2D { double x; double y; double theta; }; void update_odometry(Pose2D pose, double v, double w, double dt) { pose.x v * dt * cos(pose.theta); pose.y v * dt * sin(pose.theta); pose.theta w * dt; } int main() { Pose2D pose{0.0, 0.0, 0.0}; double v 0.5; double w 0.2; double dt 0.02; for (int i 0; i 100; i) { update_odometry(pose, v, w, dt); } cout x pose.x endl; cout y pose.y endl; cout theta pose.theta endl; return 0; }6.2 编码器距离计算如果使用编码器需要先把编码器脉冲转换成轮子移动距离。设N // 编码器每圈脉冲数 r // 轮子半径 delta_n // 当前周期编码器增量则单个脉冲对应的距离为distance_per_pulse 2πr / N当前周期轮子运动距离为delta_s delta_n * distance_per_pulse如果考虑减速比distance_per_pulse 2πr / (N * gear_ratio)6.3 编码器 IMU 融合思路仅靠编码器会受到轮子打滑影响。仅靠 IMU 会受到漂移影响。所以工程中常用编码器计算位移IMU 修正航向角激光 SLAM 或视觉定位修正全局位置。常见组合方式轮式里程计 IMU 轮式里程计 激光 SLAM 轮式里程计 IMU EKF 轮式里程计 IMU UWB 轮式里程计 IMU 视觉定位6.4 不同底盘控制难点总结底盘类型控制难点里程计难点两轮差速左右轮速度同步打滑和轮距误差四轮差速转弯滑移控制原地旋转误差大履带底盘滑移严重编码器误差大阿克曼底盘转角限制和最小转弯半径低速转向模型不稳定麦克纳姆轮四轮速度解算和安装方向横移误差大全向轮底盘坐标变换和轮速分配地面摩擦影响大舵轮底盘舵角和轮速同步标定复杂七、总结移动机器人底盘控制的本质是把机器人整体速度指令转换成每个轮子的速度、角度或电机转速。对于差速底盘核心是左右轮速度差对于四轮差速和履带底盘核心是左右两侧速度差对于阿克曼底盘核心是车辆速度和前轮转角对于麦克纳姆轮底盘核心是将vx、vy、wz分解到四个轮子对于舵轮底盘核心是同时控制每个轮子的转向角和驱动速度。
