累计编码器从100到101米,里程积分应输入101还是1
应输入本段增量1m。合成日志左轮100→101m、右轮200→201m,增量各1m;从(2,3)m、90°开始,终点应为(2,4)m,而不是把累计读数再次当新行程。
本文由器赋开物编辑整理,AI 辅助撰写。下面输入是合成对照,用于复算公式或协议规则,没有连接真实设备完成现场验证。
本次具体要判断什么?
任务是把累计编码器日志转成里程积分输入,防止同一历史行程重复累加。合成前一时刻读数左100m、右200m,后一时刻左101m、右201m;此前位姿已累计到(2,3)m、朝北90°。这些累计偏置只是计数器初值不同,并不意味着右轮本段比左轮多走100m。
先保存可复算的对照输入
打开差速轮行程圆弧位姿积分工具,把默认值改为下表场景。文字或字节过长时这里只展示摘要,完整原始输入在附件中。
| 输入项目 | 对照值 | 单位或格式 |
|---|---|---|
| 本段左轮行程增量 | 1 | m |
| 本段右轮行程增量 | 1 | m |
| 有效轮距 | 0.5 | m |
| 起始x | 2 | m |
| 起始y | 3 | m |
| 起始朝向,逆时针正 | 90 | ° |
模型或规则得到什么结果?
s=(ΔL+ΔR)/2;θ=(ΔR−ΔL)/b;位移=s×sinc(θ/2)[cos(ψ+θ/2),sin(ψ+θ/2)]
| 结果项目 | 对照输出 | 单位 |
|---|---|---|
| 终点x | 2 | m |
| 终点y | 4 | m |
| 累计终点朝向,未归一化 | 90 | ° |
| 中心有符号弧长 | 1 | m |
| 本段转角 | 0 | rad |
一段恒定轮行程比例下的精确圆弧积分,左转为正、起始朝向沿+x;轮行程是本段增量而非累计读数。无陀螺修正,忽略打滑和轮距误差,不能当全局定位真值。
下载本例完整输入、输出与核验记录 JSON。64 位整数按字符串保留,未四舍五入的计算值保存在附件;设备、仪器和实际结论栏目留空,不把预测当测量。
怎样核对和排查?
先在同一时间窗口分别做差:左101−100=1m,右201−200=1m。将这两个增量输入后,中心弧长1m、轮差0,朝向保持90°;世界坐标位移为(1cos90°,1sin90°)≈(0,1)m,因此终点(2,4)m。检查路径先确认日志字段是累计值还是周期增量,再对齐左右快照时间,最后把上次积分终点作为本次起点。若编码器曾清零或重启,跨重置区间不能未经处理就直接做差。
哪些做法容易误判?
把101与201原样输入会同时伪造巨大中心行程和巨大转角;把初始位姿也重置为0则会丢失世界坐标历史。累计值差分与速度乘周期是不同数据入口,二者不能对同一段重复积分。计数回绕还需先按实际位宽恢复正确增量。
什么条件才足以接受结论?
合成核验应保存前后四个累计读数、两个1m增量和起始位姿,最终复得(2,4)m、90°。正式日志验收还需证明时间同步、重置处理和单位换算有效;本页不读取编码器硬件,也不把纯轮程积分等同全局定位真值。
适用范围与相关资料
继续查阅相关原理或其他工具。使用不同工具时先核对输入单位、模型和协议版本,避免把一个场景的结论直接套到另一个场景。
行程是本段增量、同一时间窗口且比例恒定,忽略打滑,无陀螺校正;不是WPILib带陀螺融合API的复刻。
依据:WPILib:差速里程计坐标与轮行程。实现检查覆盖了独立算例和拒绝路径;工具自身通过测试不能替代你对硬件、SDK版本和业务规则的核验。
继续处理相邻任务
本文为公开资料整理,非亲测。关键参数与代码请结合实物与下列官方来源验证。
- WPILib:差速里程计坐标与轮行程 ↗
docs.wpilib.org/en/stable/docs/software/kinematics-and-odometry/differential-drive-odometry.html