[发明专利]机器人左右轮相对误差标定方法、装置及系统有效
申请号: | 201810015598.X | 申请日: | 2018-01-08 |
公开(公告)号: | CN108388242B | 公开(公告)日: | 2021-05-18 |
发明(设计)人: | 金杭;张利刚 | 申请(专利权)人: | 浙江立石机器人技术有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 广州市越秀区哲力专利商标事务所(普通合伙) 44288 | 代理人: | 胡拥军 |
地址: | 310000 浙江省杭州市*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 左右 相对误差 标定 方法 装置 系统 | ||
1.一种机器人左右轮相对误差标定方法,其特征在于,包括:
围栏设置步骤,设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取步骤,在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动步骤,控制机器人直线行走预定距离L;
第二姿态角获取步骤,在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算步骤,根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
左右轮相对误差计算步骤,根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
误差更正步骤:
多次重复第一姿态角获取步骤、第一姿态角获取步骤、直线运动步骤、第二姿态角获取步骤、弧线半径计算步骤和左右轮相对误差计算步骤,求取左右轮相对误差的平均值。
2.一种机器人左右轮相对误差标定装置,其特征在于,包括:
围栏设置模块,用于设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取模块,用于在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动模块,用于控制机器人直线行走预定距离L;
第二姿态角获取模块,用于在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算模块,用于根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
左右轮相对误差计算模块,用于根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
误差更正模块:
多次重复调用第一姿态角获取模块、第一姿态角获取模块、直线运动模块、第二姿态角获取模块、弧线半径计算模块和左右轮相对误差计算模块,求取左右轮相对误差的平均值。
3.一种机器人左右轮相对误差标定系统,其特征在于,包括:
权利要求2所述的机器人左右轮相对误差标定装置;
围栏,包括相互平行的第一围栏和第二围栏,用于提供标定场地;
激光雷达,安装在机器人顶部中间,用于扫描环境,监测围栏的2条平行线。
4.根据权利要求3所述的机器人左右轮相对误差标定系统,其特征在于,还包括与激光雷达连接的散热装置,用于为激光雷达提供散热功能。
5.根据权利要求3或4所述的机器人左右轮相对误差标定系统,其特征在于,还包括与激光雷达连接的太阳能电源装置,用于为激光雷达提供太阳能电源。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江立石机器人技术有限公司,未经浙江立石机器人技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201810015598.X/1.html,转载请声明来源钻瓜专利网。