还是我之前回答的方法,基本一致;把距离代入公式应该就可以吧。
距离(s)=固定时间T采集的编码器值 / 编码器线数*(轮子周长);行驶速度 = 距离(S)/ 固定时间T;
前进一周的距离理论上等于周长,但实际值需要测量的,会有一定误差