CN109773779B - 一种自动对位换油机器人的建模与控制方法 - Google Patents
一种自动对位换油机器人的建模与控制方法 Download PDFInfo
- Publication number
- CN109773779B CN109773779B CN201811499744.7A CN201811499744A CN109773779B CN 109773779 B CN109773779 B CN 109773779B CN 201811499744 A CN201811499744 A CN 201811499744A CN 109773779 B CN109773779 B CN 109773779B
- Authority
- CN
- China
- Prior art keywords
- oil
- coordinate system
- horizontal translation
- axis
- robot
- 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
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明涉及了一种自动对位换油机器人的建模与控制方法,该控制方法能够获取机器人在各个姿态下的注油口坐标值,实现了整个装卸油动作的高精度、全自动的操作。该方法的主要步骤如下:【1】自动对位换油机器人建模;【2】调试阶段;【3】自动运行阶段。
Description
技术领域
本发明涉及一种自动对位换油机器人的建模与控制方法。
背景技术
目前我国铁路石油运输行业的装卸油工作主要是通过人工作业的方式实现的,野外作业面临严寒、曝晒等恶劣环境条件,此外高空作业还有一定的危险。
现有技术采用了一种鹤管装卸油设备,通过人工操作鹤管装卸油设备实现装卸油工作,但是该方式存在的问题是:人工操作实现一系列的动作会浪费大量的人力,同时控制精度也无法达到要求。
基于此,目前又提供了一种自动对位换油机器人安装在栈桥上,如图1所示,该机器人主要包括横行桁架1、水平平移轴2、转动轴3、装卸油鹤管组件以及密封帽4;
其中,水平平移轴2安装在横行桁架1上并可在横行桁架1上水平移动,转动轴3安装在水平平移轴2上,转动轴3上安装卸油鹤管组件可带动卸油鹤管组件做旋转运动,卸油鹤管组件包括鹤管内臂5和鹤管外臂6;鹤管外臂6的末端为注油口7,注油口7位置设置有密封帽4;需要说明的是:无论鹤管内臂如何旋转时,鹤管外臂始终处于垂直状态。密封帽的结构实现了在装卸油过程中罐口的密封。
采用人工对该机器人进行操作,同样会存在人力浪费以及控制精度不佳的问题。
发明内容
为了解决背景技术中的问题,本发明提供了一种对自动对位换油机器人的控制方法,该控制方法能自动获取罐口位置,实现了整个装卸油动作的高精度、全自动的操作。
为了实现发明目的,本发明的具体技术方案是:
本发明提供了一种自动对位换油机器人的建模与控制方法,包括以下步骤:
【1】自动对位换油机器人建模;
【1.1】定义坐标系;
L1为鹤管内臂长度,L2为鹤管外臂长度,θ为鹤管内臂转动的角度;
【1.3】计算出水平平移轴移动的距离和转动轴转动的角度:
【2】调试阶段
【2.1】记录待机位置信息
自定义待机位置,操作转动轴使其处于垂直状态,操作水平平移轴使其运动到待机位置,根据当前水平移动的距离S0和当前鹤管内臂转动角度θ0,θ0=90°,应用步骤【1.2】中的公式,计算机器人移动到待机位置时,注油口位置的坐标(X0,Y0,Z0,A0,B0,C0),并记录;
【2.2】记录扫描起点位置信息
操作水平平移轴使其运动到扫描起点位置,转动轴仍保持垂直状态,根据当前水平移动的距离Ss和当前鹤管内臂转动角度θ0,θ0=90°,应用【1.2】中的公式,计算机器人移动到扫描起点位置时,注油口位置的坐标(Xs,Ys,Zs,As,Bs,Cs),并记录;
【2.3】记录扫描终点位置信息
操作水平平移轴使其运动到扫描终点位置,转动轴仍保持垂直状态,根据当前水平移动的距离Se和当前鹤管内臂转动角度θ0,θ0=90°,应用【1.2】中的公式,计算机器人移动到扫描终点位置时,注油口位置的坐标(Xe,Ye,Ze,Ae,Be,Ce),并记录;
【2.4】记录垂直下降高度信息
设定从罐口到装卸油位置的垂直下降高度H,并记录;
【3】自动运行阶段
【3.1】读取已存储的待机位置信息(X0,Y0,Z0,A0,B0,C0),机器人运动到待机位;
机器人从开机初始位置到待机位置的运动过程中需要应用【1.3】中的公式,实时计算每一时刻的S和θ,用于控制水平平移轴和转动轴运动;
【3.2】读取已存储的扫描起点位置信息(Xs,Ys,Zs,As,Bs,Cs),机器人运动到扫描起点;
机器人从待机位置到扫描起点位置的运动过程中,转动轴一直保持垂直状态θ=90°,水平平移轴从S0运动到Ss;
【3.3】扫描罐口位置;
【3.3.1】运动到扫描起点后,启动激光测距仪,读取激光测距仪的输出信号,此时应为高电平;
【3.3.2】从扫描起点沿水平方向移动,当检测到激光测距仪的输出信号从高电平变为低电平时,则罐口区域被检测到,停止移动,并记录此时的水平平移轴位置Sa;
【3.3.3】继续沿水平方向运动,当检测到激光测距仪的输出信号从低电平变为高电平时,则激光测距仪已经移出罐口区域,停止移动,并记录此时的水平平移轴位置Sb;
【3.3.5】根据Sh和θ=90°,应用【1.2】中的公式,计算此时注油口位置的坐标:(Xh,Yh,Zh,Ah,Bh,Ch);
【3.4】机器人运动到罐口位置,转动轴一直保持垂直状态θ=90°,水平平移轴从Sb运动到Sh;
【3.5】根据调试阶段设定的从罐口到装卸油位置的垂直下降高度H,计算得到装卸油位置注油口位置的坐标(Xl,Yl,Zl,Al,Bl,Cl);
【3.6】机器人运动到装卸油位置;
机器人从罐口位置到装卸油位置的运动过程中需要应用【1.3】中的公式,实时计算每一时刻的S和θ,用于控制水平平移轴和转动轴运动,当转动轴向下转动时,水平平移轴同时向后移动,保证鹤管注油口垂直下降;
【3.7】启动装卸油的阀门,进行装卸油;
【3.8】装卸油任务完成后,机器人恢复至待机位置。
进一步地,为了实现密封帽组件始终与罐口紧密贴合,从而保证装卸油过程的密封性,所述自动对位换油机器人还包括感应片以及接近开关;所述感应片安装在密封帽上,所述接近开关安装在所述鹤管外臂的下部;
执行步骤【3.7】时:
当密封帽上的密封气垫和罐口之间紧密贴合时,罐口的反作用力会使感应片上移靠近接近开关,接近开关感应到感应片后输出低电平信号;
当密封气垫和罐口之间有间隙时,感应片远离接近开关,接近开关会输出高电平信号;
检测接近开关的输出信号,当低电平信号则密封气垫和罐口贴合紧密,水平平移轴和转动轴不动作,当检测为高电平信号时,则控制水平平移轴和转动轴运动,使注油口垂直下降,直到接近开关的输出信号变为低电平。
本发明的有益效果是:
1、本发明采用了对机器人进行建模的方法,从而能够获取机器人在各个姿态下的注油口坐标值,实现对机器人整个卸油过程的自动控制。
2、本发明的方法采用接近开关和密封帽的配合实现了罐口位置的自动补偿,使旋转轴和水平移动轴能随着罐口的下沉,实时运动,实现密封气垫和罐口的密封。
附图说明
图1为现有自动对位换油机器人的结构简图;
图2为增加了激光测距仪和接近开关的自动对位换油机器人的结构简图;
图3为激光测距仪的安装位置图;
图4为自动对位换油机器人的坐标模型图。
图5为接近开关未感应到感应片时的状态图。
图6为接近开关感应到感应片时的状态图。
附图标记如下:
1-横行桁架、2-水平平移轴、3-转动轴、4-密封帽、5-鹤管内臂、6-鹤管外臂、7-注油口、8-激光测距仪、9-感应片、10-接近开关。
具体实施方式
下面结合附图对本发明的作进一步的详述:
一种自动对位换油机器人的建模与控制方法,具体步骤如下:
实现该方法之初,需要在自动对位换油机器人上安装一个激光测距仪8、一个接近开关10以及感应片9;
如图2和图3所示,激光测距仪8安装在水平平移轴2上,当鹤管内臂5处于垂直状态时,激光测距仪8的中心点位置正处于注油口7中心位置的正下方;如图5和图6所示,接近开关10安装在鹤管外臂6的下方,感应片9安装在密封帽的密封气垫上;
步骤【1】自动对位换油机器人建模;
如图4所示,
步骤【1.1】定义坐标系;
L1为鹤管内臂长度,L2为鹤管外臂长度,θ为鹤管内臂转动的角度;
步骤【1.3】计算出水平平移轴移动的距离和转动轴转动的角度:
步骤【2】调试阶段
在现场安装该机器人后,需要首先进行手动调试,确定并记录后续自动运行时需要的一些关键点信息,包括待机位置信息、扫描起点位置信息、扫描终点位置和垂直下降高度信息。
其中待机位置是机器人每次执行任务前等待的位置,扫描起点位置和扫描终点位置决定了机器人每次扫描罐口位置的扫描范围。
【2.1】记录待机位置信息
调试人员使用示教器,手动操作转动轴使其处于垂直状态,手动操作水平平移轴使其运动到待机位置,根据当前水平移动的距离S0和当前鹤管内臂转动角度θ0(θ0=90°),应用【1.2】中的公式,计算机器人移动到待机位置时,注油口位置的坐标(X0,Y0,Z0,A0,B0,C0),并记录保存到机器人控制器中。
【2.2】记录扫描起点位置信息
调试人员使用示教器,手动操作水平平移轴使其运动到扫描起点位置,转动轴仍保持垂直状态,根据当前水平移动的距离Ss和当前鹤管内臂转动角度θ0(θ0=90°),应用【1.2】中的公式,计算机器人移动到扫描起点位置时,注油口位置的坐标:(Xs,Ys,Zs,As,Bs,Cs),并记录保存到机器人控制器中。
【2.3】记录扫描终点位置信息
调试人员使用示教器,手动操作水平平移轴使其运动到扫描终点位置,转动轴仍保持垂直状态,根据当前水平移动的距离Se和当前鹤管内臂转动角度θ0(θ0=90°),应用【1.2】中的公式,计算机器人移动到扫描起点位置时,注油口位置的坐标:(Xe,Ye,Ze,Ae,Be,Ce),并记录保存到机器人控制器中。
【2.4】记录垂直下降高度信息
调试人员使用示教器,设定从罐口到装卸油位置的垂直下降高度H,并记录保存到机器人控制器中。
【3】自动运行阶段
手动调试完成后,开始执行自动运行;具体是:
【3.1】读取已存储的待机位置信息(X0,Y0,Z0,A0,B0,C0),机器人运动到待机位。
机器人从开机初始位置到待机位置的运动过程中需要应用【1.3】中的公式,实时计算每一时刻的S和θ,用于控制水平平移轴和转动轴运动。
【3.2】读取已存储的扫描起点位置信息(Xs,Ys,Zs,As,Bs,Cs),机器人运动到扫描起点;
机器人从待机位置到扫描起点位置的运动过程中,转动轴一直保持垂直状态(θ=90°),水平平移轴从S0运动到Ss;
【3.3】扫描罐口位置
具体步骤是:
【3.3.1】运动到扫描起点后,启动激光测距仪,读取激光测距仪的输出信号,此时应为高电平;
【3.3.2】从扫描起点沿水平方向移动,当检测到激光测距仪的输出信号从高电平变为低电平时,则罐口区域被检测到,停止移动,并记录此时的水平平移轴位置Sa;
【3.3.3】继续沿水平方向运动,当检测到激光测距仪的输出信号从低电平变为高电平时,则激光测距仪已经移出罐口区域,停止移动,并记录此时的水平平移轴位置Sb;
【3.4.5】根据Sh和θ=90°,应用【1.2】中的公式,计算此时注油口位置的坐标:(Xh,Yh,Zh,Ah,Bh,Ch);
【3.4】机器人运动到罐口位置;
这一过程中,机器人转动轴一直保持垂直状态(θ=90°),水平平移轴从Sb运动到Sh;
【3.5】根据调试阶段设定的从罐口到装卸油位置的垂直下降高度H,计算得到装卸油位置注油口位置的坐标:(Xl,Yl,Zl,Al,Bl,Cl);
【3.6】机器人运动到装卸油位置;
机器人从罐口位置到装卸油位置的运动过程中需要应用【1.3】中的公式,实时计算每一时刻的S和θ,用于控制水平平移轴和转动轴运动,当转动轴向下转动时,水平平移轴同时向后移动,保证鹤管注油口垂直下降;
【3.7】操作工人启动装卸油的阀门,进行装卸油;
密封气垫自动补偿功能:为防止可燃和有害液体挥发泄露到空气中,在灌装过程中灌口应达到密封功能。然而在灌油过程中,随着罐体内油量逐渐的增多,油罐罐体会跟着下沉,密封帽的密封气垫和灌口产生间隙。避免挥发气体从间隙泄露,需增加密封气垫的下沉自动补偿功能。
如图6所示,当密封帽的密封气垫和罐口之间紧密贴合时,罐口的反作用力会使感应片上移靠近接近开关,接近开关感应到感应片后输出低电平信号;如图5所示,当密封气垫和罐口之间有间隙时,感应片远离近接传感器,近接传感器会输出高电平信号。
检测接近开关的输出信号,当低电平信号则密封气垫和罐口贴合紧密,水平平移轴和转动轴不动作,当检测为高电平信号时,则控制水平平移轴和转动轴运动,使注油口垂直下降,直到接近开关的输出信号变为低电平。
【3.8】装卸油任务完成后,机器人运动到罐口位置;
机器人从装卸油位置到罐口位置的运动过程中需要应用【1.3】中的公式,实时计算每一时刻的S和θ,用于控制水平平移轴和转动轴运动,当转动轴向上转动时,水平平移轴同时向前移动,保证鹤管注油口垂直上升。
【3.9】机器人从罐口位置运动回到待机位;这一过程中,机器人转动轴一直保持垂直状态(θ=90°),水平平移轴从Sh运动到S0。
Claims (2)
1.一种自动对位换油机器人的建模与控制方法,所述自动对位换油机器人包括横行桁架、水平平移轴、转动轴、装卸油鹤管组件以及密封帽;
其中,水平平移轴安装在横行桁架上并可在横行桁架上水平移动,转动轴安装在水平平移轴上,转动轴上安装卸油鹤管组件,转动轴可带动卸油鹤管组件做旋转运动,卸油鹤管组件包括鹤管内臂和鹤管外臂;鹤管外臂的末端为卸油鹤管注油口,卸油鹤管注油口位置设置有密封帽;
建模与控制方法的具体步骤如下:
【1】自动对位换油机器人建模
【1.1】定义坐标系;
L1为鹤管内臂长度,L2为鹤管外臂长度,θ为鹤管内臂转动的角度;
【1.3】计算出水平平移轴移动的距离和转动轴转动的角度:
【2】调试阶段
【2.1】记录待机位置信息
自定义待机位置,操作转动轴使其处于垂直状态,操作水平平移轴使其运动到待机位置,根据当前水平移动的距离S0和当前鹤管内臂转动角度θ0,θ0=90°,应用步骤【1.2】中的公式,计算机器人移动到待机位置时,注油口位置的坐标(X0,Y0,Z0,A0,B0,C0),并记录;
【2.2】记录扫描起点位置信息
操作水平平移轴使其运动到扫描起点位置,转动轴仍保持垂直状态,根据当前水平移动的距离Ss和当前鹤管内臂转动角度θ0,θ0=90°,应用【1.2】中的公式,计算机器人移动到扫描起点位置时,注油口位置的坐标(Xs,Ys,Zs,As,Bs,Cs),并记录;
【2.3】记录扫描终点位置信息
操作水平平移轴使其运动到扫描终点位置,转动轴仍保持垂直状态,根据当前水平移动的距离Se和当前鹤管内臂转动角度θ0,θ0=90°,应用【1.2】中的公式,计算机器人移动到扫描终点位置时,注油口位置的坐标(Xe,Ye,Ze,Ae,Be,Ce),并记录;
【2.4】记录垂直下降高度信息
设定从罐口到装卸油位置的垂直下降高度H,并记录;
【3】自动运行阶段
【3.1】读取已存储的待机位置信息(X0,Y0,Z0,A0,B0,C0),机器人运动到待机位;
机器人从开机初始位置到待机位置的运动过程中需要应用【1.3】中的公式,实时计算每一时刻的S和θ,用于控制水平平移轴和转动轴运动;
【3.2】读取已存储的扫描起点位置信息(Xs,Ys,Zs,As,Bs,Cs),机器人运动到扫描起点;
机器人从待机位置到扫描起点位置的运动过程中,转动轴一直保持垂直状态θ=90°,水平平移轴从S0运动到Ss;
【3.3】扫描罐口位置;
【3.3.1】运动到扫描起点后,启动激光测距仪,读取激光测距仪的输出信号,此时应为高电平;
【3.3.2】从扫描起点沿水平方向移动,当检测到激光测距仪的输出信号从高电平变为低电平时,则罐口区域被检测到,停止移动,并记录此时的水平平移轴位置Sa;
【3.3.3】继续沿水平方向运动,当检测到激光测距仪的输出信号从低电平变为高电平时,则激光测距仪已经移出罐口区域,停止移动,并记录此时的水平平移轴位置Sb;
【3.3.5】根据Sh和θ=90°,应用【1.2】中的公式,计算此时注油口位置的坐标:(Xh,Yh,Zh,Ah,Bh,Ch);
【3.4】机器人运动到罐口位置,转动轴一直保持垂直状态θ=90°,水平平移轴从Sb运动到Sh;
【3.5】根据调试阶段设定的从罐口到装卸油位置的垂直下降高度H,计算得到装卸油位置注油口的坐标(Xl,Yl,Zl,Al,Bl,Cl);
【3.6】机器人运动到装卸油位置;
机器人从罐口位置到装卸油位置的运动过程中需要应用【1.3】中的公式,实时计算每一时刻的S和θ,用于控制水平平移轴和转动轴运动,当转动轴向下转动时,水平平移轴同时向后移动,保证鹤管注油口垂直下降;
【3.7】启动装卸油的阀门,进行装卸油;
【3.8】装卸油任务完成后,机器人恢复至待机位置。
2.根据权利要求1所述的自动对位换油机器人的建模与控制方法,其特征在于:
所述自动对位换油机器人还包括感应片以及接近开关;所述感应片安装在密封帽上,所述接近开关安装在所述鹤管外臂的下部;
执行步骤【3.7】时:
当密封帽上的密封气垫和罐口之间紧密贴合时,罐口的反作用力会使感应片上移靠近接近开关,接近开关感应到感应片后输出低电平信号;
当密封气垫和罐口之间有间隙时,感应片远离接近开关,接近开关会输出高电平信号;
检测接近开关的输出信号,当低电平信号则密封气垫和罐口贴合紧密,水平平移轴和转动轴不动作,当检测为高电平信号时,则控制水平平移轴和转动轴运动,使注油口垂直下降,直到接近开关的输出信号变为低电平。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811499744.7A CN109773779B (zh) | 2018-12-09 | 2018-12-09 | 一种自动对位换油机器人的建模与控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811499744.7A CN109773779B (zh) | 2018-12-09 | 2018-12-09 | 一种自动对位换油机器人的建模与控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109773779A CN109773779A (zh) | 2019-05-21 |
CN109773779B true CN109773779B (zh) | 2020-12-08 |
Family
ID=66496825
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811499744.7A Active CN109773779B (zh) | 2018-12-09 | 2018-12-09 | 一种自动对位换油机器人的建模与控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109773779B (zh) |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2927322B1 (fr) * | 2008-02-08 | 2010-03-05 | Fmc Technologies Sa | Dispositif de commande directe, notamment proportionnelle et/ou de chargement et/ou dechargement de fluides |
FR3003855B1 (fr) * | 2013-03-29 | 2016-01-29 | Fmc Technologies Sa | Bras de transfert d'un produit fluide de navire a navire |
CN104445034B (zh) * | 2013-12-15 | 2017-02-15 | 新疆中拓新能源技术股份有限公司 | 流体罐装鹤管自动对位装置 |
CN104891412A (zh) * | 2015-04-16 | 2015-09-09 | 新疆中拓新能源技术股份有限公司 | 一种带自对位功能的多关节鹤管系统 |
CN106006529A (zh) * | 2016-07-19 | 2016-10-12 | 连云港锦缘石化设备制造有限公司 | 全自动液压鹤管 |
CN206476740U (zh) * | 2017-02-23 | 2017-09-08 | 克拉玛依市独山子先达技术有限责任公司 | 一种悬臂式鹤管 |
CN106966353B (zh) * | 2017-04-24 | 2019-05-14 | 北京牧晨机电有限公司 | 全自动流体装车鹤管及其应用 |
CN108793046A (zh) * | 2018-06-12 | 2018-11-13 | 新疆中拓新能源技术股份有限公司 | 悬臂升降式自动对位装车鹤管 |
CN108840304A (zh) * | 2018-07-11 | 2018-11-20 | 天津市正方科技发展有限公司 | 汽车自动装车系统 |
-
2018
- 2018-12-09 CN CN201811499744.7A patent/CN109773779B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109773779A (zh) | 2019-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106013149B (zh) | 基于gps技术的全自动静力压桩机定位控制系统 | |
CN102345390A (zh) | 一种混凝土泵车臂架变形量的补偿方法 | |
CN204495337U (zh) | 一种用于激光成形的自动调平装置 | |
CN104833324A (zh) | 一种基于测量头的机器人标定方法 | |
WO2020173111A1 (zh) | 一种 3d 微涂覆机器人及其涂覆方法 | |
CN109773779B (zh) | 一种自动对位换油机器人的建模与控制方法 | |
CN109227551A (zh) | 一种视觉定位机器人手眼坐标转换方法 | |
CN108748096B (zh) | 一种绘图机械臂及其控制系统 | |
CN204234993U (zh) | 随焊超声冲击机器人智能测控系统 | |
CN102183963B (zh) | 一种高空作业平台的工作轨迹控制方法 | |
CN108840304A (zh) | 汽车自动装车系统 | |
CN110883770A (zh) | 一种基于位置和图像的机器人混合视觉伺服控制方法 | |
CN108890640A (zh) | 一种基于同步定位与地图构建技术的机器人设备校准方法 | |
CN116214542B (zh) | 一种球罐内壁爬壁机器人数字孪生系统 | |
CN100578675C (zh) | 一种三自由度高精密定位运动台装置的定位方法 | |
CN112720451B (zh) | 自动作业机器人及其按规划路径自动作业的控制方法 | |
CN110181538B (zh) | 高铁车体定位系统及测量方法 | |
CN205380431U (zh) | 一种数控转盘式减震器焊接机 | |
CN114777649A (zh) | 一种飞机整体油箱螺栓封包尺寸检测系统 | |
CN208603703U (zh) | 汽车自动装车系统 | |
CN111702304B (zh) | 埋弧焊用导电嘴自动定位的控制系统及其方法 | |
CN113845064B (zh) | 一种具有圆形支脚的物料承载装置的定位方法及系统 | |
CN108508894A (zh) | 一种基于二维激光的机器人定位方法 | |
CN212704344U (zh) | 固定安装相机的自动机械手引导装置 | |
CN109368586B (zh) | 一种悬臂式火车全自动鹤管自动对准罐口的方法及悬臂式火车全自动鹤管 |
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 |