CN106323294A - 变电站巡检机器人定位方法及定位装置 - Google Patents

变电站巡检机器人定位方法及定位装置 Download PDF

Info

Publication number
CN106323294A
CN106323294A CN201610961927.0A CN201610961927A CN106323294A CN 106323294 A CN106323294 A CN 106323294A CN 201610961927 A CN201610961927 A CN 201610961927A CN 106323294 A CN106323294 A CN 106323294A
Authority
CN
China
Prior art keywords
coordinate
robot
rightarrow
mobile robot
quick response
Prior art date
Application number
CN201610961927.0A
Other languages
English (en)
Inventor
袁亮
侯爱萍
刘祖兵
姜道伟
罗高
巨刚
蒋伟
何巍
Original Assignee
新疆大学
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 新疆大学 filed Critical 新疆大学
Priority to CN201610961927.0A priority Critical patent/CN106323294A/zh
Publication of CN106323294A publication Critical patent/CN106323294A/zh

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Abstract

本发明涉及变电站智能巡检技术领域,是一种变电站巡检机器人定位方法及定位装置,前者包括第一步建立坐标系,第二步计算里程计的定位结果,第三步计算移动机器人的位姿,第四步修正定位结果;后者包括驱动机器人运动的轮式平台、机器人运动控制器、编码器、通信模块、摄像机和云台,轮式平台沿圆周等间距安装有三个全向轮,三个全向轮上各安装有一个编码器,云台底部设有支撑轴,支撑轴固定安装在轮式平台上,摄像机安装在云台的顶部。本发明采用编码器与二维码方式相结合定位,即使在二维码有障碍物遮挡的情况下仍然可以知道移动机器人的位置。变电站巡检机器人使用二维码的定位方法,在室内与室外环境下都可以使用。

Description

