CN106323294B - 变电站巡检机器人定位方法及定位装置 - Google Patents
变电站巡检机器人定位方法及定位装置 Download PDFInfo
- Publication number
- CN106323294B CN106323294B CN201610961927.0A CN201610961927A CN106323294B CN 106323294 B CN106323294 B CN 106323294B CN 201610961927 A CN201610961927 A CN 201610961927A CN 106323294 B CN106323294 B CN 106323294B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- mobile robot
- robot
- dimensional code
- relative
- Prior art date
- Legal status (The legal status 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 status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y04—INFORMATION OR COMMUNICATION TECHNOLOGIES HAVING AN IMPACT ON OTHER TECHNOLOGY AREAS
- Y04S—SYSTEMS INTEGRATING TECHNOLOGIES RELATED TO POWER NETWORK OPERATION, COMMUNICATION OR INFORMATION TECHNOLOGIES FOR IMPROVING THE ELECTRICAL POWER GENERATION, TRANSMISSION, DISTRIBUTION, MANAGEMENT OR USAGE, i.e. SMART GRIDS
- Y04S10/00—Systems supporting electrical power generation, transmission or distribution
- Y04S10/50—Systems or methods supporting the power network operation or management, involving a certain degree of interaction with the load-side end user applications
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明涉及变电站智能巡检技术领域,是一种变电站巡检机器人定位方法及定位装置,前者包括第一步建立坐标系,第二步计算里程计的定位结果,第三步计算移动机器人的位姿,第四步修正定位结果;后者包括驱动机器人运动的轮式平台、机器人运动控制器、编码器、通信模块、摄像机和云台,轮式平台沿圆周等间距安装有三个全向轮,三个全向轮上各安装有一个编码器,云台底部设有支撑轴,支撑轴固定安装在轮式平台上,摄像机安装在云台的顶部。本发明采用编码器与二维码方式相结合定位,即使在二维码有障碍物遮挡的情况下仍然可以知道移动机器人的位置。变电站巡检机器人使用二维码的定位方法,在室内与室外环境下都可以使用。
Description
技术领域
本发明涉及变电站智能巡检技术领域,是一种变电站巡检机器人定位方法及定位装置。
背景技术
现有的移动机器人的定位有基于里程计的定位、基于惯性传感器的定位、视觉定位、超声定位、地图匹配定位、基于多种传感信息的定位、路标与灯塔的定位和同时定位与地图构建(SLAM)等定位方式。目前,变电站智能巡检机器人主要包括轨道式巡检机器人和轮式巡检机器人。轨道式巡检机器人系统是由设置在轨道上的定位片对机器人进行定位,定位精度高,但其能够巡检的空间有限,只能在固定的轨道中移动。轮式巡检机器人定位方式主要是依靠磁轨道进行定位和利用自身传感器系统进行定位,依靠磁轨道进行定位需要事先在底下铺设磁轨道,成本较高,行动范围有限;依靠自身传感器进行定位可以使机器人在大范围内进行移动,但传统的方式是使用激光扫描雷达使机器人进行自定位,成本高昂,机器人不能实现智能定位。
发明专利201210186563.5公布了一种基于二维码的移动机器人定位系统和方法,将视觉定位技术、二维码定位技术及两自由度测速技术有机结合在一起,实现了对移动机器人的准确定位功能,解决了传统视觉定位在图像处理上过于复杂和定位精度不够准确的问题。该方法存在的问题是:1、施工难度大,对人工和环境设备要求非常苛刻,形成人工成本和设备成本的高投入;2、容错性差,移动机器人运行非常不稳定:由于采用一个二维码读码器定位的方法不能容错人工和设备的误差而常常造成误判断,致使移动机器人不得不长期处于大幅度位姿调整的状态,移动机器人运行时机体晃动、摇摆不定,严重影响了稳定性。3、该方法由于采用随动轮测速机构来检测移动机器人的速度,没有对随动轮打滑的情况进行考虑,会造成测速机构所测得的速度不够准确。
发明专利201210472984.4公布了一种基于多个二维码读码器的移动机器人定位系统及方法。该方法是在机器人与地面上安装至少两个二维码读码器和分布于地面上的二维码标签,每次至少同时读取两个二维码标签来实现对移动机器人的定位,有效容错性差,以及读取单个二维码标签所带来的不足。但是该方法仍然存在以下缺点与不足:1、由于二维码张贴在地面上,因此对于地面的平整度要求较高,对环境要求较为苛刻,并且该方法只能适用于室内移动机器人的定位,在室外等情况下无法适用;2、该方法在张贴二维码时施工难度较大,对人工和环境设备要求较为严格,容易形成较高的人工成本与设备成本。
发明内容
本发明提供了一种变电站巡检机器人定位装置和方法,克服了上述现有技术之不足,其能有效解决现有技术中存在的移动机器人稳定性差、容错性差以及移动机器人不能适用于室外移动定位的问题。
本发明的技术方案之一是通过以下措施来实现的:变电站巡检机器人定位方法包括以下步骤:
第一步,建立坐标系,建立世界坐标系OXYZ,二维码坐标系o1x1y1z1,摄像机坐标系o2x2y2z2,云台a部分坐标系o3x3y3z3,云台b部分坐标系o3x4y4z4和机器人坐标系o5x5y5z5;
第二步,计算里程计的定位结果M1,对移动机器人进行运动学建模,使用三轮全向轮移动机器人作为移动平台,XOY为世界坐标系,xoy为机器人坐标系,移动机器人的三个轮子分别标记为i,j,k,三个轮子各自的线速度分别为Vi,Vj,Vk,在机器人坐标系中,移动机器人在X轴和Y轴两个坐标上的速度分别为vx,vy,方向与坐标轴方向相同,机器人自身旋转的角速度为ω,R为轮子到机器人中心点O的距离;在世界坐标系中机器人沿两坐标轴的速度分别为VX,VY,通过分析可得在机器人坐标系中根据机器人三个全向轮的线速度可以计算出机器人的速度为:
机器人坐标系与世界坐标系的夹角为φ,由机器人坐标系中的速度可以计算得到在世界坐标系下的速度为:
移动机器人的初始姿态为(x0,y0,φ0),Δt时间后移动机器人的姿态为(x1,y1,φ1),计算公式如下:
因移动机器人在地面运动,移动机器人的位姿用M1表示为:
M1=(x1,y1,φ1)T;
第三步,通过二维码图像计算移动机器人的位姿M2,包括以下步骤:
(1)通过图像处理,读取二维码的信息,包括以下步骤:(a)相机拍照,(b)灰度化,(c)二值化,(d)形态学滤波,(e)边缘检测,(f)霍夫直线变换,(g)透视变换,(h)二维码信息读取;
(2)通过二维码计算摄像机坐标系o2x2y2z2相对于二维码坐标系o1x1y1z1的旋转矩阵2 1R以及平移矩阵P12,计算方法如下:
二维码贴在x1o1y1平面中,z1轴垂直于墙面向外,移动机器人相机镜头的朝向为z2轴,镜体方向为x2轴,图像信息位于x2o2y2坐标中;设边AO长度为lengthAO,边A1O1的长度为标定时假设当物体距离相机距离为1m时,实际中物体的长度和图像中物体长
度的比为m,相机与二维码之间的距离计算公式如下:
已知二维码张贴高度h,移动机器人高清摄像机距离二维码的长度为l,则:
在世界坐标系中∠AOB=90°在相机坐标系中∠A1O1B1=θ,o2X2y2z2相对于o1x1y1z1绕z轴旋转-90°,然后在z1轴方向不再转动,在移动机器人运动和相机云台运动过程中,相对于z1轴不再旋转,只相对于x1轴和y1轴转动,绕x1转动用θx表示,绕y1轴用θy表示。o2x2y2z2中的坐标在o1x1y1z1坐标中如下表示:
其中
Δz=h
Δx=l*sinα
Δy=l*cosα
3个未知数θx,θy和β,需要3个方程,则OA,OB在x1o1y1平面中可表示为:
在o2x2y2z2坐标系中:
(3)各个坐标系之间旋转矩阵与平移矩阵的计算:
在世界坐标系中,设定二维码的位置为(x1,y1,z1),二维码坐标系o1x1y1z1相对于世界坐标系OXYZ的平移矩阵为PO1的计算如下:
P01=(X1,Y1,Z1)T
移动机器人各个坐标系相对于相邻的坐标系的旋转角度以及平移距离在移动机器人系统均已知,其他坐标系的旋转矩阵以及平移矩阵也按照上述方法来计算;
二维码坐标系o1x1y1z1相对于世界坐标系OXYZ有平移,相对于Z轴旋转,旋转矩阵为平移矩阵为PO1;摄像机坐标系o2x2y2z2相对于二维码坐标系o1x1y1z1为平移和旋转,旋转矩阵为/>平移矩阵为P12;云台a部分坐标系o3x3y3z3相对于摄像机坐标系o2x2y2z2只是相对于x2轴的平移,旋转矩阵为/>平移矩阵为P23;云台a部分坐标系o3x3y3z3相对于云台b部分坐标系o3x4y4z4只是相对于z3轴的旋转,所以他们共用一个坐标系原点o3,旋转矩阵为平移矩阵为P34;移动机器人坐标系o5x5y5z5相对于云台b部分坐标系o3x4y4z4只是相对于轴方向的平移和旋转,并且在云台b部分的坐标系o3x4y4z4下,移动机器人的坐标为4O5;
(4)通过旋转矩阵与平移矩阵计算移动机器人的位姿:通过计算表示出云台b部分坐标系相对于世界坐标系的旋转矩阵为平移矩阵为PO1+P12+P23+P34,移动机器人坐标系原点O5就是移动机器人的位置;根据坐标系变换规则,可以计算出移动机器人位置:/>
M2=(x,y,θ)T;
第四步,二维码定位数据对里程计定位结果修正,使用二维码的定位结果来修正里程计的数据,则:M1=M2=(x,y,θ)T。
本发明的技术方案之二是通过以下措施来实现的:一种变电站巡检机器人定位装置,包括驱动机器人运动的轮式平台、设置在轮式平台内的机器人运动控制器、编码器、通信模块、摄像机和云台,所述轮式平台沿圆周等间距安装有三个全向轮,三个全向轮上各安装有一个编码器,所述云台底部设有支撑轴,支撑轴固定安装在轮式平台上,所述摄像机安装在云台的顶部,所述机器人运动控制器与通信模块双向通信连接,编码器与机器人运动控制器双向电连接,摄像机和云台均与通信模块双向通信连接。
上述通信模块包括无线路由器和串口联网模块,所述摄像机、云台、无线路由器和机器人运动控制器均与串口联网模块通信连接。
上述还包括远程PC机,所述远程PC机与无线路由器无线通信连接。
上述摄像机包括红外摄像机和高清摄像机,红外摄像机和高清摄像机均与串口联网模块通信连接。
上述编码器A、编码器B和编码器C均为光电编码器。
本发明通过使用三个全向轮移动机器人平台比其他普通轮移动机器人平台运动灵活,可以向任意方向运动。通过使用云台,对二维码的张贴位置没有特殊的要求,实施会更加简单高效。通过采用编码器与二维码方式相结合定位,即使在二维码有障碍物遮挡的情况下仍然可以知道移动机器人的位置。变电站巡检机器人使用二维码的定位方法,在室内与室外环境下都可以使用。
附图说明
附图1为本发明实施例1全方位移动机器人定位方法流程图。
附图2为本发明全方位移动机器人定位坐标系示意图。
附图3为本发明全方位移动机器人运动学简化模型示意图。
附图4为本发明高清摄像机与二维码位置关系示意图。
附图5为本发明高清摄像机相对于世界坐标系的定位坐标示意图。
附图6为本发明二维码读取过程示意图。
附图7为本发明全方位移动机器人运动路线及二维码张贴位置示意图。
附图8为本发明全方位移动机器人依据二维码位置校正自身位置示意图。
附图9为本发明全方位移动机器人定位系统框图。
附图10为本发明全方位移动机器人平台效果示意图。
附图中的编码分别为:1为轮式平台,2为机器人运动控制器,3为云台,4为支撑轴,5为全向轮,6为无线路由器,7为编码器A,8为编码器B,9为编码器C,10为串口联网模块,,11为远程PC机,12为红外摄像机,13为高清摄像机。
具体实施方式
本发明不受下述实施例的限制,可根据本发明的技术方案与实际情况来确定具体的实施方式。
在本发明中,为了便于描述,各部件的相对位置关系的描述均是根据说明书附图1的布图方式来进行描述的,如:前、后、上、下、左、右等的位置关系是依据说明书附图1的布图方向来确定的。
下面结合实施例及附图对本发明作进一步描述:
实施例1:如附图1、2、3、4、5、6、7、8所示,变电站巡检机器人定位方法包括以下步骤:
第一步,建立坐标系,建立世界坐标系OXYZ,二维码坐标系o1x1y1z1,摄像机坐标系o2x2y2z2,云台a部分坐标系o3x3y3z3,云台b部分坐标系o3x4y4z4和机器人坐标系o5x5y5z5;
这里的二维码坐标系o1x1y1z1相对于世界坐标系OXYZ有平移,相对于Z轴旋转。摄像机坐标系o2x2y2z2相对于二维码坐标系o1x1y1z1为平移和旋转。云台A部分坐标系o3x3y3z3相对于摄像机坐标系o2x2y2z2只是相对于x2轴的平移。云台A部分坐标系o3x3y3z3相对于云台B部分坐标系o3x4y4z4只是相对于z3轴的旋转,所以他们共用一个坐标系原点o3。云台B部分坐标系o3x4y4z4相对于移动机器人坐标系o5x5y5z5只是相对于轴方向的平移和旋转。
第二步,计算里程计的定位结果M1,对移动机器人进行运动学建模,使用三轮全向轮移动机器人作为移动平台,XOY为世界坐标系,xoy为机器人坐标系,移动机器人的三个轮子分别标记为i,j,k,三个轮子各自的线速度分别为Vi,Vj,Vk,在机器人坐标系中,移动机器人在X轴和Y轴两个坐标上的速度分别为vx,vy,方向与坐标轴方向相同,机器人自身旋转的角速度为ω,R为轮子到机器人中心点O的距离;在世界坐标系中机器人沿两坐标轴的速度分别为VX,VY,通过分析可得在机器人坐标系中根据机器人三个全向轮的线速度可以计算出机器人的速度为:
机器人坐标系与世界坐标系的夹角为φ,由机器人坐标系中的速度可以计算得到在世界坐标系下的速度为:
移动机器人的初始姿态为(x0,y0,φ0),Δt时间后移动机器人的姿态为(x1,y1,φ1),计算公式如下:
因移动机器人在地面运动,移动机器人的位姿用M1表示为:
M1=(x1,y1,φ1)T;
第三步,通过二维码图像计算移动机器人的位姿M2,包括以下步骤:
(1)通过图像处理,读取二维码的信息,包括以下步骤:(a)相机拍照,(b)灰度化,(c)二值化,(d)形态学滤波,(e)边缘检测,(f)霍夫直线变换,(g)透视变换,(h)二维码信息读取;
二维码贴在x1o1y1平面中,z1轴垂直于墙面向外,移动机器人相机镜头的朝向为z2轴,镜体方向为x2轴,图像信息位于x2o2y2坐标中;设边AO长度为lengthAO,边A1O1的长度为标定时假设当物体距离相机距离为1m时,实际中物体的长度和图像中物体长度的比为m,相机与二维码之间的距离计算公式如下:
已知二维码张贴高度h,移动机器人高清摄像机距离二维码的长度为l,则:
在世界坐标系中∠AOB=90°在相机坐标系中∠A1O1B1=θ,o2X2y2z2相对于o1x1y1z1绕z轴旋转-90°,然后在z1轴方向不再转动,在移动机器人运动和相机云台运动过程中,相对于z1轴不再旋转,只相对于x1轴和y1轴转动,绕x1转动用θx表示,绕y1轴用θy表示。o2x2y2z2中的坐标在o1x1y1z1坐标中如下表示:
其中
Δz=h
Δx=l*sinα
Δy=l*cosα
3个未知数θx,θy和β,需要3个方程,则OA,OB在x1o1y1平面中可表示为:
在o2x2y2z2坐标系中:
(3)各个坐标系之间旋转矩阵与平移矩阵的计算:
在世界坐标系中,设定二维码的位置为(x1,y1,z1),二维码坐标系o1x1y1z1相对于世界坐标系OXYZ的平移矩阵为PO1的计算如下:
P01=(X1,Y1,Z1)T
移动机器人各个坐标系相对于相邻的坐标系的旋转角度以及平移距离在移动机器人系统均已知,其他坐标系的旋转矩阵以及平移矩阵也按照上述方法来计算;
二维码坐标系o1x1y1z1相对于世界坐标系OXYZ有平移,相对于Z轴旋转,旋转矩阵为平移矩阵为PO1;摄像机坐标系o2x2y2z2相对于二维码坐标系o1x1y1z1为平移和旋转,旋转矩阵为/>平移矩阵为P12;云台a部分坐标系o3x3y3z3相对于摄像机坐标系o2x2y2z2只是相对于x2轴的平移,旋转矩阵为/>平移矩阵为P23;云台a部分坐标系o3x3y3z3相对于云台b部分坐标系o3x4y4z4只是相对于z3轴的旋转,所以他们共用一个坐标系原点o3,旋转矩阵为/>平移矩阵为P34;移动机器人坐标系o5x5y5z5相对于云台b部分坐标系o3x4y4z4只是相对于轴方向的平移和旋转,并且在云台b部分的坐标系o3x4y4z4下,移动机器人的坐标为4O5;
(4)通过旋转矩阵与平移矩阵计算移动机器人的位姿:通过计算表示出云台b部分坐标系相对于世界坐标系的旋转矩阵为平移矩阵为PO1+P12+P23+P34,移动机器人坐标系原点O5就是移动机器人的位置;根据坐标系变换规则,可以计算出移动机器人位置:
M2=(x,y,θ)T;
第四步,二维码定位数据对里程计定位结果修正,使用二维码的定位结果来修正里程计的数据,则:M1=M2=(x,y,θ)T。
这里考虑到机器人在移动的过程中存在打滑的情况,所以里程计的定位结果存在误差。二维码的位置在世界坐标系中是已知的,所以使用二维码的定位结果来修正里程计的数据;当移动机器人移动到没有二维码的地方时采用里程计的定位结果M1,当移动机器人运动到有二维码的地方时,使用二维码的定位结果M2来修正里程计的定位结果M1。因移动机器人在移动的过程中存在打滑的情况,里程计的定位结果存在误差,通过二维码定位数据对里程计定位结果进行修正移动机器人不需要进行大幅度位姿调整,有效提高了移动机器人的容错性和稳定性。
实施例2:如附图9、10所示,一种变电站巡检机器人定位装置,包括驱动机器人运动的轮式平台1、设置在轮式平台1内的机器人运动控制器2、编码器、通信模块、摄像机和云台3,所述轮式平台1沿圆周等间距安装有三个全向轮5,三个全向轮5上各安装有一个编码器,所述云台3底部设有支撑轴4,支撑轴4固定安装在轮式平台1上,所述摄像机安装在云台3的顶部,所述机器人运动控制器2与通信模块双向通信连接,编码器与机器人运动控制器2双向电连接,摄像机和云台3均与通信模块双向通信连接。
在实际工作时,轮式平台1起到驱动变电站巡检机器人运动和支撑云台的作用,在每个全向轮5上分别安装有一个电机,机器人运动控制器2控制电机的转向和转速,电机驱动车轮转动,从而实现机器人的运动;这里采用三个全向轮5带动旋转机器人的运动,能够快速实现机器人的360°转向,比起四轮驱动更方便灵活。这里的电机、机器人运动控制器2、通信模块均由固定在轮式平台内的大容量电池提供电源;编码器分别为编码器A7、编码器B8和编码器C9,机器人运动控制器2接收编码器A7、编码器B8和编码器C9发送的全向轮5的位置信息。这里的云台3为两自由度云台,包括云台a部分和云台b部分,云台a部分的两侧臂安装在云台b部分上,云台a部分和云台b部分均能够在机器人运动控制器的控制指令下旋转,云台a部分能够带动摄像机转动,随时调整摄像头的角度,便于寻找设备二维码位置。
如附图9、10所示,通信模块包括无线路由器6和串口联网模块10,所述摄像机、云台3、无线路由器6和机器人运动控制器2均与串口联网模块10通信连接。串口联网模块10的作用是将串口转化为RJ-45的网络接口,摄像机、串口联网模块10与无线路由器6之间均通过网口连接,云台3与串口联网模块10之间使用RS485通信接口连接,机器人运动控制器2与串口联网模块10之间使用RS232通信接口连接。
如附图9、10所示,还包括远程PC机11,所述远程PC机11与无线路由器6无线通信连接。远程PC机11与无线路由器6之间采用无线网络通信连接,用户通过远程PC机11控制巡检机器人运动,实现对设备的远程监控。
如附图9、10所示,所述摄像机包括红外摄像机12和高清摄像机13,红外摄像机12和高清摄像机13均与串口联网模块10通信连接。高清摄像机13上设有网络接口和USB接口,主要用于采集变电站内的二维码图像信息,这里的二维码图像均为矩形;红外摄像机13主要利用红外采集二维码的图像,便于更清楚的采集二维码信息。
如附图9、10所示,编码器均为光电编码器。这里的光电编码器A7、光电编码器B8和光电编码器C9分别安装在驱动移动机器人全向轮5运动的三个电机上,用于检测电机的转速,便于计算,从而实现对移动机器人进行精确定位。
实施例3:如附图1、2、3、4、5、6、7、8、9、10所示,基于二维码信息对变电站巡检机器人精确定位方法,包括以下步骤:
(1)使用二维码生成器生成带有编号的变电站设备二维码信息;
(2)将生成的二维码图片装订好,贴在二维码信息对应的变电站相应设备上并获得每个二维码在整个地图中的坐标;
(3)由计算机自动生成机器人的运动轨迹图,将轨迹图通过远程PC机以无线的形式发送给移动机器人;
(4)将搭载云台及高清摄像机的移动机器人放在变电站中按轨迹图进行移动,在机器人运动过程中,根据编码器得到机器人的位置信息,编码器具有累计误差,机器人运动越久,定位误差越大;当误差增大时,机器人自身检测到的自身位置和实际机器人所在的位置就会不同;
(5)在没有二维码区域移动机器人利用编码器进行定位,当捕捉到二维码时,机器人利用二维码信息进行识别,定位自身所在位置;二维码所代表的就是地图中坐标信息,设定移动机器人设置有两种路线,第一种路线依序经过的设备二维码位置为是0001至0002至0003至0004至0005至0006至0007至0008至0009,第二种路线是0001至0004至0002至0003至0005至0006至0008至0007至0009,在两种路线中,机器人在运动过程中自身定位误差会不同,但移动机器人根据二维码的设备位置信息调整后,可以纠正其定位误差;因为二维码自身所包含的信息中有自身的编号,机器人通过无线通信将编号信息发送给远程PC机11,远程PC机11遍寻编号后,得知该编号二维码在地图中的位置信息;
(6)远程PC机11查得二维码所在位置信息后,将信息发送给移动机器人,移动机器人根据自己相对于二维码的位置,从而得到移动机器人在全局中的准确位置,将自身的位置信息进行纠正,实现对移动机器人的全局精确定位。例如:0012号二维码所在位置是(X1,Y1),然后根据机器人相对二维码的距离和方位,确定机器人自身位置(X2,Y2)。
以上技术特征构成了本发明的实施例,其具有较强的适应性和实施效果,可根据实际需要增减非必要的技术特征,来满足不同情况的需求。
Claims (1)
1.一种变电站巡检机器人定位方法,其特征在于包括以下步骤:
第一步,建立坐标系,建立世界坐标系OXYZ,二维码坐标系o1x1y1z1,摄像机坐标系o2x2y2z2,云台a部分坐标系o3x3y3z3,云台b部分坐标系o3x4y4z4和机器人坐标系o5x5y5z5;
第二步,计算里程计的定位结果M1,对移动机器人进行运动学建模,使用三轮全向轮移动机器人作为移动平台,OXYZ为世界坐标系,o5x5y5z5为机器人坐标系,移动机器人的三个轮子分别标记为i,j,k,三个轮子各自的线速度分别为Vi,Vj,Vk,在机器人坐标系中,移动机器人在X轴和Y轴两个坐标上的速度分别为vx,vy,方向与坐标轴方向相同,机器人自身旋转的角速度为ω,R为轮子到机器人中心点O的距离;在世界坐标系中机器人沿两坐标轴的速度分别为Vx,Vy;通过分析得在机器人坐标系中根据机器人三个全向轮的线速度计算出机器人的速度为:
机器人坐标系与世界坐标系的夹角为φ,由机器人坐标系中的速度计算得到在世界坐标系下的速度为:
移动机器人的初始姿态为(x0,y0,φ0),Δt时间后移动机器人的姿态为(x1,y1,φ1),计算公式如下:
因移动机器人在地面运动,移动机器人的位姿用M1表示为:
M1=(x1,y1,φ1)T
第三步,通过二维码图像计算移动机器人的位姿M2,包括以下步骤:
(1)通过图像处理,读取二维码的信息,包括以下步骤:(a)相机拍照,(b)灰度化,(c)二值化,(d)形态学滤波,(e)边缘检测,(f)霍夫直线变换,(g)透视变换,(h)二维码信息读取;
(2)通过二维码计算摄像机坐标系o2x2y2z2相对于二维码坐标系o1x1y1z1的旋转矩阵2 1R以及平移矩阵P12,计算方法如下:
二维码贴在x1o1y1平面中,z1轴垂直于墙面向外,移动机器人相机镜头的朝向为z2轴,镜体方向为x2轴,图像信息位于x2o2y2坐标中;设边AO长度为lengthAO,边A1O1的长度为标定时假设当物体距离相机距离为1m时,实际中物体的长度和图像中物体长度的比为m,相机与二维码之间的距离计算公式如下:/>
已知二维码张贴高度h,移动机器人高清摄像机距离二维码的长度为l,则:
在世界坐标系中∠AOB=90°在相机坐标系中∠A1O1B1=θ,o2x2y2z2相对于o1x1y1z1绕z轴旋转-90°,然后在z1轴方向不再转动,在移动机器人运动和相机云台运动过程中,相对于z1轴不再旋转,只相对于x1轴和y1轴转动,绕x1转动用θx表示,绕y1轴用θy表示;o2x2y2z2中的坐标在o1x1y1z1坐标中如下表示:
其中
Δz=h
Δx=l*sinα
Δy=l*cosα
3个未知数θx,θy和β,需要3个方程,则OA,OB在x1o1y1平面中表示为:
在o2x2y2z2坐标系中:
z2轴与x1轴之间的夹角为θz1x
(3)各个坐标系之间旋转矩阵与平移矩阵的计算:
在世界坐标系中,设定二维码的位置为(x1,y1,z1),二维码坐标系o1x1y1z1相对于世界坐标系OXYZ的平移矩阵为PO1的计算如下:
P01=(X1,Y1,Z1)T
移动机器人各个坐标系相对于相邻的坐标系的旋转角度以及平移距离在移动机器人系统均已知,其他坐标系的旋转矩阵以及平移矩阵也按照上述方法来计算;
二维码坐标系o1x1y1z1相对于世界坐标系OXYZ有平移,相对于Z轴旋转,旋转矩阵为平移矩阵为PO1;摄像机坐标系o2x2y2z2相对于二维码坐标系o1x1y1z1为平移和旋转,旋转矩阵为/>平移矩阵为P12;云台a部分坐标系o3x3y3z3相对于摄像机坐标系o2x2y2z2只是相对于x2轴的平移,旋转矩阵为/>平移矩阵为P23;云台a部分坐标系o3x3y3z3相对于云台b部分坐标系o3x4y4z4只是相对于z3轴的旋转,所以他们共用一个坐标系原点o3,旋转矩阵为/>平移矩阵为P34;移动机器人坐标系o5x5y5z5相对于云台b部分坐标系o3x4y4z4只是相对于轴方向的平移和旋转,并且在云台b部分的坐标系o3x4y4z4下,移动机器人的坐标为4O5;
(4)通过旋转矩阵与平移矩阵计算移动机器人的位姿:通过计算表示出云台b部分坐标系相对于世界坐标系的旋转矩阵为平移矩阵为PO1+P12+P23+P34,移动机器人坐标系原点O5就是移动机器人的位置;根据坐标系变换规则,计算出移动机器人位置:
M2=(x,y,θ)T
第四步,二维码定位数据对里程计定位结果修正,使用二维码的定位结果来修正里程计的数据,则:
M1=M2=(x,y,θ)T。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610961927.0A CN106323294B (zh) | 2016-11-04 | 2016-11-04 | 变电站巡检机器人定位方法及定位装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610961927.0A CN106323294B (zh) | 2016-11-04 | 2016-11-04 | 变电站巡检机器人定位方法及定位装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106323294A CN106323294A (zh) | 2017-01-11 |
CN106323294B true CN106323294B (zh) | 2023-06-09 |
Family
ID=57815905
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610961927.0A Active CN106323294B (zh) | 2016-11-04 | 2016-11-04 | 变电站巡检机器人定位方法及定位装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106323294B (zh) |
Families Citing this family (34)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106871904A (zh) * | 2017-03-02 | 2017-06-20 | 南阳师范学院 | 一种基于机器视觉的移动机器人码盘定位修正方法 |
CN107300391A (zh) * | 2017-06-26 | 2017-10-27 | 国家电网公司 | 一种变电站智能巡检机器人定位坐标的自动校正装置及校正方法 |
CN107727104B (zh) | 2017-08-16 | 2019-04-30 | 北京极智嘉科技有限公司 | 结合标识的同时定位和地图创建导航方法、装置及系统 |
CN107962568A (zh) * | 2017-11-16 | 2018-04-27 | 上海斐讯数据通信技术有限公司 | 一种机器人的实时定位方法及系统 |
CN108036786B (zh) * | 2017-12-01 | 2021-02-09 | 安徽优思天成智能科技有限公司 | 基于辅助线的位姿检测方法、装置和计算机可读存储介质 |
CN109974746B (zh) * | 2017-12-27 | 2020-11-24 | 深圳市优必选科技有限公司 | 全向轮里程校准方法及机器人 |
CN108345304A (zh) * | 2018-01-29 | 2018-07-31 | 星视创(长沙)智能装备有限公司 | 智能搬运机器人定位系统及定位方法 |
CN108429175B (zh) * | 2018-05-17 | 2024-02-23 | 国家电网公司 | 智能变电站巡检系统 |
CN108827342A (zh) * | 2018-06-15 | 2018-11-16 | 深圳市沃特沃德股份有限公司 | 扫地机器人的摄像头与里程计坐标标定方法及系统 |
CN108759853A (zh) * | 2018-06-15 | 2018-11-06 | 浙江国自机器人技术有限公司 | 一种机器人定位方法、系统、设备及计算机可读存储介质 |
CN108537913A (zh) * | 2018-06-15 | 2018-09-14 | 浙江国自机器人技术有限公司 | 一种巡检系统 |
CN109035474A (zh) * | 2018-07-27 | 2018-12-18 | 国网江苏省电力有限公司苏州供电分公司 | 基于二维码的巡检方法和系统 |
CN110857858A (zh) * | 2018-08-23 | 2020-03-03 | 上海智远弘业机器人有限公司 | 一种用于机器人二维码导航的路标 |
CN111971529A (zh) * | 2018-09-03 | 2020-11-20 | Abb瑞士股份有限公司 | 用于管理机器人系统的方法和装置 |
CN109655055B (zh) * | 2018-11-07 | 2020-11-20 | 深圳技术大学(筹) | 一种轨检机器人的定位方法及装置 |
CN109596120A (zh) * | 2018-12-25 | 2019-04-09 | 芜湖哈特机器人产业技术研究院有限公司 | 一种组合定位导航传感器系统 |
CN109711503A (zh) * | 2018-12-29 | 2019-05-03 | 中国银联股份有限公司 | 一种机器人定位方法及装置 |
CN109738213B (zh) * | 2019-02-03 | 2020-10-02 | 北京新联铁集团股份有限公司 | 轨道交通机车车辆巡检位姿检测系统及其方法 |
CN109946564B (zh) * | 2019-03-15 | 2021-07-27 | 国网智能科技股份有限公司 | 一种配网架空线路巡检数据采集方法及巡检系统 |
CN111736583A (zh) * | 2019-03-25 | 2020-10-02 | 东元电机股份有限公司 | 二阶段导航系统 |
CN110187348A (zh) * | 2019-05-09 | 2019-08-30 | 盈科视控(北京)科技有限公司 | 一种激光雷达定位的方法 |
CN110197095B (zh) * | 2019-05-13 | 2023-08-11 | 深圳市普渡科技有限公司 | 机器人识别定位标识的方法及系统 |
CN110345937A (zh) * | 2019-08-09 | 2019-10-18 | 东莞市普灵思智能电子有限公司 | 一种基于二维码的导航定姿定位方法和系统 |
CN111026105A (zh) * | 2019-10-18 | 2020-04-17 | 同济大学 | 一种移动式机器人现场定位系统及其控制方法 |
CN111337011A (zh) * | 2019-12-10 | 2020-06-26 | 亿嘉和科技股份有限公司 | 一种基于激光和二维码融合的室内定位方法 |
CN110962128B (zh) * | 2019-12-11 | 2021-06-29 | 南方电网电力科技股份有限公司 | 一种变电站巡检布点方法及巡检机器人控制方法 |
CN111985420B (zh) * | 2020-08-25 | 2023-08-22 | 北京奥特雷柏科技有限公司 | 一种基于机器视觉的配电站无人化巡查方法 |
CN113758499B (zh) * | 2021-03-18 | 2024-05-17 | 北京京东乾石科技有限公司 | 确定定位传感器装配偏差补偿参数的方法、装置和设备 |
CN113075929A (zh) * | 2021-03-25 | 2021-07-06 | 深圳市伽利略机器人有限公司 | 滚刷式全向行走的机器人及其行走控制方法 |
CN113021297A (zh) * | 2021-03-25 | 2021-06-25 | 深圳市伽利略机器人有限公司 | 盘式行走的机器人及其行走控制方法 |
CN113075931B (zh) * | 2021-03-30 | 2022-04-08 | 西南科技大学 | 一种三轮全向移动机器人及其运动控制方法 |
CN113256837B (zh) * | 2021-04-28 | 2022-05-31 | 宁波思高信通科技有限公司 | 一种机房巡检方法、系统、存储介质及智能终端 |
CN113566827A (zh) * | 2021-07-09 | 2021-10-29 | 中国能源建设集团安徽省电力设计院有限公司 | 一种基于信息融合的变电站巡检机器人室内定位方法 |
CN114035540B (zh) * | 2021-10-26 | 2024-03-22 | 嘉兴市敏硕智能科技有限公司 | 全向移动平台误差自校准方法、系统、装置及存储介质 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03229311A (ja) * | 1990-02-02 | 1991-10-11 | Sanyo Electric Co Ltd | 走行ロボット装置 |
JP2009123061A (ja) * | 2007-11-16 | 2009-06-04 | Topy Ind Ltd | ロボット位置検出システム |
CN102280826A (zh) * | 2011-07-30 | 2011-12-14 | 山东鲁能智能技术有限公司 | 变电站智能机器人巡检系统及巡检方法 |
CN103400392A (zh) * | 2013-08-19 | 2013-11-20 | 山东鲁能智能技术有限公司 | 基于变电站巡检机器人的双目视觉导航系统及方法 |
DE102012112401B3 (de) * | 2012-12-17 | 2014-03-27 | Miele & Cie. Kg | Selbstfahrender Roboter und Verfahren zur Bestimmung einer Drehstellung mindestens eines Antriebsrads eines selbstfahrenden Roboters |
WO2015024407A1 (zh) * | 2013-08-19 | 2015-02-26 | 国家电网公司 | 基于电力机器人的双目视觉导航系统及方法 |
CN104597903A (zh) * | 2014-11-27 | 2015-05-06 | 无锡北斗星通信息科技有限公司 | 用于自动读表的变电站巡检机器人 |
CN105044754A (zh) * | 2015-07-01 | 2015-11-11 | 西安交通大学 | 一种基于多传感器融合的移动平台室外定位方法 |
CN105243366A (zh) * | 2015-10-10 | 2016-01-13 | 北京微尘嘉业科技有限公司 | 一种基于二维码的车辆定位方法 |
CN105259899A (zh) * | 2015-12-01 | 2016-01-20 | 国网重庆市电力公司电力科学研究院 | 一种变电站巡检机器人的控制系统 |
WO2016165391A1 (zh) * | 2015-04-16 | 2016-10-20 | 华南理工大学 | 一种视觉设备作为传感器的并联平台跟踪控制装置与方法 |
CN206321253U (zh) * | 2016-11-04 | 2017-07-11 | 新疆大学 | 变电站巡检机器人定位装置 |
-
2016
- 2016-11-04 CN CN201610961927.0A patent/CN106323294B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03229311A (ja) * | 1990-02-02 | 1991-10-11 | Sanyo Electric Co Ltd | 走行ロボット装置 |
JP2009123061A (ja) * | 2007-11-16 | 2009-06-04 | Topy Ind Ltd | ロボット位置検出システム |
CN102280826A (zh) * | 2011-07-30 | 2011-12-14 | 山东鲁能智能技术有限公司 | 变电站智能机器人巡检系统及巡检方法 |
DE102012112401B3 (de) * | 2012-12-17 | 2014-03-27 | Miele & Cie. Kg | Selbstfahrender Roboter und Verfahren zur Bestimmung einer Drehstellung mindestens eines Antriebsrads eines selbstfahrenden Roboters |
CN103400392A (zh) * | 2013-08-19 | 2013-11-20 | 山东鲁能智能技术有限公司 | 基于变电站巡检机器人的双目视觉导航系统及方法 |
WO2015024407A1 (zh) * | 2013-08-19 | 2015-02-26 | 国家电网公司 | 基于电力机器人的双目视觉导航系统及方法 |
CN104597903A (zh) * | 2014-11-27 | 2015-05-06 | 无锡北斗星通信息科技有限公司 | 用于自动读表的变电站巡检机器人 |
WO2016165391A1 (zh) * | 2015-04-16 | 2016-10-20 | 华南理工大学 | 一种视觉设备作为传感器的并联平台跟踪控制装置与方法 |
CN105044754A (zh) * | 2015-07-01 | 2015-11-11 | 西安交通大学 | 一种基于多传感器融合的移动平台室外定位方法 |
CN105243366A (zh) * | 2015-10-10 | 2016-01-13 | 北京微尘嘉业科技有限公司 | 一种基于二维码的车辆定位方法 |
CN105259899A (zh) * | 2015-12-01 | 2016-01-20 | 国网重庆市电力公司电力科学研究院 | 一种变电站巡检机器人的控制系统 |
CN206321253U (zh) * | 2016-11-04 | 2017-07-11 | 新疆大学 | 变电站巡检机器人定位装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106323294A (zh) | 2017-01-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106323294B (zh) | 变电站巡检机器人定位方法及定位装置 | |
CN106607907B (zh) | 一种移动视觉机器人及其测控方法 | |
US9470658B2 (en) | Self-contained holonomic tracking method and apparatus for non-destructive inspection | |
CN108571971B (zh) | 一种agv视觉定位系统及方法 | |
US10809071B2 (en) | Method for constructing a map while performing work | |
CN107167141B (zh) | 基于双一线激光雷达的机器人自主导航系统 | |
CN108287544B (zh) | 一种智能机器人路线规划及沿原路径返回的方法及系统 | |
KR101776823B1 (ko) | 외부 감시카메라를 이용한 모바일 로봇의 위치인식 방법 및 시스템 | |
CN109911188B (zh) | 非卫星导航定位环境的桥梁检测无人机系统 | |
CN206321253U (zh) | 变电站巡检机器人定位装置 | |
CN106595630B (zh) | 一种基于激光导航变电站巡检机器人的建图系统与方法 | |
CN109737981B (zh) | 基于多传感器的无人车目标搜索装置及方法 | |
CN111633660A (zh) | 一种智能巡检机器人 | |
CN104786226A (zh) | 抓取在线工件的机器人位姿及运动轨迹定位系统与方法 | |
CN104914863A (zh) | 一种一体式无人运动平台环境理解系统及其工作方法 | |
CA2836290A1 (en) | Holonomic motion vehicle for travel on non-level surfaces | |
CN106959697A (zh) | 一种面向长直廊环境的室内地图自动构建系统 | |
CN208818162U (zh) | 定位机器人 | |
CN205655844U (zh) | 一种基于ros的机器人里程计 | |
CN111251271B (zh) | 一种旋转激光雷达及室内地图构建和定位的slam机器人 | |
Nüchter et al. | Irma3D—An intelligent robot for mapping applications | |
CN109976339A (zh) | 一种车载配网巡检数据采集方法与巡检系统 | |
Vega-Heredia et al. | Multi-sensor orientation tracking for a façade-cleaning robot | |
CN111531560B (zh) | 应用于变电站室内外环境中的巡检机器人 | |
Suriyon et al. | Development of guide robot by using QR code recognition |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |