一种滚动机器人里程计算装置及方法

基本信息

申请号 CN202010474945.2 申请日 -
公开(公告)号 CN111637900A 公开(公告)日 2020-09-08
申请公布号 CN111637900A 申请公布日 2020-09-08
分类号 G01C22/00(2006.01)I 分类 -
发明人 王酉;黄海晖;何梦佳 申请(专利权)人 逻腾(杭州)科技有限公司
代理机构 杭州知见专利代理有限公司 代理人 逻腾(杭州)科技有限公司
地址 310000浙江省杭州市杭州经济开发区白杨街道科技园路20号14幢3层01室-01
法律状态 -

摘要

摘要 本发明公开了一种滚动机器人里程计算装置及方法,包括以下步骤:S01、通过主轴轮速计测量主轴电机转速并转换为滚动机器人绕主轴旋转产生的角速度,通过姿态传感器检测主轴的倾角,解算出滚动机器人的运动轨迹半径,并进行小量近似,解算出最终主位移;S02、通过副轴轮速计测量副轴电机转速并转换为滚动机器人绕副轴旋转产生的圈数,通过姿态传感器测量滚动机器人的倾角,结合主位移运动,通过小量近似,解算最终侧向位移;S03、将该滚动机器人的子运动进行叠加,最终得到位移增加迭代的解析解,从而获得滚动机器人的运动里程。本方法解算得到的最终位姿增量相对定位稳定性强,定位精度更高。