变电站巡检机器人定位方法及定位装置
技术领域
[0001] 本发明涉及变电站智能巡检技术领域,是一种变电站巡检机器人定位方法及定位 装置。
背景技术
[0002] 现有的移动机器人的定位有基于里程计的定位、基于惯性传感器的定位、视觉定 位、超声定位、地图匹配定位、基于多种传感信息的定位、路标与灯塔的定位和同时定位与 地图构建(SLAM)等定位方式。目前,变电站智能巡检机器人主要包括轨道式巡检机器人和 轮式巡检机器人。轨道式巡检机器人系统是由设置在轨道上的定位片对机器人进行定位, 定位精度高,但其能够巡检的空间有限,只能在固定的轨道中移动。轮式巡检机器人定位方 式主要是依靠磁轨道进行定位和利用自身传感器系统进行定位,依靠磁轨道进行定位需要 事先在底下铺设磁轨道,成本较高,行动范围有限;依靠自身传感器进行定位可以使机器人 在大范围内进行移动,但传统的方式是使用激光扫描雷达使机器人进行自定位,成本高昂, 机器人不能实现智能定位。
[0003] 发明专利201210186563.5公布了一种基于二维码的移动机器人定位系统和方法, 将视觉定位技术、二维码定位技术及两自由度测速技术有机结合在一起,实现了对移动机 器人的准确定位功能,解决了传统视觉定位在图像处理上过于复杂和定位精度不够准确的 问题。该方法存在的问题是:1、施工难度大,对人工和环境设备要求非常苛刻,形成人工成 本和设备成本的高投入;2、容错性差,移动机器人运行非常不稳定:由于采用一个二维码读 码器定位的方法不能容错人工和设备的误差而常常造成误判断,致使移动机器人不得不长 期处于大幅度位姿调整的状态,移动机器人运行时机体晃动、摇摆不定,严重影响了稳定 性。3、该方法由于采用随动轮测速机构来检测移动机器人的速度,没有对随动轮打滑的情 况进行考虑,会造成测速机构所测得的速度不够准确。
[0004] 发明专利201210472984.4公布了一种基于多个二维码读码器的移动机器人定位 系统及方法。该方法是在机器人与地面上安装至少两个二维码读码器和分布于地面上的二 维码标签,每次至少同时读取两个二维码标签来实现对移动机器人的定位,有效容错性差, 以及读取单个二维码标签所带来的不足。但是该方法仍然存在以下缺点与不足:1、由于二 维码张贴在地面上,因此对于地面的平整度要求较高,对环境要求较为苛刻,并且该方法只 能适用于室内移动机器人的定位,在室外等情况下无法适用;2、该方法在张贴二维码时施 工难度较大,对人工和环境设备要求较为严格,容易形成较高的人工成本与设备成本。
发明内容
[0005] 本发明提供了一种变电站巡检机器人定位装置和方法,克服了上述现有技术之不 足,其能有效解决现有技术中存在的移动机器人稳定性差、容错性差以及移动机器人不能 适用于室外移动定位的问题。
[0006] 本发明的技术方案之一是通过以下措施来实现的:变电站巡检机器人定位方法包 括以下步骤:
[0007] 第一步,建立坐标系,建立世界坐标系0ΧΥΖ,二维码坐标系01X1y1Z1,摄像机坐标系 02X2y2Z2,云台a部分坐标系03X3y3Z3,云台b部分坐标系03X4y4Z4和机器人坐标系05X5y5Z5;
[0008] 第二步,计算里程计的定位结果施,对移动机器人进行运动学建模,使用三轮全向 轮移动机器人作为移动平台,Χ0Υ为世界坐标系, X0y为机器人坐标系,移动机器人的三个轮 子分别标记为i,j,k,三个轮子各自的线速度分别为Vi,Vj,Vk,在机器人坐标系中,移动机器 人在X轴和Y轴两个坐标上的速度分别为v x,vy,方向与坐标轴方向相同,机器人自身旋转的 角速度为《,R为轮子到机器人中心点0的距离;在世界坐标系中机器人沿两坐标轴的速度 分别为Vx,V Y,通过分析可得在机器人坐标系中根据机器人三个全向轮的线速度可以计算出 机器人的速度为:
Figure CN106323294AD00071
[0010] 机器人坐标系与世界坐标系的夹角为Φ,由机器人坐标系中的速度可以计算得到 在世界坐标系下的速度为:
Figure CN106323294AD00072
[0012] 移动机器人的初始姿态为(XQ,yQ,Φο),At时间后移动机器人的姿态为( xi,yi, Φΐ),计算公式如下:
Figure CN106323294AD00073
[0014] 因移动机器人在地面运动,移动机器人的位姿用施表示为:
[0015] Mi = (xi, yi, Φ ι) τ ;
[0016] 第三步,通过二维码图像计算移动机器人的位姿Μ2,包括以下步骤:
[0017] (1)通过图像处理,读取二维码的信息,包括以下步骤:(a)相机拍照,(b)灰度化, (c)二值化,(d)形态学滤波,(e)边缘检测,(f)霍夫直线变换,(g)透视变换,(h)二维码信息 读取;
[0018] (2)通过二维码计算摄像机坐标系〇2X2y2Z2相对于二维码坐标系oixiyizi的旋转矩 阵/R以及平移矩阵P 12,计算方法如下:
[0019] 二维码贴在X1〇iyi平面中,Z1轴垂直于墙面向外,移动机器人相机镜头的朝向为 Z2 轴,镜体方向为χ2轴,图像信息位于x202y2坐标中;设边A0长度为lengthAQ,边ΑιΟι的长度为 标定时假设当物体距离相机距离为lm时,实际中物体的长度和图像中物体长
[0020] 度的比为m,相机与二维码之间的距离计算公式如下:
Figure CN106323294AD00081
[0022]已知二维码张贴高度h,移动机器人高清摄像机距离二维码的长度为1,则:
Figure CN106323294AD00082
[0024] 在世界坐标系中ZA0B = 90°在相机坐标系中ΖΑι0ιΒι = θ,〇2X2y2Z2相对于oixiyizi 绕z轴旋转-90°,然后在zi轴方向不再转动,在移动机器人运动和相机云台运动过程中,相 对于zi轴不再旋转,只相对于XI轴和yi轴转动,绕XI转动用θχ表示,绕yi轴用θ γ表示。02X2y2Z2 中的坐标在omyizi坐标中如下表示:
Figure CN106323294AD00083
[0027] 其中
Figure CN106323294AD00084
[0030] Δ z = h
[0031] Ax = l*sina
[0032] Λ y = l*cosa
[0033] 3个未知数θχ,θ,β,需要3个方程,则0A,OB在x1〇iyi平面中可表示为:
[0034] m = (a,b,〇h〇B^(e,dfi)
[0035] 在〇2X2y2Z2坐标系中:
Figure CN106323294AD00085
[0041] Z2轴与xi轴之间的夹角为
Figure CN106323294AD00091
[0043] 其中r已知,_0ίιΧ可用β表示;根据Z2轴在oixiyizi坐标系中的向量得到关于β的方程;
Figure CN106323294AD00092
[0045] 联立方程⑴(2)⑶可求得θχ,θγ,和β,得到 〇2X2y;Jlj〇lXlylZl的转换矩阵决,.以及平 移矩阵Pl2;
[0046] (3)各个坐标系之间旋转矩阵与平移矩阵的计算:
[0047] 在世界坐标系中,设定二维码的位置为(XI,yi,ζι),二维码坐标系oixiyizi相对于 世界坐标系0ΧΥΖ的平移矩阵为PQ1的计算如下:
[0048] Ρ〇ι= (Χι,Υι,Ζι)τ
[0049] 二维码坐标系的三个坐标轴与世界坐标系的三个轴之间的夹角组成的3 X 3的矩 阵,各个夹角所对应的余弦值所组成的矩阵为二维码坐标系〇1X1y1Z1相对于世界坐标系 0ΧΥΖ的旋转矩阵为,如下:
Figure CN106323294AD00093
[0051] 移动机器人各个坐标系相对于相邻的坐标系的旋转角度以及平移距离在移动机 器人系统均已知,其他坐标系的旋转矩阵以及平移矩阵也按照上述方法来计算;
[0052] 二维码坐标系〇1X1y1Z1相对于世界坐标系0ΧΥΖ有平移,相对于Z轴旋转,旋转矩阵 为,平移矩阵为PQ1;摄像机坐标系〇2X2y2Z2相对于二维码坐标系〇 1X1y1Z1为平移和旋转,旋 转矩阵为挺,平移矩阵为p12;云台a部分坐标系〇3X3y3Z3相对于摄像机坐标系〇2X2y2Z2只是相 对于X2轴的平移,旋转矩阵为扭,平移矩阵为p 23;云台a部分坐标系03X3y3Z3相对于云台b部 分坐标系03X474Z4只是相对于Z3轴的旋转,所以他们共用一个坐标系原点〇3,旋转矩阵为沐, 平移矩阵为P34;移动机器人坐标系〇5X5y5Z5相对于云台b部分坐标系03X474Z4只是相对于轴 方向的平移和旋转,并且在云台b部分的坐标系03X4y4Z4下,移动机器人的坐标为 4〇5;
[0053] ⑷通过旋转矩阵与平移矩阵计算移动机器人的位姿:通过计算表示出云台b部分 坐标系相对于世界坐标系的旋转矩阵为,平移矩阵为P〇l+Pl2+P23+P34,移动机器人 坐标系原点05就是移动机器人的位置;根据坐标系变换规则,可以计算出移动机器人位置:
Figure CN106323294AD00094
[0055] 移动机器人坐标系相对于世界坐标系沿着Z轴方向旋转就是移动机 器人坐标系相对于世界坐标系的旋转矩阵,通过旋转矩阵,可以计算出移动机器人坐标系 相对于世界坐标系的夹角Θ,移动机器人的位姿用M2矩阵表示为:
[0056] M2 = (x, y, θ) τ ;
[0057] 第四步,二维码定位数据对里程计定位结果修正,使用二维码的定位结果来修正 里程计的数据,贝>J:Mi=M2= (x,y,0)T。
[0058] 本发明的技术方案之二是通过以下措施来实现的:一种变电站巡检机器人定位装 置,包括驱动机器人运动的轮式平台、设置在轮式平台内的机器人运动控制器、编码器、通 信模块、摄像机和云台,所述轮式平台沿圆周等间距安装有三个全向轮,三个全向轮上各安 装有一个编码器,所述云台底部设有支撑轴,支撑轴固定安装在轮式平台上,所述摄像机安 装在云台的顶部,所述机器人运动控制器与通信模块双向通信连接,编码器与机器人运动 控制器双向电连接,摄像机和云台均与通信模块双向通信连接。
[0059] 上述通信模块包括无线路由器和串口联网模块,所述摄像机、云台、无线路由器和 机器人运动控制器均与串口联网模块通信连接。
[0060] 上述还包括远程PC机,所述远程PC机与无线路由器无线通信连接。
[0061]上述摄像机包括红外摄像机和尚清摄像机,红外摄像机和尚清摄像机均与串口联 网模块通信连接。
[0062] 上述编码器A、编码器B和编码器C均为光电编码器。
[0063] 本发明通过使用三个全向轮移动机器人平台比其他普通轮移动机器人平台运动 灵活,可以向任意方向运动。通过使用云台,对二维码的张贴位置没有特殊的要求,实施会 更加简单高效。通过采用编码器与二维码方式相结合定位,即使在二维码有障碍物遮挡的 情况下仍然可以知道移动机器人的位置。变电站巡检机器人使用二维码的定位方法,在室 内与室外环境下都可以使用。
附图说明
[0064] 附图1为本发明实施例1全方位移动机器人定位方法流程图。
[0065] 附图2为本发明全方位移动机器人定位坐标系示意图。
[0066] 附图3为本发明全方位移动机器人运动学简化模型示意图。
[0067] 附图4为本发明高清摄像机与二维码位置关系示意图。
[0068] 附图5为本发明高清摄像机相对于世界坐标系的定位坐标示意图。
[0069] 附图6为本发明二维码读取过程示意图。
[0070] 附图7为本发明全方位移动机器人运动路线及二维码张贴位置示意图。
[0071] 附图8为本发明全方位移动机器人依据二维码位置校正自身位置示意图。
[0072] 附图9为本发明全方位移动机器人定位系统框图。
[0073] 附图10为本发明全方位移动机器人平台效果示意图。
[0074] 附图中的编码分别为:1为轮式平台,2为机器人运动控制器,3为云台,4为支撑轴, 5为全向轮,6为无线路由器,7为编码器A,8为编码器B,9为编码器C,10为串口联网模块,,11 为远程PC机,12为红外摄像机,13为高清摄像机。
具体实施方式
[0075] 本发明不受下述实施例的限制,可根据本发明的技术方案与实际情况来确定具体 的实施方式。
[0076] 在本发明中,为了便于描述,各部件的相对位置关系的描述均是根据说明书附图1 的布图方式来进行描述的,如:前、后、上、下、左、右等的位置关系是依据说明书附图1的布 图方向来确定的。
[0077] 下面结合实施例及附图对本发明作进一步描述:
[0078] 实施例1:如附图1、2、3、4、5、6、7、8所示,变电站巡检机器人定位方法包括以下步 骤:
[0079] 第一步,建立坐标系,建立世界坐标系0ΧΥΖ,二维码坐标系〇1X1ym,摄像机坐标系 02X2y2Z2,云台a部分坐标系03X3y3Z3,云台b部分坐标系03X4y4Z4和机器人坐标系05X5y5Z5;
[0080] 这里的二维码坐标系oixiyizi相对于世界坐标系0ΧΥΖ有平移,相对于Z轴旋转。摄 像机坐标系〇2X2y2Z2相对于二维码坐标系oixiyizi为平移和旋转。云台A部分坐标系03X3y3Z3 相对于摄像机坐标系〇2X2y2Z2只是相对于X2轴的平移。云台A部分坐标系03X3y3Z3相对于云台 B部分坐标系03X4y4Z4只是相对于Z3轴的旋转,所以他们共用一个坐标系原点03。云台B部分 坐标系〇3X4y4Z4相对于移动机器人坐标系05X5y5Z5只是相对于轴方向的平移和旋转。
[0081] 第二步,计算里程计的定位结果施,对移动机器人进行运动学建模,使用三轮全向 轮移动机器人作为移动平台,Χ0Υ为世界坐标系, X0y为机器人坐标系,移动机器人的三个轮 子分别标记为i,j,k,三个轮子各自的线速度分别为Vi,Vj,Vk,在机器人坐标系中,移动机器 人在X轴和Y轴两个坐标上的速度分别为v x,vy,方向与坐标轴方向相同,机器人自身旋转的 角速度为《,R为轮子到机器人中心点0的距离;在世界坐标系中机器人沿两坐标轴的速度 分别为Vx,V Y,通过分析可得在机器人坐标系中根据机器人三个全向轮的线速度可以计算出 机器人的速度为:
Figure CN106323294AD00111
[0083] 机器人坐标系与世界坐标系的夹角为Φ,由机器人坐标系中的速度可以计算得到 在世界坐标系下的速度为:
Figure CN106323294AD00112
[0085] 移动机器人的初始姿态为(XQ,yQ,Φο),At时间后移动机器人的姿态为(xi, yi, Φ 1),计算公式如下:
Figure CN106323294AD00113
[0087] 因移动机器人在地面运动,移动机器人的位姿用施表示为:
[0088] Mi = (xi, yi, Φ ι) τ ;
[0089] 第三步,通过二维码图像计算移动机器人的位姿Μ2,包括以下步骤:
[0090] (1)通过图像处理,读取二维码的信息,包括以下步骤:(a)相机拍照,(b)灰度化, (c)二值化,(d)形态学滤波,(e)边缘检测,(f)霍夫直线变换,(g)透视变换,(h)二维码信息 读取;
[0091] (2)通过二维码计算摄像机坐标系〇2X2y2Z2相对于二维码坐标系oixiyizi的旋转矩 阵g以及平移矩阵P 12,计算方法如下:
[0092] 二维码贴在X1〇iyi平面中,Z1轴垂直于墙面向外,移动机器人相机镜头的朝向为 Z2 轴,镜体方向为χ2轴,图像信息位于x202y2坐标中;设边A0长度为lengthAQ,边A101的长度为 ^印Λ叫,标定时假设当物体距离相机距离为1m时,实际中物体的长度和图像中物体长度的 比为m,相机与二维码之间的距离计算公式如下:
Figure CN106323294AD00121
[0094]已知二维码张贴高度h,移动机器人高清摄像机距离二维码的长度为1,则:
Figure CN106323294AD00122
[0096] 在世界坐标系中ZA0B = 90°在相机坐标系中ΖΑι0ιΒι = θ,〇2X2y2Z2相对于oixiyizi 绕z轴旋转-90°,然后在zi轴方向不再转动,在移动机器人运动和相机云台运动过程中,相 对于zi轴不再旋转,只相对于XI轴和yi轴转动,绕XI转动用θχ表示,绕yi轴用θ γ表示。02X2y2Z2 中的坐标在omyizi坐标中如下表示:
Figure CN106323294AD00123
[0099] 其中
Figure CN106323294AD00124
[0102] Az=h
[0103] Λ x = l*sina
[0104] Ay = l>!<c〇sa
[0105] 3个未知数θχ,θ4Ρβ,需要3个方程,则0A,0B在χ1〇ιγι平面中可表示为:
Figure CN106323294AD00125
[0107] 在〇2Χ2Υ2Ζ2坐标系中:
Figure CN106323294AD00126
Figure CN106323294AD00131
[0113] Z2轴与XI轴之间的夹角为气r
Figure CN106323294AD00132
[0115] 其中r已知,.可用β表示;根据z2轴在〇lXlylZl*标系中的向量得到关于邱勺方程;
Figure CN106323294AD00133
(3)
[0117] 联立方程⑴(2) (3)可求得θχ,θγ,和β,得到02X2y^lj01xiyizl的转换矩阵货,以及平 移矩阵Pl2;
[0118] (3)各个坐标系之间旋转矩阵与平移矩阵的计算:
[0119] 在世界坐标系中,设定二维码的位置为(XI,yi,ζι),二维码坐标系oixiyizi相对于 世界坐标系0ΧΥΖ的平移矩阵为P Q1的计算如下:
[0120] Ρ〇ι= (Χι,Υι,Ζι)τ
[0121] 二维码坐标系的三个坐标轴与世界坐标系的三个轴之间的夹角组成的3 X 3的矩 阵,各个夹角所对应的余弦值所组成的矩阵为二维码坐标系〇1X1y1Z1相对于世界坐标系 0ΧΥΖ的旋转矩阵为,如下:
Figure CN106323294AD00134
[0123] 移动机器人各个坐标系相对于相邻的坐标系的旋转角度以及平移距离在移动机 器人系统均已知,其他坐标系的旋转矩阵以及平移矩阵也按照上述方法来计算;
[0124] 二维码坐标系〇1XiyiZ1相对于世界坐标系0ΧΥΖ有平移,相对于Z轴旋转,旋转矩阵 为1^,平移矩阵为Pol;摄像机坐标系〇2X2y2Z2相对于二维码坐标系OlXiyiZl为平移和旋转,旋 转矩阵为决,平移矩阵为P12;云台a部分坐标系〇3X3y3Z3相对于摄像机坐标系〇2X2y2Z2只是相 对于 X2轴的平移,旋转矩阵为贫,平移矩阵为P23;云台a部分坐标系〇3X3y 3Z3相对于云台b部 分坐标系03X474Z4只是相对于Z3轴的旋转,所以他们共用一个坐标系原点03,旋转矩阵为4¾, 平移矩阵为P34;移动机器人坐标系〇5X5y5z5相对于云台b部分坐标系 〇3X4y4Z4只是相对于轴 方向的平移和旋转,并且在云台b部分的坐标系03X4y4Z4下,移动机器人的坐标为4〇5;
[0125] (4)通过旋转矩阵与平移矩阵计算移动机器人的位姿:通过计算表示出云台b部分 坐标系相对于世界坐标系的旋转矩阵为',平移矩阵为P〇l+Pl2+P23+P34,移动机器人 坐标系原点〇5就是移动机器人的位置;根据坐标系变换规则,可以计算出移动机器人位置:
Figure CN106323294AD00141
[0127] 移动机器人坐标系相对于世界坐标系沿着Z轴方向旋转,就是移动机 器人坐标系相对于世界坐标系的旋转矩阵,通过旋转矩阵,可以计算出移动机器人坐标系 相对于世界坐标系的夹角,移动机器人的位姿用此矩阵表示为:
[0128] M2 = (x, y, θ) τ ;
[0129] 第四步,二维码定位数据对里程计定位结果修正,使用二维码的定位结果来修正 里程计的数据,贝>J:Mi=M2= (x,y,0)T。
[0130] 这里考虑到机器人在移动的过程中存在打滑的情况,所以里程计的定位结果存在 误差。二维码的位置在世界坐标系中是已知的,所以使用二维码的定位结果来修正里程计 的数据;当移动机器人移动到没有二维码的地方时采用里程计的定位结果%,当移动机器 人运动到有二维码的地方时,使用二维码的定位结果M 2来修正里程计的定位结果施。因移动 机器人在移动的过程中存在打滑的情况,里程计的定位结果存在误差,通过二维码定位数 据对里程计定位结果进行修正移动机器人不需要进行大幅度位姿调整,有效提高了移动机 器人的容错性和稳定性。
[0131] 实施例2:如附图9、10所示,一种变电站巡检机器人定位装置,包括驱动机器人运 动的轮式平台1、设置在轮式平台1内的机器人运动控制器2、编码器、通信模块、摄像机和云 台3,所述轮式平台1沿圆周等间距安装有三个全向轮5,三个全向轮5上各安装有一个编码 器,所述云台3底部设有支撑轴4,支撑轴4固定安装在轮式平台1上,所述摄像机安装在云台 3的顶部,所述机器人运动控制器2与通信模块双向通信连接,编码器与机器人运动控制器2 双向电连接,摄像机和云台3均与通信模块双向通信连接。
[0132] 在实际工作时,轮式平台1起到驱动变电站巡检机器人运动和支撑云台的作用,在 每个全向轮5上分别安装有一个电机,机器人运动控制器2控制电机的转向和转速,电机驱 动车轮转动,从而实现机器人的运动;这里采用三个全向轮5带动旋转机器人的运动,能够 快速实现机器人的360°转向,比起四轮驱动更方便灵活。这里的电机、机器人运动控制器2、 通信模块均由固定在轮式平台内的大容量电池提供电源;编码器分别为编码器A7、编码器 B8和编码器C9,机器人运动控制器2接收编码器A7、编码器B8和编码器C9发送的全向轮5的 位置信息。这里的云台3为两自由度云台,包括云台a部分和云台b部分,云台a部分的两侧臂 安装在云台b部分上,云台a部分和云台b部分均能够在机器人运动控制器的控制指令下旋 转,云台a部分能够带动摄像机转动,随时调整摄像头的角度,便于寻找设备二维码位置。
[0133] 如附图9、10所示,通信模块包括无线路由器6和串口联网模块10,所述摄像机、云 台3、无线路由器6和机器人运动控制器2均与串口联网模块10通信连接。串口联网模块10的 作用是将串口转化为RJ-45的网络接口,摄像机、串口联网模块10与无线路由器6之间均通 过网口连接,云台3与串口联网模块10之间使用RS485通信接口连接,机器人运动控制器2与 串口联网模块10之间使用RS232通信接口连接。
[0134] 如附图9、10所示,还包括远程PC机11,所述远程PC机11与无线路由器6无线通信连 接。远程PC机11与无线路由器6之间采用无线网络通信连接,用户通过远程PC机11控制巡检 机器人运动,实现对设备的远程监控。
[0135] 如附图9、10所示,所述摄像机包括红外摄像机12和高清摄像机13,红外摄像机12 和高清摄像机13均与串口联网模块10通信连接。高清摄像机13上设有网络接口和USB接口, 主要用于采集变电站内的二维码图像信息,这里的二维码图像均为矩形;红外摄像机13主 要利用红外采集二维码的图像,便于更清楚的采集二维码信息。
[0136] 如附图9、10所示,编码器均为光电编码器。这里的光电编码器A7、光电编码器B8和 光电编码器C9分别安装在驱动移动机器人全向轮5运动的三个电机上,用于检测电机的转 速,便于计算,从而实现对移动机器人进行精确定位。
[0137] 实施例3:如附图1、2、3、4、5、6、7、8、9、10所示,基于二维码信息对变电站巡检机器 人精确定位方法,包括以下步骤:
[0138] (1)使用二维码生成器生成带有编号的变电站设备二维码信息;
[0139] (2)将生成的二维码图片装订好,贴在二维码信息对应的变电站相应设备上并获 得每个二维码在整个地图中的坐标;
[0140] (3)由计算机自动生成机器人的运动轨迹图,将轨迹图通过远程PC机以无线的形 式发送给移动机器人;
[0M1] (4)将搭载云台及高清摄像机的移动机器人放在变电站中按轨迹图进行移动,在 机器人运动过程中,根据编码器得到机器人的位置信息,编码器具有累计误差,机器人运动 越久,定位误差越大;当误差增大时,机器人自身检测到的自身位置和实际机器人所在的位 置就会不同;
[0142] (5)在没有二维码区域移动机器人利用编码器进行定位,当捕捉到二维码时,机器 人利用二维码信息进行识别,定位自身所在位置;二维码所代表的就是地图中坐标信息,设 定移动机器人设置有两种路线,第一种路线依序经过的设备二维码位置为是0001至0002至 0003 至0004 至0005 至0006 至0007 至0008 至0009,第二种路线是0001 至0004至0002 至0003 至 0005至0006至0008至0007至0009,在两种路线中,机器人在运动过程中自身定位误差会不 同,但移动机器人根据二维码的设备位置信息调整后,可以纠正其定位误差;因为二维码自 身所包含的信息中有自身的编号,机器人通过无线通信将编号信息发送给远程PC机11,远 程PC机11遍寻编号后,得知该编号二维码在地图中的位置信息;
[0143] (6)远程PC机11查得二维码所在位置信息后,将信息发送给移动机器人,移动机器 人根据自己相对于二维码的位置,从而得到移动机器人在全局中的准确位置,将自身的位 置信息进行纠正,实现对移动机器人的全局精确定位。例如:0012号二维码所在位置是(心, Y!),然后根据机器人相对二维码的距离和方位,确定机器人自身位置(X2,Y2)。
[0144] 以上技术特征构成了本发明的实施例,其具有较强的适应性和实施效果,可根据 实际需要增减非必要的技术特征,来满足不同情况的需求。

Claims (9)

1. 一种变电站巡检机器人定位方法,其特征在于包括以下步骤: 第一步,建立坐标系,建立世界坐标系OXYZ,二维码坐标系oixiyizi,摄像机坐标系 02X2y2Z2,云台a部分坐标系03X3y3Z3,云台b部分坐标系03X4y4Z4和机器人坐标系05X5y5Z5; 第二步,计算里程计的定位结果Mi,对移动机器人进行运动学建模,使用三轮全向轮移 动机器人作为移动平台,X0Y为世界坐标系,xoy为机器人坐标系,移动机器人的三个轮子分 别标记为i,j,k,三个轮子各自的线速度分别为Vi,Vj,Vk,在机器人坐标系中,移动机器人在 X轴和Y轴两个坐标上的速度分别为Vx,Vy,方向与坐标轴方向相同,机器人自身旋转的角速 度为《,R为轮子到机器人中心点0的距离;在世界坐标系中机器人沿两坐标轴的速度分别 为Vx,V Y,通过分析可得在机器人坐标系中根据机器人三个全向轮的线速度可以计算出机器 人的速度为:
Figure CN106323294AC00021
机器人坐标系与世界坐标系的夹角为巾,由机器人坐标系中的速度可以计算得到在世 界坐标系下的速度为:
Figure CN106323294AC00022
移动机器人的初始姿态为(xQ,yo,巾〇),At时间后移动机器人的姿态为(X1,yi,(^),计 算公式如下:
Figure CN106323294AC00023
因为移动机器人在地面运动,移动机器人的位姿用施表示为: Mi= (xi,yi, <i>i)T 第三步,通过二维码图像计算移动机器人的定位结果M2,包括以下步骤: (1) 通过图像处理,读取二维码的信息,包括以下步骤:(a)相机拍照,(b)灰度化,(c)二 值化,(d)形态学滤波,(e)边缘检测,(f)霍夫直线变换,(g)透视变换, (h)二维码信息读取; (2) 通过二维码计算摄像机坐标系〇2X2y2Z2相对于二维码坐标系oixiyizi的旋转矩阵:1/? 以及平移矩阵P 12,计算方法如下:二维码贴在幻〇171平面中,Z1轴垂直于墙面向外,移动机器 人相机镜头的朝向为Z2轴,镜体方向为X2轴,图像信息位于x 2〇2y2坐标中;设边A0长度为 lengthAo,边AiCh的长度为&»_确,标定时假设当物体距离相机距离为lm时,实际中物体的 9 长度和图像中物体长度的比为m,相机与二维码之间的距离计算公式如下:
Figure CN106323294AC00031
已知二维码张贴高度h,移动机器人高清摄像机距离二维码的长度为1,则:
Figure CN106323294AC00032
在世界坐标系中ZA0B = 90°在相机坐标系中ZAiOiBi = 0,〇2X2y2Z2相对于oixiyizi绕z轴 旋转_90°,然后在21轴方向不再转动,在移动机器人运动和相机云台运动过程中,相对于21 轴不再旋转,只相对于xi轴和yi轴转动,绕xi转动用0X表示,绕yi轴用0y表示。〇2X2y2Z2中的坐 标在oixiyizi坐标中如下表示:
Figure CN106323294AC00033
A z = h A x = l*sina A y = l*cosa 3个未知数9X,9y和,需要3个方程,则OA,OB在x1〇iyi平面中可表示为:
Figure CN106323294AC00034
在〇2X2y2Z2坐标系中:
Figure CN106323294AC00035
Z2轴与X1轴之间的夹角为%
Figure CN106323294AC00041
其中r已知,L可用0表示;根据z2轴在〇1切121坐标系中的向量得到关于邱勺方程;
Figure CN106323294AC00042
(3) 联立方程⑴⑵⑶可求得0X A,和0,得到〇2X2y2到omym的转换矩阵>,以及平移矩 阵 Pl2; ⑶各个坐标系之间旋转矩阵与平移矩阵的计算: 在世界坐标系中,设定二维码的位置为(xi,yi,zi),二维码坐标系oixiyizi相对于世界坐 标系0XYZ的平移矩阵为PQ1的计算如下: Poi= (Xi,Yi,Zi)t 二维码坐标系的三个坐标轴与世界坐标系的三个轴之间的夹角组成的3 X 3的矩阵,各 个夹角所对应的余弦值所组成的矩阵为二维码坐标系〇ixiyiZ1相对于世界坐标系0XYZ的旋 转矩阵为?#,如下:
Figure CN106323294AC00043
移动机器人各个坐标系相对于相邻的坐标系的旋转角度以及平移距离在移动机器人 系统均已知,其他坐标系的旋转矩阵以及平移矩阵也按照上述方法来计算; 二维码坐标系〇lXiyiZl相对于世界坐标系0XYZ有平移,相对于Z轴旋转,旋转矩阵为#, 平移矩阵为Pea;摄像机坐标系〇2X2y2Z2相对于二维码坐标系〇my1Z1为平移和旋转,旋转矩 阵为汸,平移矩阵为Pi2;云台a部分坐标系 〇3X3y3Z3相对于摄像机坐标系〇2X2y2Z2只是相对于 x2轴的平移,旋转矩阵为平移矩阵为P23;云台a部分坐标系〇3X3y 3Z3相对于云台b部分坐 标系03W4Z4只是相对于Z3轴的旋转,所以他们共用一个坐标系原点03,旋转矩阵为#,平 移矩阵为P34;移动机器人坐标系05X5y5Z5相对于云台b部分坐标系03X4y4Z4只是相对于轴方 向的平移和旋转,并且在云台b部分的坐标系 〇3X4y4Z4下,移动机器人的坐标为405; ⑷通过旋转矩阵与平移矩阵计算移动机器人的位姿:通过计算表示出云台b部分坐标 系相对于世界坐标系的旋转矩阵为» ,平移矩阵为PCU+PU+P23+P34,移动机器人坐标 系原点〇5就是移动机器人的位置;根据坐标系变换规则,可以计算出移动机器人位置:
Figure CN106323294AC00044
移动机器人坐标系相对于世界坐标系沿着Z轴方向旋转,就是移动机器人 坐标系相对于世界坐标系的旋转矩阵,通过旋转矩阵,可以计算出移动机器人坐标系相对 于世界坐标系的夹角0,移动机器人的位姿用M 2矩阵表示为: M2 = (x, y, 0) T 第四步,二维码定位数据对里程计定位结果修正,使用二维码的定位结果来修正里程 计的数据,贝>J:Mi=M2= (X,y,0) T。
2. -种变电站巡检机器人定位装置,其特征在于包括驱动机器人运动的轮式平台、设 置在轮式平台内的机器人运动控制器、编码器、通信模块、摄像机和云台,所述轮式平台沿 圆周等间距安装有三个全向轮,三个全向轮上各安装有一个编码器,所述云台底部设有支 撑轴,支撑轴固定安装在轮式平台上,所述摄像机安装在云台的顶部,所述机器人运动控制 器与通信模块双向通信连接,编码器与机器人运动控制器双向电连接,摄像机和云台均与 通信模块双向通信连接。
3. 根据权利要求2所述的变电站巡检机器人定位装置,其特征在于通信模块包括无线 路由器和串口联网模块,所述摄像机、云台、无线路由器和机器人运动控制器均与串口联网 模块通信连接。
4. 根据权利要求2或3所述的变电站巡检机器人定位装置,其特征在于还包括远程PC 机,所述远程PC机与无线路由器无线通信连接。
5. 根据权利要求3所述的变电站巡检机器人定位装置,其特征在于所述摄像机包括红 外摄像机和高清摄像机,红外摄像机和高清摄像机均与串口联网模块通信连接。
6. 根据权利要求4所述的变电站巡检机器人定位装置,其特征在于所述摄像机包括红 外摄像机和高清摄像机,红外摄像机和高清摄像机均与串口联网模块通信连接。
7. 根据权利要求2或3所述的变电站巡检机器人定位装置,其特征在于编码器均为光电 编码器。
8. 根据权利要求4所述的变电站巡检机器人定位装置,其特征在于编码器均为光电编 码器。
9. 根据权利要求5所述的变电站巡检机器人定位装置,其特征在于编码器均为光电编 码器。
CN201610961927.0A 2016-11-04 2016-11-04 变电站巡检机器人定位方法及定位装置 CN106323294A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610961927.0A CN106323294A (zh) 2016-11-04 2016-11-04 变电站巡检机器人定位方法及定位装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610961927.0A CN106323294A (zh) 2016-11-04 2016-11-04 变电站巡检机器人定位方法及定位装置

Publications (1)

Publication Number Publication Date
CN106323294A true CN106323294A (zh) 2017-01-11

Family

ID=57815905

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610961927.0A CN106323294A (zh) 2016-11-04 2016-11-04 变电站巡检机器人定位方法及定位装置

Country Status (1)

Country Link
CN (1) CN106323294A (zh)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106871904A (zh) * 2017-03-02 2017-06-20 南阳师范学院 一种基于机器视觉的移动机器人码盘定位修正方法
CN107300391A (zh) * 2017-06-26 2017-10-27 国家电网公司 一种变电站智能巡检机器人定位坐标的自动校正装置及校正方法
CN108036786A (zh) * 2017-12-01 2018-05-15 安徽优思天成智能科技有限公司 基于辅助线的位姿检测方法、装置和计算机可读存储介质
CN108759853A (zh) * 2018-06-15 2018-11-06 浙江国自机器人技术有限公司 一种机器人定位方法、系统、设备及计算机可读存储介质
CN108827342A (zh) * 2018-06-15 2018-11-16 深圳市沃特沃德股份有限公司 扫地机器人的摄像头与里程计坐标标定方法及系统
CN109035474A (zh) * 2018-07-27 2018-12-18 国网江苏省电力有限公司苏州供电分公司 基于二维码的巡检方法和系统
CN109655055A (zh) * 2018-11-07 2019-04-19 深圳技术大学(筹) 一种轨检机器人的定位方法
CN109974746A (zh) * 2017-12-27 2019-07-05 深圳市优必选科技有限公司 全向轮里程校准方法及机器人
CN110187348A (zh) * 2019-05-09 2019-08-30 盈科视控(北京)科技有限公司 一种激光雷达定位的方法
CN110345937A (zh) * 2019-08-09 2019-10-18 东莞市普灵思智能电子有限公司 一种基于二维码的导航定姿定位方法和系统
CN110857858A (zh) * 2018-08-23 2020-03-03 上海智远弘业机器人有限公司 一种用于机器人二维码导航的路标
WO2020047713A1 (en) * 2018-09-03 2020-03-12 Abb Schweiz Ag Method and apparatus for managing robot system
CN110962128A (zh) * 2019-12-11 2020-04-07 广东电科院能源技术有限责任公司 一种变电站巡检布点方法及巡检机器人控制方法
CN109738213B (zh) * 2019-02-03 2020-10-02 北京新联铁集团股份有限公司 轨道交通机车车辆巡检位姿检测系统及其方法

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106871904A (zh) * 2017-03-02 2017-06-20 南阳师范学院 一种基于机器视觉的移动机器人码盘定位修正方法
CN107300391A (zh) * 2017-06-26 2017-10-27 国家电网公司 一种变电站智能巡检机器人定位坐标的自动校正装置及校正方法
CN108036786A (zh) * 2017-12-01 2018-05-15 安徽优思天成智能科技有限公司 基于辅助线的位姿检测方法、装置和计算机可读存储介质
CN109974746A (zh) * 2017-12-27 2019-07-05 深圳市优必选科技有限公司 全向轮里程校准方法及机器人
CN108827342A (zh) * 2018-06-15 2018-11-16 深圳市沃特沃德股份有限公司 扫地机器人的摄像头与里程计坐标标定方法及系统
CN108759853A (zh) * 2018-06-15 2018-11-06 浙江国自机器人技术有限公司 一种机器人定位方法、系统、设备及计算机可读存储介质
CN109035474A (zh) * 2018-07-27 2018-12-18 国网江苏省电力有限公司苏州供电分公司 基于二维码的巡检方法和系统
CN110857858A (zh) * 2018-08-23 2020-03-03 上海智远弘业机器人有限公司 一种用于机器人二维码导航的路标
WO2020047713A1 (en) * 2018-09-03 2020-03-12 Abb Schweiz Ag Method and apparatus for managing robot system
CN109655055A (zh) * 2018-11-07 2019-04-19 深圳技术大学(筹) 一种轨检机器人的定位方法
CN109738213B (zh) * 2019-02-03 2020-10-02 北京新联铁集团股份有限公司 轨道交通机车车辆巡检位姿检测系统及其方法
CN110187348A (zh) * 2019-05-09 2019-08-30 盈科视控(北京)科技有限公司 一种激光雷达定位的方法
CN110345937A (zh) * 2019-08-09 2019-10-18 东莞市普灵思智能电子有限公司 一种基于二维码的导航定姿定位方法和系统
CN110962128A (zh) * 2019-12-11 2020-04-07 广东电科院能源技术有限责任公司 一种变电站巡检布点方法及巡检机器人控制方法

Similar Documents

Publication Publication Date Title
US10625593B2 (en) Self-balancing robot system comprising robotic omniwheel
US9197810B2 (en) Systems and methods for tracking location of movable target object
CN105045263B (zh) 一种基于Kinect深度相机的机器人自定位方法
Carrillo et al. Hovering quad-rotor control: A comparison of nonlinear controllers using visual feedback
CN102866706B (zh) 一种采用智能手机导航的清扫机器人及其导航清扫方法
CN102840852B (zh) 航空摄影图像拾取方法和航空摄影图像拾取装置
Alonso et al. Accurate global localization using visual odometry and digital maps on urban environments
Sharp et al. A vision system for landing an unmanned aerial vehicle
CN101887037B (zh) 轮式x射线探伤机器人装置
CN104407615B (zh) 一种agv机器人导引偏差校正方法
CN101630409B (zh) 一种用于机器人制孔系统的手眼视觉标定方法
Martinelli et al. Multi-robot localization using relative observations
CN204374771U (zh) 实现清扫机器人地图边界建模的装置以及清扫机器人
Courbon et al. Autonomous navigation of vehicles from a visual memory using a generic camera model
Kriegman et al. A mobile robot: Sensing, planning and locomotion
Krotkov et al. Terrain mapping for a walking planetary rover
La et al. Mechatronic systems design for an autonomous robotic system for high-efficiency bridge deck inspection and evaluation
CN102967305B (zh) 基于大小回字标志物的多旋翼无人机位姿获取方法
CN106607907B (zh) 一种移动视觉机器人及其测控方法
CN1788188B (zh) 拍摄图像显示方法及拍摄图像显示装置
CN105783913A (zh) 一种融合车载多传感器的slam装置及其控制方法
CN104786865B (zh) 一种基于单目视觉为电动汽车提供充电对接的方法
CN106199626B (zh) 基于摆动激光雷达的室内三维点云地图生成系统及方法
US20060106507A1 (en) Optical laser guidance system apparatus and method
CN102116625B (zh) 巡线机器人gis-gps导航方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination