差速车走四分之一圆,为什么不能把弧长沿最终朝向直接平移
轮距1m、左轮π/4m、右轮3π/4m,中心弧长π/2m、转角π/2rad,从(0,0)、朝+x开始的理想终点为(1,1)。把整段弧长沿最终朝向平移会错误得到(0,π/2)。
本文由器赋开物编辑整理,AI 辅助撰写。下面输入是合成对照,用于复算公式或协议规则,没有连接真实设备完成现场验证。
本次具体要判断什么?
任务是核对合成轮式里程计的空间积分算法。假定本段左右轮行程比例恒定、无打滑,有效轮距1m;输入的是这一段增量而非编码器累计值。用四分之一圆构造几何可独立判断的终点,区别于旧差速速度计算器的线速度与角速度任务。
先保存可复算的对照输入
打开差速轮行程圆弧位姿积分工具,把默认值改为下表场景。文字或字节过长时这里只展示摘要,完整原始输入在附件中。
| 输入项目 | 对照值 | 单位或格式 |
|---|---|---|
| 本段左轮行程增量 | 0.7853981633974483 | m |
| 本段右轮行程增量 | 2.356194490192345 | m |
| 有效轮距 | 1 | m |
| 起始x | 0 | m |
| 起始y | 0 | m |
| 起始朝向,逆时针正 | 0 | ° |
模型或规则得到什么结果?
s=(ΔL+ΔR)/2;θ=(ΔR−ΔL)/b;位移=s×sinc(θ/2)[cos(ψ+θ/2),sin(ψ+θ/2)]
| 结果项目 | 对照输出 | 单位 |
|---|---|---|
| 终点x | 1 | m |
| 终点y | 1 | m |
| 累计终点朝向,未归一化 | 90 | ° |
| 中心有符号弧长 | 1.57079632679 | m |
| 本段转角 | 1.57079632679 | rad |
一段恒定轮行程比例下的精确圆弧积分,左转为正、起始朝向沿+x;轮行程是本段增量而非累计读数。无陀螺修正,忽略打滑和轮距误差,不能当全局定位真值。
下载本例完整输入、输出与核验记录 JSON。64 位整数按字符串保留,未四舍五入的计算值保存在附件;设备、仪器和实际结论栏目留空,不把预测当测量。
怎样核对和排查?
平均行程s=(π/4+3π/4)/2=π/2m,轮差除轮距得到θ=π/2rad。中心圆弧半径R=s/θ=1m,故局部位移为(Rsinθ,R(1−cosθ))=(1,1)m。工具用中间朝向与sinc的等价式积分,终点应约(1,1)、90°。检查代码时用这个几何向量对照,尤其排除“先改朝向再把全部s投影”或“始终沿旧朝向直行”的两种错误。
哪些做法容易误判?
这一段恒曲率模型不适合把任意变化速度的长路径只累计成两个总轮程再积分;应按变化分段。实际轮径、轮距和滑移误差也会累计,几何向量通过不代表机器人已经定位准确。
什么条件才足以接受结论?
接受算法对照必须复得x≈1、y≈1、朝向≈90°,并保存轮程增量与坐标约定。正式里程计需进一步验证采样同步、轮程符号、尺度与外部参考误差,本例只验证圆弧积分数学。
适用范围与相关资料
继续查阅相关原理或其他工具。使用不同工具时先核对输入单位、模型和协议版本,避免把一个场景的结论直接套到另一个场景。
行程是本段增量、同一时间窗口且比例恒定,忽略打滑,无陀螺校正;不是WPILib带陀螺融合API的复刻。
依据:WPILib:差速里程计坐标与轮行程。实现检查覆盖了独立算例和拒绝路径;工具自身通过测试不能替代你对硬件、SDK版本和业务规则的核验。
继续处理相邻任务
本文为公开资料整理,非亲测。关键参数与代码请结合实物与下列官方来源验证。
- WPILib:差速里程计坐标与轮行程 ↗
docs.wpilib.org/en/stable/docs/software/kinematics-and-odometry/differential-drive-odometry.html