1,从车身的运动速度(x,y,w)得到四个轮子的速度:看文章.得到如下结果:vty为沿车身y方向运动的速度.vtx同理.
2,从四个轮子的速度得到车身的运动速度(x,y,w):通过上述文章最后的结论反推即可.
前两个式子求平均(我猜这样量太少会导致不精确)或者四个式子求平均,得到vty.其余的vtx,w同理.
3,得到了底盘的速度,剩下的就和普通二轮差速的底盘里程计计算一样了,固定很短间隔时间内认为运动分量不变,进行积分...
因篇幅问题不能全部显示，请点此查看更多更全内容
Copyright © 2019- haog.cn 版权所有
违法及侵权请联系：TEL:199 1889 7713 E-MAIL:2724546146@qq.com
本站由北京市万商天勤律师事务所王兴未律师提供法律服务
