[发明专利]二维码以及用于机器人的视觉-惯性组合导航系统及方法

说明书

本发明实施例提供了一种二维码以及用于机器人的视觉‑惯性组合导航系统及方法。二维码的外围带有封闭的辅助边框，该辅助边框和二维码均用于视觉导航。用于机器人的视觉‑惯性组合导航系统采用前述二维码。用于机器人的视觉‑惯性组合导航方法包括：在地面上铺设多个外围带有封闭的辅助边框的二维码；在机器人行进过程中，成像设备拍摄图像；获取成像设备的绝对位置和绝对方向角，获得二维码的绝对坐标，成像设备的绝对位置和绝对方向角；确定机器人相对其当前起始点的相对位置和相对其当前起始方向角的相对方向角；得到机器人的绝对位置，利用该绝对位置作为下一起始点；得到机器人的绝对方向角，利用该绝对方向角作为下一起始方向角。

相关申请的交叉引用

本申请为2015年6月1日提交的中国专利申请号为“201510293436.9”的分案申请，其全部内容作为整体并入本申请中。

技术领域

本发明涉及导航领域，具体而言涉及一种二维码以及用于机器人的视觉-惯性组合导航系统及方法。

背景技术

视觉-惯性组合导航凭借其良好的互补性和自主性逐渐成为导航领域的重要发展方向和极具发展前景的导航技术。惯性导航是一种不依赖外界信息的自主式导航系统，具有实时性好、抗干扰性强等优点，但其精度误差会造成累积漂移误差,在较长时间内难以达到定位的要求。因此，在视觉/惯性组合导航中，视觉导航用以辅助定位修正惯性导航的漂移,从而提供一种高精度的组合定位方式。从工程应用角度看，视觉导航的精确性、鲁棒性和实时性是影响视觉/惯性组合导航性能的重要因素。

发明内容

鉴于背景技术中存在的问题，本发明的目的在于提供一种二维码以及用于机器人的视觉-惯性组合导航系统及方法，其能有效加快二维码区域的筛选效率、成像设备的绝对位置和绝对方向角的计算效率，实时地修正惯性导航的漂移，以更可靠地以视觉/惯性组合的方式实现机器人的高精度实时导航。

为了实现上述目的，在第一方面，本发明实施例提供了一种二维码，其中所述二维码的外围带有封闭的辅助边框，该辅助边框和所述二维码均用于视觉导航。

为了实现上述目的，在第二方面，本发明实施例提供了一种用于机器人的视觉-惯性组合导航方法，包括：

控制设置在机器人上的成像设备拍摄机器人在行进路线上经过铺设在地面上的外围带有辅助边框的二维码，以获得二维码的图像；

针对拍摄的二维码的图像进行边缘提取，以获得边缘图像；

针对边缘图像进行筛选，以获得封闭的轮廓曲线；

针对封闭的轮廓曲线进行多边形拟合，并将辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框；

基于辅助边框确定辅助边框内的区域为二维码区域；

基于确定的辅助边框和确定的二维码区域，计算成像设备相对于二维码区域的相对位置和相对方向角；

利用二维码扫描程序对二维码的图像在二维码区域内进行扫描，以扫描二维码，并基于二维码编码规则对扫描后的二维码进行解码和校验，以获得二维码的绝对坐标；

基于计算出的成像设备的相对位置和相对方向角以及获得的二维码的绝对坐标，经坐标系转换，获得成像设备的绝对位置和绝对方向角，作为惯性导航中修正机器人位置的视觉导航数据；

获得机器人相对机器人的当前起始点的相对位置以及机器人相对机器人的当前起始方向角的相对方向角；机器人的相对位置和相对方向角是由设置在机器人上的编码器和惯性导航系统确定的；