CN110154026B - 铁路牵引变电所操作机器人控制系统及控制方法 - Google Patents
铁路牵引变电所操作机器人控制系统及控制方法 Download PDFInfo
- Publication number
- CN110154026B CN110154026B CN201910441674.8A CN201910441674A CN110154026B CN 110154026 B CN110154026 B CN 110154026B CN 201910441674 A CN201910441674 A CN 201910441674A CN 110154026 B CN110154026 B CN 110154026B
- Authority
- CN
- China
- Prior art keywords
- button
- center
- axis
- distance
- manipulator
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1689—Teleoperation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
一种铁路牵引变电所操作机器人控制系统及控制方法,可解决人工完成对牵引变电所室内配电柜上设备进行操作,劳动强度大和操作风险大的技术问题。包括磁导引AGV和安装在磁导引AGV上的控制柜,控制柜上设置工业相机总成、操作平台升降总成、操作平台横移总成、机械手总成、传感器总成;通过AGV小车的移动和升降装置的升降,工业相机总成可以拍摄到配电柜整体图片;通过图像处理和识别,确定要操作的电气开关和小车以及机械手的相对位置,调整机械手位置使其正对要操作的开关,从而控制机械手完成对开关的操作。本发明实现从“有人”到“无人”的跨越性转变,提升了巡检的精度和数据收集的准确率,同时也缩短了故障从发生到发展再到造成事故的判断周期。
Description
技术领域
本发明涉及机器人技术领域,具体涉及一种铁路牵引变电所操作机器人控制系统及控制方法。
背景技术
随着我国的铁路和电力系统自动化技术的快速发展,牵引变电所的数量不断增加,牵引变电所作为牵引供电系统中变换电压、传输电能的枢纽,承担着极其重要的任务,牵引变电所稳定运行直接影响铁路系统的稳定性、可靠性以及抵抗事故的能力。目前牵引变电所正在朝着无人值守的方向发展,对无人值守的牵引变电所内电力设备进行操作对于保证牵引变电所稳定运行具有重要的作用。目前,国内大多数牵引变电所内的电力设备进行操作时还是采用传统的人工操作。人工操作会出现以下几方面问题:
(1)操作人员采用手动对电力设备上装置进行操作,但是随着牵引变电所的数量和功能不断增加,变电所内需要操作的设备仪器种类繁多、种类各异,很容易由于操作人员的工作经验、责任心、业务水平、精神状态等诸多因素影响制约发生误操作和漏操作的情况,为重大设备事故埋下隐患。而且操作人员需要操作的电力设备多,也会导致劳动强度大、工作效率低等问题,这些问题会直接影响牵引变电所稳定运行和铁路的正常工作。
(2)操作人员对电力设备上的空开、旋钮、按钮等装置进行手动操作时,由于有的电力设备安装在高压室内,操作人员在手动操作时会存在安全风险。
发明内容
本发明提出的一种铁路牵引变电所操作机器人控制系统及控制方法,可解决人工完成对牵引变电所室内配电柜上设备进行操作,劳动强度大和操作风险大的技术问题。
为实现上述目的,本发明采用了以下技术方案:
一种铁路牵引变电所操作机器人控制系统,包括有操作机器人:
所述操作机器人包括磁导引AGV和安装在磁导引AGV上的控制柜,所述控制柜上设置工业相机总成、操作平台升降总成、操作平台横移总成、机械手总成、传感器总成;
所述控制柜内还设置工业平板电脑和可编程逻辑控制器;
所述操作平台升降总成、操作平台横移总成、机械手总成的驱动机构分别与可编程逻辑控制器连接;传感器总成与可编程逻辑控制器直接连接;
所述磁导引AGV、工业相机总成、可编程逻辑控制器均与工业平板电脑连接;
其中,传感器总成用于测量控制柜与配电柜之间距离,测量磁导引AGV与配电柜之间的夹角,测量操作平台横移总成与配电柜之间距离,并发送给工业平板电脑,从而控制操作机械手向前移动固定距离完成操作;
工业相机总成用于拍摄配电柜上待操作设备的位置图片并发送给工业平板电脑,工业平板电脑对所述图片进行图像处理和分析,计算出操作机械手与待操作设备间的距离差值,从而控制操作机械手定位到待操作设备处。
进一步的,还包括信息中心,信息中心包括有工业控制计算机、分别与工业控制计算机连接的中心显示屏和中心无线路由器;所述中心无线路由器通过操作无线路由器与工业平板电脑通信连接。
进一步的,所述工业相机总成包括有近景相机和远景相机;
所述近景相机安装在操作平台横移总成上;
所述远景相机固定在操作平台升降总成上;
所述近景相机和远景相机分别与工业平板电脑通信连接。
进一步的,所述传感器总成包括有固定激光位移传感器和移动激光位移传感器;
所述固定激光位移传感器安装在控制柜外侧上;
所述移动激光位移传感器安装在操作平台横移总成上;
所述固定激光位移传感器和移动激光位移传感器分别与可编程逻辑控制器直接连接。
另一方面本发明还公开一种铁路牵引变电所操作机器人控制方法,基于上述的铁路牵引变电所操作机器人控制系统,包括以下步骤:
磁导引AGV启动,到达地标卡标记位置;
通过传感器总成测量磁导引AGV与配电柜之间的夹角,判断磁导引AGV是否平行于待操作控制柜,如果不平行则调整磁导引AGV角度使其与控制柜平行;
通过工业相机总成拍摄配电柜上待操作设备的位置图片并发送给工业平板电脑,工业平板电脑对所述图片进行图像处理和分析,计算出操作机械手与待操作设备间的距离差值,从而控制操作机械手定位到待操作设备处,按压按钮操作。
进一步的,所述通过传感器总成测量磁导引AGV与配电柜之间的夹角的具体步骤如下:
(一)、基于操作机器人建立空间坐标系,在空间坐标系下对机械手总成、传感器总成、工业相机总成的初始位置坐标进行确定;
空间坐标系的X轴、Y轴、Z轴定义如下:
Z轴:过磁导引AGV中心点并垂直于其顶部,Z轴起始点为Z轴和磁导引AGV顶部的交点,规定向上为Z轴正方向;
Y轴:过Z轴起始点并垂直于Z轴,平行于操作平台横移总成水平移动方向,规定向左为Y轴正方向;
原点:Y轴和Z轴的交点为原点;
X轴:根据右手定则,X轴过原点并平行于磁导引AGV,磁导引AGV(12)前进方向为X轴正方向;
(三)、为按钮机械手、空开机械手、旋钮机械手分别建立直线坐标系,分别用V1轴、V2轴、V3轴表示,这三个轴都平行于Y轴;
固定激光位移传感器位置固定不动,此时中心坐标S1为(xS10,yS10,zS10),测得的距离为a1;
移动激光位移传感器随着操作平台横移总成沿Y轴移动距离y,此时中心S2坐标为(xS20,yS20+y,zS20),测得的距离为a2;
假设磁导引AGV与配电柜之间有夹角θ,S1代表固定激光位移传感器初始位置,S2和S2′分别代表移动激光位移传感器初始位置和当前位置,则夹角θ的计算公式如(1.1)和(1.2);
式中:
E=a1-[a2+y-(yS10-yS20)]
F=xS10-xS20
计算出夹角θ后,工业平板电脑将夹角θ数据发送给磁导引AGV,磁导引AGV旋转θ使得磁导引AGV和配电柜相互平行。
进一步的,所述通过工业相机总成拍摄配电柜上待操作设备的位置图片并发送给工业平板电脑,工业平板电脑对所述图片进行图像处理和分析,计算出操作机械手与待操作设备间的距离差值;
包括:
工业平板电脑对远景相机拍摄的配电柜图片进行图像处理,得出待操作按钮中心的像素坐标和图片中心像素坐标,从而计算出待操作按钮中心G0和远景相机中心P1在空间坐标系下沿X轴和Z轴方向上的距离差值,再通过坐标转换得到待操作按钮中心G0和按钮机械手中心Q1在X轴和Z轴方向上的距离差值,然后在X轴方向上移动磁导引AGV以及在Z轴方向上提升操作平台升降总成,达到按钮机械手在XZ平面坐标系下粗定位的目的;
按钮机械手完成粗定位后,操作平台横移总成向前移动直到移动激光位移传感器测得与配电柜间距离为d3时停下,根据操作任务的不同改变d3的距离,操作平台横移总成向前移动缩短近景相机和配电柜之间的距离,使得近景相机拍摄待操作按钮的图片分辨率更高,从而进行图像处理得到的按钮中心坐标精度更高,达到按钮机械手精定位的目的。
进一步的,所述计算出待操作按钮中心G0和远景相机中心P1在空间坐标系下沿X轴和Z轴方向上的距离差值,再通过坐标转换得到待操作按钮中心G0和按钮机械手中心Q1在X轴和Z轴方向上的距离差值,步骤如下:
第一步:操作平台升降总成提升高度h后,远景相机中心P1坐标(xP10,yP10,zP10+h),固定激光位移传感器测得离配电柜的距离为d1以及中心S1坐标(xS10,yS10,zS10),得出远景相机离配电柜的距离为d2,d2计算公式如公式1.3所示,其中远景相机中心P1和固定激光位移传感器中心S1在XY平面坐标系中位置关系;
d2=d1+yS10-yP10\*MERGEFORMAT(1.3);
第二步:假设远景相机的最高分辨率为M×N,远景相机拍摄的图片实际长度L和远景相机离配电柜之间的距离d2关系为L∶d2=1∶1,图片的实际高度为H与实际长度L之间的关系为L∶H=M∶N;在图像坐标系中X轴方向上单位像素代表的实际距离为Ix,Z轴方向上单位像素代表的实际距离为Iz,Ix和Iz,的计算公式如(1.4)所示;
第三步:由于远景相机在拍摄图片的时候,远景相机中心不是正对着待操作按钮中心,而且待操作按钮有一定厚度t,导致图像识别到的按钮中心与实际按钮中心有偏移误差,需要进行误差补偿;具体步骤如下:
假设平面A是待操作按钮表面,平面B是配电柜表面,平面A和平面B之间距离为按钮厚度t,点P1是远景相机中心,点P1'是P1在平面B上的垂直投影点,点P1到平面B距离为d2,G0是待操作按钮实际中心,G1是图像识别找到的待操作按钮中心,G2是G0在平面B上的垂直投影点,计算的偏移误差就是计算线段G1G2的距离,G1G2与水平方向上的夹角为α,根据相似三角形G0G1G2相似于P1G1P1'可得出G1G2的距离,则水平方向的距离误差为G1G2cosα,竖直方向上的距离误差为G1G2sinα,计算公式如(1.5)、(1.6)所示;
为了计算平面B上各点间实际距离,通过调用已写好的图像算法对远景相机拍摄的图片进行图像处理,从而得到各点像素坐标;由于空间坐标系的Z轴正方向是竖直向上的,为了使图像坐标系里Z轴和空间坐标系里Z轴正方向一致,重新构建图像坐标系使得图像坐标系里的Z轴向上以及X轴向右;
具体为图像识别找到的按钮中心G1点的像素坐标为(x1,z1),按钮实际中心G0在平面B上投影点G2的像素坐标为(x2,z2),远景相机中心P1在平面B上投影点P1'的像素坐标为(M/2,N/2),G1点和P1'点之间的像素坐标差(R,S),按钮实际中心G0和远景相机中心P1在空间坐标系下沿X轴和Z轴方向上的移动量为L1和H1,图像坐标系中各点间实际距离计算公式如(1.7)至(1.12)所示;
图像识别后水平方向上的实际距离误差:
图像识别后竖直方向上的实际距离误差:
磁导引AGV(12)在X轴方向上移动量L1为:
操作平台升降总成在Z轴方向上移动量H1为:
第四步:已知操作平台横移总成沿Y轴移动了距离y,按钮机械手沿V1轴移动了距离v1,操作平台升降总成提升了高度h,此时按钮机械手中心Q1坐标为(xQ10,yQ10+y+v1,zQ10+h),远景相机中心P1坐标(xP10,yP10,zP10+h),按钮机械手中心Q1和远景相机中心P1在空间坐标系下沿着X轴和Z轴方向上的实际距离差值xP10-xQ10和zP10-zQ10;
具体为:
1)按钮机械手中心Q1和按钮中心G0在沿着X轴方向上的移动量为X1,计算公式如(1.13);
X1=L1+xP10-xQ10\*MERGEFORMAT(1.13)
2)按钮机械手中心Q1和按钮中心G0在沿着Z轴方向上的移动量为Z1,计算公式如(1.14)所示;
Z1=H1+zP10-zQ10\*MERGEFORMAT(1.14)
则操作机器人控制磁导引AGV和操作平台升降总成分别在X轴和Z轴的方向上移动数值为X1和Z1,使得按钮机械手在XZ平面坐标系下完成粗定位。
进一步的,所述按钮机械手完成粗定位后,操作平台横移总成向前移动直到移动激光位移传感器测得与配电柜间距离为d3时停下,根据操作任务的不同改变d3的距离,操作平台横移总成向前移动缩短近景相机和配电柜之间的距离,使得近景相机拍摄待操作按钮的图片分辨率更高,从而进行图像处理得到的按钮中心坐标精度更高,达到按钮机械手精定位的目的;
具体包括:
精定位处理过程和粗定位处理过程相同,精定位时近景相机中心P2距离配电柜表面距离为d4,图像处理后会得出按钮中心G0和近景相机P2中心在空间坐标系下沿X轴和Z轴方向上的移动差值L2和H2,再通过坐标转换得到按钮中心G0和按钮机械手中心Q1在X轴和Z轴方向上的移动量X2和Z2;
1)按钮机械手中心Q1和按钮中心G0沿着X轴方向上的移动量为X2,计算公式如(1.15);
X2=L2+xP20-xQ10\*MERGEFORMAT(1.15);
2)按钮机械手中心Q1和按钮中心G0在沿着Z轴方向上的移动量为Z2,计算公式如(1.16)所示,
Z2=H2+zP20-zQ10\*MERGEFORMAT(1.16);
操作机器人再次控制磁导引AGV和操作平台升降总成分别在X轴和Z轴的方向上移动数值为X2和Z2,使得按钮机械手在XZ平面坐标系下完成精定位。
进一步的,还包括,所述按钮机械手完成精定位后,按钮机械手沿着V1轴向前移动距离d5使其接触按钮表面,Q1和Q1'分别代表按钮机械手中心的初始位置和当前位置,已知按钮机械手在初始位置沿V1轴移动了距离v1,得当前位置的按钮机械手中心Q1'和移动激光位移传感器中心S2沿Y轴方向上距离差为yQ10+v1-yS20,移动激光位移传感器中心S2与配电柜表面距离为d3,按钮头部的厚度为t,d5计算公式如(1.17)所示,
d5=d3-(yQ10+v1-yS20)-t
\*MERGEFORMAT(1.17);
在进行按压按钮操作之前,近景相机需要再次拍摄按钮图片并发送给工业平板电脑进行确认,工业平板电脑判断按钮机械手定位到的这个按钮是不是正确的,如果确定是需要操作的按钮,按钮机械手将向前移动距离d6进行按压按钮操作,移动的距离d6为按钮导通的行程,如果不是正确的将返回远景相机拍照流程进行再一次的粗定位和精定位;
操作机器人所有的伺服电机完成退回原点操作,结束按压按钮操作任务并为下一次自动操作做准备。
由上述技术方案可知,本发明的铁路牵引变电所操作机器人控制系统及控制方法,设置机器人的机械结构都架设于AGV小车上方,AGV小车采取的是差速转弯,使得机器人在狭小的过道中可以对电气柜进行检测;机器人的主升降架部分采取的是一种二级提升装置,使操作平台上的摄像头和操作手可以竖直上升到最高的位置(2.1米),下降到最低的位置(0.4米),整个机器人可以全工作面(从上到下)的对电气柜进行巡检;通过AGV小车的移动和升降装置的升降,摄像头可以对整个拍摄到整幅控制柜的图像;通过图像处理和识别,确定要操作的电气开关和小车以及机械手的相对位置,调整机械手位置使其正对要操作的开关。操作平台向控制柜面板方向伸出,机械手从操作平台上伸出接触开关,完成对开关的操作。
本发明的电气柜巡检机器人旨在实现从“有人”到“无人”的跨越性转变,在电力行业新旧管理体系和方法交替的时期,机器人技术的引入,可以在技术层面直接对巡检工作进行干预,提升了巡检的精度和数据收集的准确率,同时也缩短了故障从发生到发展再到造成事故的判断周期。
附图说明
图1是本发明的结构框图;
图2是本发明的整体结构示意图;
图3是本发明操作机器人空间坐标系示意图;
图4是本发明操作机器人的三视图(4a是主视图,4b是左视图,4c是俯视图);
图5是本发明操作机器人直线坐标系;
图6是本发明操作机器人硬件相对位置图;
图7是本发明操作机器人操作按钮的流程图;
图8是本发明磁导引AGV与配电柜相对位置图;
图9是本发明远景相机和固定激光位移传感器的XY平面示意图;
图10是本发明按钮中心点位置误差分析图;
图11是本发明图像坐标系中各点相对位置图;
图12是本发明粗定位XY平面示意图;
图13是本发明粗定位YZ平面示意图;
图14是本发明精定位XY平面示意图;
图15是本发明精定位YZ平面示意图;
图16是本发明按钮机械手向前移动时XY平面示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。
如图1和图2所示,本实施例所述的铁路牵引变电所操作机器人控制系统,铁路牵引变电所操作机器人控制系统,包括有操作机器人1、信息中心2;
操作机器人1包括工业相机总成11、磁导引AGV12、安装在磁导引AGV12上的控制柜13、操作平台升降总成14、操作平台横移总成15、机械手总成16、传感器总成17;
控制柜13内设置有工业平板电脑132、可编程逻辑控制器134、操作无线路由器133;
操作平台升降总成14、操作平台横移总成15、机械手总成16的驱动机构与可编程逻辑控制器134连接;传感器总成17与可编程逻辑控制器134直接连接;
磁导引AGV12、工业相机总成11、可编程逻辑控制器134、操作无线路由器133均与工业平板电脑132连接;
机械手总成16安装在操作平台上;近景相机111和移动激光位移传感器172安装在操作平台横移总成15上;远景相机112固定在操作平台升降总成14上;固定激光位移传感器171安装在控制柜13外侧上;
信息中心2包括有工业控制计算机22、分别与工业控制计算机22连接的中心显示屏23以及中心无线路由器21;操作无线路由器133和中心无线路由器21采用无线通信连接;
机械手总成16包括有按钮机械手161、空开机械手162、旋钮机械手163;
工业相机总成11包括有近景相机111、远景相机112;
传感器总成17包括有固定激光位移传感器171、移动激光位移传感器172;
铁路牵引变电所操作机器人控制系统的操作方法,包括以下步骤:
(一)空间坐标系的建立
操作机器人1要完成操作的关键是要控制机械手移动到指定的位置,为了实现机械手能够精确的到达待操作按钮、空开、旋钮的位置,需要进行空间坐标系的建立,在操作机器人1上建立空间坐标系后如图3所示,操作机器人1的三视图如图4(a、b、c)所示。在空间坐标系下对机械手总成16、传感器总成17、工业相机总成11的初始位置坐标进行确定,自动操作时利用图像识别技术进行坐标转换,实现机械手准确定位到待操作按钮、空开、旋钮的位置处并进行操作。
空间坐标系的X轴、Y轴、Z轴定义如下:
Z轴:过磁导引AGV12中心点并垂直于其顶部,Z轴起始点为Z轴和磁导引AGV12顶部的交点,规定向上为Z轴正方向。
Y轴:过Z轴起始点并垂直于Z轴,平行于操作平台横移总成15水平移动方向,规定向左为Y轴正方向。
原点:Y轴和Z轴的交点为原点。
X轴:根据右手定则,X轴过原点并平行于磁导引AGV12,磁导引AGV12前进方向为X轴正方向。
(二)直线坐标系的建立
在空间坐标系下操作平台横移总成15在Y轴方向上移动,因为在自动操作时机械手要在操作平台横移总成15上进行二次移动,因此需要为按钮机械手161、空开机械手162、旋钮机械手163分别建立直线坐标系,分别用V1轴、V2轴、V3轴表示,这三个轴都平行于Y轴,操作机器人1直线坐标系如图5所示。
(三)硬件初始中心坐标
操作机器人1上的各种硬件的相对位置如图6所示,在空间坐标系下对操作机器人1上的硬件如工业相机、激光位移传感器、机械手进行初始中心坐标的确定,首先将六台伺服电机全部进行回原点,在原点状态下得到硬件的初始中心坐标。
原点状态下,安装在操作平台升降总成14上的远景相机112中心P1坐标为(xP10,yP10,zP10),安装在操作平台横移总成15上的近景相机111中心P2坐标为(xP20,yP20,zP20),安装在控制柜13上的固定激光位移传感器171中心S1坐标为(xS10,yS10,zS10),安装在操作平台横移总成15上的移动激光位移传感器172中心S2坐标为(xS20,yS20,zS20),按钮机械手161中心Q1坐标为(xQ10,yQ10,zQ10),空开机械手162中心Q2坐标为(xQ20,yQ20,zQ20),旋钮机械手163中心Q3坐标为(xQ30,yQ30,zQ30),这些硬件在操作机器人1上的相对位置如图6所示。
自动操作过程中,远景相机112只沿着Z轴移动,中心P1坐标为(xP10,yP10,zP10+z);近景相机111只沿着Y轴、Z轴移动,中心P2坐标为(xP20,yP20+y,zP20+z);固定激光位移传感器171位置固定不动,中心S1坐标为(xS10,yS10,zS10);移动激光位移传感器172只沿着Y轴、Z轴移动,中心S2坐标为(xS20,yS20+y,zS20+z);按钮机械手161只沿着V1轴、Y轴、Z轴移动,中心Q1坐标为(xQ10,yQ10+y+v1,zQ10+z),空开机械手162只沿着V2轴、Y轴、Z轴移动,中心Q2坐标为(xQ20,yQ20+y+v2,zQ20+z);旋钮机械手163只沿着V3轴、Y轴、Z轴移动以及V3轴转动,中心Q3坐标为(xQ30,yQ30+y+v3,zQ30+z)。
(四)操作按钮流程设计
按钮操作、空开操作、旋钮操作的操作步骤大致相同,只是这三个元器件的结构不同所以在最后执行动作方面有所区别,下面以操作按钮为例对操作机器人1如何实现每一步动作进行分析说明,操作机器人1操作按钮的流程图如图7所示。
操作机器人1在对配电柜上的按钮进行操作的时候,需要进行多次逻辑判断和图像识别,包括判断磁导引AGV12是否与配电柜平行,图像处理进行按钮位置的粗定位和精定位、发送精定位后的按钮图片给信息中心进行确认判断等步骤,从而使按钮机械手161能够准确的移动到按钮的位置完成操作。
下面对流程图里这些步骤进行理论分析和设计:
(1)磁导引AGV12移动至目标配电柜:在工业平板电脑132的任务选择界面里选择需要操作的配电柜站号以及对哪个按钮进行操作后,工业平板电脑132将配电柜站号发送给磁导引AGV12,磁导引AGV12通过铺设在磁条下面的RFID标签确定配电柜的位置并准确停下。
(2)判断磁导引AGV12是否平行于配电柜:磁导引AGV12在配电柜面前停下后需要判断磁导引AGV12是否与配电柜平行,如果不平行会影响按钮机械手161对按钮的操作。因此,需要进行磁导引AGV12位置调整,通过两个激光位移传感器测得的距离可以计算出磁导引AGV12与配电柜之间的夹角,再将计算得到的角度发送给磁导引AGV12使其旋转相应角度与配电柜平行。
固定激光位移传感器171位置固定不动,此时中心坐标S1为(xS10,yS10,zS10),测得的距离为a1;移动激光位移传感器172随着操作平台横移总成15沿Y轴移动距离y,此时中心S2坐标为(xS20,yS20+y,zS20),测得的距离为a2。假设磁导引AGV12与配电柜之间有夹角θ,S1代表固定激光位移传感器171初始位置,S2和S2'分别代表移动激光位移传感器172初始位置和当前位置,磁导引AGV12和配电柜之间的相对位置如图8所示。夹角θ的计算公式如(1.1)和(1.2)所示。
式中:
E=a1-[a2+y-(yS10-yS20)]
F=xS10-xS20
计算出夹角θ后,工业平板电脑132将夹角θ数据发送给磁导引AGV12,磁导引AGV12旋转θ使得磁导引AGV12和配电柜相互平行。
(3)操作平台升降总成14提升到指定高度h:当磁导引AGV12旋转到与配电柜平行后,安装在操作平台升降总成14上的远景相机112需要拍摄到待操作按钮图片进行粗定位,由于配电柜比较高而且远景相机112受安装位置限制离配电柜不是很远,因此不能将配电柜整体拍摄下来,需要将操作平台升降总成14提升到一定高度h,保证在粗定位的时候能够拍摄到待操作按钮。
(4)按钮机械手161进行粗定位:因为远景相机112与配电柜的距离远,拍摄的图片分辨率不够,导致经过图像处理后得到的按钮中心坐标精度不够,因此作为按钮机械手161粗定位。
工业平板电脑132对远景相机112拍摄的配电柜图片进行图像处理,得出待操作按钮中心的像素坐标和图片中心像素坐标,从而计算出待操作按钮中心G0和远景相机112中心P1在空间坐标系下沿X轴和Z轴方向上的距离差值,再通过坐标转换得到待操作按钮中心G0和按钮机械手161中心Q1在X轴和Z轴方向上的距离差值,然后在X轴方向上移动磁导引AGV12以及在Z轴方向上提升操作平台升降总成14,达到按钮机械手161在XZ平面坐标系下粗定位的目的。距离差值计算步骤如下:
第一步:操作平台升降总成14提升高度h后,远景相机112中心P1坐标(xP10,yP10,zP10+h),固定激光位移传感器171测得离配电柜的距离为d1以及中心S1坐标(xS10,yS10,zS10),得出远景相机112离配电柜的距离为d2,d2计算公式如(1.3)所示,其中远景相机112中心P1和固定激光位移传感器171中心S1在XY平面坐标系中位置关系如图9所示。
d2=d1+yS10-yP10\*MERGEFORMAT(1.3)
第二步:远景相机112的最高分辨率为M×N,远景相机112拍摄的图片实际长度L和远景相机112离配电柜之间的距离d2关系为L:d2=1:1,图片的实际高度为H与实际长度L之间的关系为L:H=M:N。在图像坐标系中X轴方向上单位像素代表的实际距离为Ix,Z轴方向上单位像素代表的实际距离为Iz,Ix和Iz的计算公式如(1.4)所示。
第三步:由于远景相机112在拍摄图片的时候,远景相机112中心不是正对着待操作按钮中心,而且待操作按钮有一定厚度t,导致图像识别到的按钮中心与实际按钮中心有偏移误差,需要进行误差补偿。
按钮中心点位置误差分析如图10所示,平面A是待操作按钮表面,平面B是配电柜表面,平面A和平面B之间距离为按钮厚度t,点P1是远景相机112中心,点P1'是P1在平面B上的垂直投影点,点P1到平面B距离为d2,G0是待操作按钮实际中心,G1是图像识别找到的待操作按钮中心,G2是G0在平面B上的垂直投影点,计算的偏移误差就是计算线段G1G2的距离,G1G2与水平方向上的夹角为α,根据相似三角形G0G1G2相似于P1G1P1'可得出G1G2的距离,则水平方向的距离误差为G1G2cosα,竖直方向上的距离误差为G1G2sinα,计算公式如(1.5)、(1.6)所示。
为了计算平面B上各点间实际距离,通过调用已写好的图像算法对远景相机112拍摄的图片进行图像处理,从而得到各点像素坐标。由于空间坐标系的Z轴正方向是竖直向上的,为了使图像坐标系里Z轴和空间坐标系里Z轴正方向一致,重新构建图像坐标系使得图像坐标系里的Z轴向上以及X轴向右。
图像识别找到的按钮中心G1点的像素坐标为(x1,z1),按钮实际中心G0在平面B上投影点G2的像素坐标为(x2,z2),远景相机112中心P1在平面B上投影点P1'的像素坐标为(M/2,N/2),G1点和P1'点之间的像素坐标差(R,S),按钮实际中心G0和远景相机112中心P1在空间坐标系下沿X轴和Z轴方向上的移动量为L1和H1,图像坐标系中各点相对位置如图11所示,各点间实际距离计算公式如(1.7)至(1.12)所示。
图像识别后水平方向上的实际距离误差:
图像识别后竖直方向上的实际距离误差:
磁导引AGV12在X轴方向上移动量L1为:
操作平台升降总成14在Z轴方向上移动量H1为:
第四步:已知操作平台横移总成15沿Y轴移动了距离y,按钮机械手161沿V1轴移动了距离v1,操作平台升降总成14向上提升了高度h,此时按钮机械手161中心Q1坐标为(xQ10,yQ10+y+v1,zQ10+h),远景相机112中心坐P1标(xP10,yP10,zP10+h),按钮机械手161中心Q1和远景相机112中心P1在空间坐标系下沿着X轴和Z轴方向上的实际距离差值xP10-xQ10和zP10-zQ10。
1)按钮机械手161中心Q1和按钮中心G0在沿着X轴方向上的移动量为X1,计算公式如(1.13),这两者在XY平面坐标系中的位置关系如图12所示。
X1=L1+xP10-xQ10\*MERGEFORMAT(1.13)
2)按钮机械手161中心Q1和按钮中心G0在沿着Z轴方向上的移动量为Z1,计算公式如(1.14)所示,这两者在YZ平面坐标系中的位置关系如图13所示。
Z1=H1+zP10-zQ10\*MERGEFORMAT(1.14)
操作机器人1控制磁导引AGV12和操作平台升降总成14分别在X轴和Z轴的方向上移动数值为X1和Z1,使得按钮机械手161在XZ平面坐标系下完成粗定位。
(5)按钮机械手161完成粗定位后,操作平台横移总成15向前移动直到移动激光位移传感器172测得与配电柜间距离为d3时停下,根据操作任务的不同改变d3的距离,操作平台横移总成15向前移动的目的是缩短近景相机111和配电柜之间的距离,使得近景相机111拍摄待操作按钮的图片分辨率更高,从而进行图像处理时得到的按钮中心坐标精度更高,达到按钮机械手161精定位的目的。
(6)按钮机械手161进行精定位:精定位处理过程和粗定位处理过程相同,这里就不重复叙述了。精定位时近景相机111中心P2距离配电柜表面距离为d4,图像处理后会得出按钮中心G0和近景相机111中心P2在空间坐标系下沿X轴和Z轴方向上的移动差值L2和H2,再通过坐标转换得到按钮中心G0和按钮机械手161中心Q1在X轴和Z轴方向上的移动量X2和Z2。
1)按钮机械手161中心Q1和按钮中心G0沿着X轴方向上的移动量为X2,计算公式如(1.15),这两者在XY平面坐标系中的位置关系如图14所示。
X2=L2+xP20-xQ10\*MERGEFORMAT(1.15)
2)按钮机械手161中心Q1和按钮中心G0在沿着Z轴方向上的移动量为Z2,计算公式如(1.16)所示,这两者在YZ平面坐标系中的位置关系如图15所示。
Z2=H2+zP20-zQ10\*MERGEFORMAT(1.16)
操作机器人1再次控制磁导引AGV12和操作平台升降总成14分别在X轴和Z轴的方向上移动数值为X2和Z2,使得按钮机械手161在XZ平面坐标系下完成精定位。
(7)按钮机械手161完成精定位后,按钮机械手161沿着V1轴向前移动距离d5使其接触按钮表面,Q1和Q1'分别代表按钮机械手161中心的初始位置和当前位置,已知按钮机械手161在初始位置沿V1轴移动了距离v1,可得当前位置的按钮机械手161中心Q1'和移动激光位移传感器172中心S2沿Y轴方向上距离差为yQ10+v1-yS20,移动激光位移传感器172中心S2与配电柜表面距离为d3,按钮头部的厚度为t,d5计算公式如(1.17)所示,此时按钮机械手161中心Q1'和按钮中心G0在XY平面坐标系下位置关系如图16所示。
d5=d3-(yQ10+v1-yS20)-t
\*MERGEFORMAT(1.17)
在进行按压按钮操作之前,近景相机111需要再次拍摄按钮图片并发送给信息中心进行确认,信息中心判断按钮机械手161定位到的这个按钮是不是正确的,如果确定是需要操作的按钮,按钮机械手161将向前移动距离d6进行按压按钮操作,移动的距离d6为按钮导通的行程,经测量导通行程为3mm,过行程为2mm。如果不是正确的将返回远景相机112拍照流程进行再一次的粗定位和精定位。
(8)操作机器人1所有的伺服电机完成回原点操作,结束按压按钮操作任务并为下一次自动操作做准备。
由上可知,本发明实施例的巡检机器人可通过周期性的巡检,记录电气开关的信息和状态,检查设备是否出现运行异常,将巡检信息发送到后台管理系统并按照要求操作指定的电气开关,能够代替人工完成电气控制室室内巡检作业,提高了巡检质量、效率,降低了工人的劳动强度和企业的人力成本,实现变电所电气控制室的“无人化”值守作业。
以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (8)
1.一种铁路牵引变电所操作机器人控制系统,包括有操作机器人(1),其特征在于:
所述操作机器人(1)包括磁导引AGV(12)和安装在磁导引AGV(12)上的控制柜(13),所述控制柜(13)上设置工业相机总成(11)、操作平台升降总成(14)、操作平台横移总成(15)、机械手总成(16)、传感器总成(17);
所述控制柜(13)内还设置工业平板电脑(132)和可编程逻辑控制器(134);
所述操作平台升降总成(14)、操作平台横移总成(15)、机械手总成(16)的驱动机构分别与可编程逻辑控制器(134)连接;传感器总成(17)与可编程逻辑控制器(134)直接连接;
所述磁导引AGV(12)、工业相机总成(11)、可编程逻辑控制器(134)均与工业平板电脑(132)连接;
其中,传感器总成(17)用于测量控制柜(13)与配电柜之间距离,测量磁导引AGV(12)与配电柜之间的夹角,测量操作平台横移总成(15)与配电柜之间距离,并发送给工业平板电脑(132),从而控制操作机械手向前移动固定距离完成操作;
工业相机总成(11)用于拍摄配电柜上待操作设备的位置图片并发送给工业平板电脑(132),工业平板电脑(132)对所述图片进行图像处理和分析,计算出操作机械手与待操作设备间的距离差值,从而控制操作机械手定位到待操作设备处;
所述铁路牵引变电所操作机器人控制系统的控制方法,包括以下步骤:
磁导引AGV(12)启动,到达地标卡标记位置;
通过传感器总成(17)测量磁导引AGV(12)与配电柜之间的夹角,判断磁导引AGV(12)是否平行于待操作控制柜,如果不平行则调整磁导引AGV(12)角度使其与控制柜平行;
通过工业相机总成(11)拍摄配电柜上待操作设备的位置图片并发送给工业平板电脑(132),工业平板电脑(132)对所述图片进行图像处理和分析,计算出操作机械手与待操作设备间的距离差值,从而控制操作机械手定位到待操作设备处,按压按钮操作;
其中,所述通过传感器总成(17)测量磁导引AGV(12)与配电柜之间的夹角的具体步骤如下:
(一)、基于操作机器人(1)建立空间坐标系,在空间坐标系下对机械手总成(16)、传感器总成(17)、工业相机总成(11)的初始位置坐标进行确定;
空间坐标系的X轴、Y轴、Z轴定义如下:
Z轴:过磁导引AGV(12)中心点并垂直于其顶部,Z轴起始点为Z轴和磁导引AGV(12)顶部的交点,规定向上为Z轴正方向;
Y轴:过Z轴起始点并垂直于Z轴,平行于操作平台横移总成(15)水平移动方向,规定向左为Y轴正方向;
原点:Y轴和Z轴的交点为原点;
X轴:根据右手定则,X轴过原点并平行于磁导引AGV(12),磁导引AGV(12)前进方向为X轴正方向;
(二)、为按钮机械手、空开机械手、旋钮机械手分别建立直线坐标系,分别用V1轴、V2轴、V3轴表示,这三个轴都平行于Y轴;
固定激光位移传感器(171)位置固定不动,此时中心坐标S1为(xS10,yS10,zS10),测得的距离为a1;
移动激光位移传感器(172)随着操作平台横移总成(15)沿Y轴移动距离y,此时中心S2坐标为(xS20,yS20+y,zS20),测得的距离为a2;
假设磁导引AGV(12)与配电柜之间有夹角θ,S1代表固定激光位移传感器(171)初始位置,S2和S2′分别代表移动激光位移传感器(172)初始位置和当前位置,则夹角θ的计算公式如(1.1)和(1.2);
式中:
E=a1-[a2+y-(yS10-yS20)]
F=xS10-xS20
计算出夹角θ后,工业平板电脑(132)将夹角θ数据发送给磁导引AGV(12),磁导引AGV(12)旋转θ使得磁导引AGV(12)和配电柜相互平行。
2.根据权利要求1所述的铁路牵引变电所操作机器人控制系统,其特征在于:还包括信息中心(2),信息中心(2)包括有工业控制计算机(22)、分别与工业控制计算机(22)连接的中心显示屏(23)和中心无线路由器(21);所述中心无线路由器(21)通过操作无线路由器(133)与工业平板电脑(132)通信连接。
3.根据权利要求2所述的铁路牵引变电所操作机器人控制系统,其特征在于:所述工业相机总成(11)包括有近景相机(111)和远景相机(112);
所述近景相机(111)安装在操作平台横移总成(15)上;
所述远景相机(112)固定在操作平台升降总成(14)上;
所述近景相机(111)和远景相机(112)分别与工业平板电脑(132)通信连接。
4.根据权利要求3所述的铁路牵引变电所操作机器人控制系统,其特征在于:所述传感器总成(17)包括有固定激光位移传感器(171)和移动激光位移传感器(172);
所述固定激光位移传感器(171)安装在控制柜(13)外侧上;
所述移动激光位移传感器(172)安装在操作平台横移总成(15)上;
所述固定激光位移传感器(171)和移动激光位移传感器(172)分别与可编程逻辑控制器(134)直接连接。
5.根据权利要求1所述的一种铁路牵引变电所操作机器人控制系统,其特征在于:所述通过工业相机总成(11)拍摄配电柜上待操作设备的位置图片并发送给工业平板电脑(132),工业平板电脑(132)对所述图片进行图像处理和分析,计算出操作机械手与待操作设备间的距离差值;
包括:
工业平板电脑(132)对远景相机(112)拍摄的配电柜图片进行图像处理,得出待操作按钮中心的像素坐标和图片中心像素坐标,从而计算出待操作按钮中心G0和远景相机中心P1在空间坐标系下沿X轴和Z轴方向上的距离差值,再通过坐标转换得到待操作按钮中心G0和按钮机械手中心Q1在X轴和Z轴方向上的距离差值,然后在X轴方向上移动磁导引AGV(12)以及在Z轴方向上提升操作平台升降总成(14),达到按钮机械手在XZ平面坐标系下粗定位的目的;
按钮机械手完成粗定位后,操作平台横移总成(15)向前移动直到移动激光位移传感器(172)测得与配电柜间距离为d3时停下,根据操作任务的不同改变d3的距离,操作平台横移总成(15)向前移动缩短近景相机(111)和配电柜之间的距离,使得近景相机(111)拍摄待操作按钮的图片分辨率更高,从而进行图像处理得到的按钮中心坐标精度更高,达到按钮机械手精定位的目的。
6.根据权利要求5所述的一种铁路牵引变电所操作机器人控制系统,其特征在于:所述计算出待操作按钮中心G0和远景相机中心P1在空间坐标系下沿X轴和Z轴方向上的距离差值,再通过坐标转换得到待操作按钮中心G0和按钮机械手中心Q1在X轴和Z轴方向上的距离差值,步骤如下:
第一步:操作平台升降总成(14)提升高度h后,远景相机(112)中心P1坐标(xP10,yP10,zP10+h),固定激光位移传感器(171)测得离配电柜的距离为d1以及中心S1坐标(xS10,yS10,zS10),得出远景相机(112)离配电柜的距离为d2,d2计算公式如公式1.3所示,其中远景相机(112)中心P1和固定激光位移传感器(171)中心S1在XY平面坐标系中位置关系;
d2=d1+yS10-yP10 (0.3);
第二步:假设远景相机(112)的最高分辨率为M×N,远景相机(112)拍摄的图片实际长度L和远景相机(112)离配电柜之间的距离d2关系为L∶d2=1∶1,图片的实际高度为H与实际长度L之间的关系为L∶H=M∶N;在图像坐标系中X轴方向上单位像素代表的实际距离为Ix,Z轴方向上单位像素代表的实际距离为Iz,Ix和Iz,的计算公式如(1.4)所示;
第三步:由于远景相机在拍摄图片的时候,远景相机中心不是正对着待操作按钮中心,而且待操作按钮有一定厚度t,导致图像识别到的按钮中心与实际按钮中心有偏移误差,需要进行误差补偿;具体步骤如下:
假设平面A是待操作按钮表面,平面B是配电柜表面,平面A和平面B之间距离为按钮厚度t,点P1是远景相机中心,点P1′是P1在平面B上的垂直投影点,点P1到平面B距离为d2,G0是待操作按钮实际中心,G1是图像识别找到的待操作按钮中心,G2是G0在平面B上的垂直投影点,计算的偏移误差就是计算线段G1G2的距离,G1G2与水平方向上的夹角为α,根据相似三角形G0G1G2相似于P1G1P1′可得出G1G2的距离,则水平方向的距离误差为G1G2cosα,竖直方向上的距离误差为G1G2sinα,计算公式如(1.5)、(1.6)所示;
为了计算平面B上各点间实际距离,通过调用已写好的图像算法对远景相机拍摄的图片进行图像处理,从而得到各点像素坐标;由于空间坐标系的Z轴正方向是竖直向上的,为了使图像坐标系里Z轴和空间坐标系里Z轴正方向一致,重新构建图像坐标系使得图像坐标系里的Z轴向上以及X轴向右;
具体为图像识别找到的按钮中心G1点的像素坐标为(x1,z1),按钮实际中心G0在平面B上投影点G2的像素坐标为(x2,z2),远景相机中心P1在平面B上投影点P1′的像素坐标为(M/2,N/2),G1点和P1′点之间的像素坐标差(R,S),按钮实际中心G0和远景相机中心P1在空间坐标系下沿X轴和Z轴方向上的移动量为L1和H1,图像坐标系中各点间实际距离计算公式如(1.7)至(1.12)所示;
图像识别后水平方向上的实际距离误差:
图像识别后竖直方向上的实际距离误差:
磁导引AGV(12)在X轴方向上移动量L1为:
操作平台升降总成在Z轴方向上移动量H1为:
第四步:已知操作平台横移总成沿Y轴移动了距离y,按钮机械手沿V1轴移动了距离v1,操作平台升降总成提升了高度h,此时按钮机械手中心Q1坐标为(xQ10,yQ10+y+v1,zQ10+h),远景相机中心P1坐标(xP10,yP10,zP10+h),按钮机械手中心Q1和远景相机中心P1在空间坐标系下沿着X轴和Z轴方向上的实际距离差值xP10-xQ10和zP10-zQ10;
具体为:
1)按钮机械手中心Q1和按钮中心G0在沿着X轴方向上的移动量为X1,计算公式如(1.13);
X1=L1+xP10-xQ10 (0.13)
2)按钮机械手中心Q1和按钮中心G0在沿着Z轴方向上的移动量为Z1,计算公式如(1.14)所示;
Z1=H1+zP10-zQ10 (0.14)
则操作机器人控制磁导引AGV和操作平台升降总成分别在X轴和Z轴的方向上移动数值为X1和Z1,使得按钮机械手在XZ平面坐标系下完成粗定位。
7.根据权利要求6所述的一种铁路牵引变电所操作机器人控制系统,其特征在于:所述按钮机械手完成粗定位后,操作平台横移总成(15)向前移动直到移动激光位移传感器(172)测得与配电柜间距离为d3时停下,根据操作任务的不同改变d3的距离,操作平台横移总成(15)向前移动缩短近景相机(111)和配电柜之间的距离,使得近景相机(111)拍摄待操作按钮的图片分辨率更高,从而进行图像处理得到的按钮中心坐标精度更高,达到按钮机械手精定位的目的;
具体包括:
精定位处理过程和粗定位处理过程相同,精定位时近景相机中心P2距离配电柜表面距离为d4,图像处理后会得出按钮中心G0和近景相机P2中心在空间坐标系下沿X轴和Z轴方向上的移动差值L2和H2,再通过坐标转换得到按钮中心G0和按钮机械手中心Q1在X轴和Z轴方向上的移动量X2和Z2;
1)按钮机械手中心Q1和按钮中心G0沿着X轴方向上的移动量为X2,计算公式如(1.15);
X2=L2+xP20-xQ10 (0.15);
2)按钮机械手中心Q1和按钮中心G0在沿着Z轴方向上的移动量为Z2,计算公式如(1.16)所示,
Z2=H2+zP20-zQ10 (0.16);
操作机器人再次控制磁导引AGV和操作平台升降总成分别在X轴和Z轴的方向上移动数值为X2和Z2,使得按钮机械手在XZ平面坐标系下完成精定位。
8.根据权利要求7所述的一种铁路牵引变电所操作机器人控制系统,其特征在于:还包括,所述按钮机械手完成精定位后,按钮机械手沿着V1轴向前移动距离d5使其接触按钮表面,Q1和Q1′分别代表按钮机械手中心的初始位置和当前位置,已知按钮机械手在初始位置沿V1轴移动了距离v1,得当前位置的按钮机械手中心Q1′和移动激光位移传感器中心S2沿Y轴方向上距离差为yQ10+v1-yS20,移动激光位移传感器中心S2与配电柜表面距离为d3,按钮头部的厚度为t,d5计算公式如(1.17)所示,
d5=d3-(yQ10+v1-ys20)-t (0.17);
在进行按压按钮操作之前,近景相机(111)需要再次拍摄按钮图片并发送给工业平板电脑(132)进行确认,工业平板电脑(132)判断按钮机械手定位到的这个按钮是不是正确的,如果确定是需要操作的按钮,按钮机械手将向前移动距离d6进行按压按钮操作,移动的距离d6为按钮导通的行程,如果不是正确的将返回远景相机(112)拍照流程进行再一次的粗定位和精定位;操作机器人(1)所有的伺服电机完成退回原点操作,结束按压按钮操作任务并为下一次自动操作做准备。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910441674.8A CN110154026B (zh) | 2019-05-24 | 2019-05-24 | 铁路牵引变电所操作机器人控制系统及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910441674.8A CN110154026B (zh) | 2019-05-24 | 2019-05-24 | 铁路牵引变电所操作机器人控制系统及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110154026A CN110154026A (zh) | 2019-08-23 |
CN110154026B true CN110154026B (zh) | 2020-12-04 |
Family
ID=67632903
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910441674.8A Active CN110154026B (zh) | 2019-05-24 | 2019-05-24 | 铁路牵引变电所操作机器人控制系统及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110154026B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110501928B (zh) * | 2019-08-26 | 2020-09-04 | 西南交通大学 | 一种铁路智能监控系统 |
CN111208417B (zh) * | 2020-01-02 | 2022-11-11 | 北京百度网讯科技有限公司 | 测试方法、装置、设备和介质 |
CN113635808A (zh) * | 2020-04-27 | 2021-11-12 | 沈阳新松机器人自动化股份有限公司 | Agv电池自动充换系统 |
CN111917978B (zh) * | 2020-07-21 | 2022-03-08 | 北京全路通信信号研究设计院集团有限公司 | 工业相机的调节装置和方法及拍摄装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9463574B2 (en) * | 2012-03-01 | 2016-10-11 | Irobot Corporation | Mobile inspection robot |
CN107092251B (zh) * | 2016-12-22 | 2019-11-15 | 合肥工业大学 | 基于图像识别的铁路无人巡检车的自动定位系统及方法 |
CN208015455U (zh) * | 2018-03-02 | 2018-10-26 | 三峡大学 | 一种变电站无人值守的倒闸操作机器人 |
CN109119923B (zh) * | 2018-08-03 | 2020-11-24 | 合肥工业大学 | 变配电所设备智能巡检系统及其巡检方法 |
CN109411268A (zh) * | 2018-12-11 | 2019-03-01 | 四川艾德瑞电气有限公司 | 一种铁路牵引变电所控制柜按钮视觉定位方法 |
-
2019
- 2019-05-24 CN CN201910441674.8A patent/CN110154026B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110154026A (zh) | 2019-08-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110154026B (zh) | 铁路牵引变电所操作机器人控制系统及控制方法 | |
CN102922521B (zh) | 一种基于立体视觉伺服的机械臂系统及其实时校准方法 | |
CN110202582A (zh) | 一种基于三坐标平台的机器人标定方法 | |
CN110605718A (zh) | 一种变电站巡检机器人系统及巡检方法 | |
EP3407088A1 (en) | Systems and methods for tracking location of movable target object | |
CN109738213A (zh) | 轨道交通机车车辆巡检位姿检测系统及其方法 | |
CN110233440B (zh) | 变配电设备巡检装置 | |
CN110007643A (zh) | 一种用于道岔制造过程自动化在线检测设备及方法 | |
CN112059363A (zh) | 一种基于视觉测量的无人爬壁焊接机器人及其焊接方法 | |
CN109387194B (zh) | 一种移动机器人定位方法和定位系统 | |
CN113510708B (zh) | 一种基于双目视觉的接触式工业机器人自动标定系统 | |
CN111238375A (zh) | 基于激光跟踪仪的移动检测机器人大型构件外形重构方法 | |
CN105928946B (zh) | 检测设备的补偿方法 | |
CN109141402B (zh) | 一种基于激光栅格的定位方法以及机器人自主充电方法 | |
CN109398328A (zh) | 车辆电池换电定位方法和装置、充换电站、控制器及介质 | |
WO2022001760A1 (zh) | 一种基于5g技术的远程可监控多轴协同智能控制器 | |
CN107328358B (zh) | 铝电解槽位姿的测量系统及测量方法 | |
CN115042175A (zh) | 一种机器人机械臂末端姿态的调整方法 | |
CN114434036B (zh) | 用于大型船舶结构件龙门式机器人焊接的三维视觉系统及运行方法 | |
CN111208828B (zh) | 一种新型agv二维码导航系统及其应用 | |
CN111208827B (zh) | 一种投射式agv二维码导航系统及其应用 | |
CN115717868B (zh) | 一种实时在线的三维自动化扫描测量系统 | |
CN115256398A (zh) | 一种变电站室内多功能操作机器人 | |
CN106546209B (zh) | 一种测量x射线机拍摄角度的装置及其方法 | |
Tamara et al. | Fork Agv: estimation of combined magnetic sensor with vision guide applied on automatic mobile transporter for navigation and accurate positioning |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |