[发明专利]一种关节吊机自动抓放钻杆系统及方法

说明书

技术领域

本发明涉及一种关节吊机自动抓放钻杆系统及方法。

背景技术

关节吊机是海洋钻井平台，海洋钻井船，半潜式钻井平台常用的钻杆移运装备；目前关节吊机常用的钻杆移运方法有经验法和辅助定位法。

经验法是关节吊机操作者依赖自身的操作能力，根据长时间的操作经验实现钻杆堆藏区钻杆的抓取和方式，钻杆猫道的抓取和放置，该方法可以自由灵活选择某根钻杆进行抓取，某个区域进行钻杆放置区域进行放置；但是抓取钻杆和放置钻杆耗时长，且容易因钻杆对准错误，抓取错误碰坏吊机夹钳和钻杆猫道。

辅助定位法是通过关节吊机各运转轴，旋转机构加装液缸位移传感器，编码器，准确测量机构的相对位置；设备运行前，预设各动作机构目标位置，关节吊机各机构运动到目标位置后自动停止，最终实现关节吊机准确放置钻杆到钻杆猫道卡槽，准确从钻杆猫道卡槽抓取钻杆；相比于经验法，辅助定位法抓取钻杆和放置钻杆对准钻杆更加准确，用时更少，对操作者的技能要求更低，因操作对准错误造成关节吊机夹钳和钻杆猫道的损坏事故更少，操作效率大大提高；但是该方法只能实现对钻杆猫道卡槽，钻杆猫道钻杆对藏区的辅助定位操作，无法有效实现对钻杆堆藏区钻杆的定位操作，操作者从钻杆堆藏区抓取钻杆和放置钻杆仍然需要依靠操作经验。

发明内容

本发明的目的在于克服现有技术的不足，提供一种关节吊机自动抓放钻杆系统及方法，定位精度高，定位时间短，降低了对吊机操作者的能力要求，提高了操作效率。

本发明的目的是通过以下技术方案来实现的：一种关节吊机自动抓放钻杆系统，包括关节吊机本体和抓杆控制设备，所述抓杆控制设备的输出端与关节吊机本体连接；

所述的关节吊机本体包括主体回转、主臂、辅臂和夹持器；所述主臂的一端铰接在主体回转上，主臂的另一端与辅臂的前端铰接；所述辅臂的末端设置有能够沿辅臂中心轴转动的夹持器；

所述的抓杆控制设备包括工业摄像机和上位控制机；所述的工业摄像机设置于主臂的正下方，其照射方向与主体回转、主臂、辅臂处于同一平面内，用于采集钻杆堆藏区内的实时图像；所述上位控制机用于控制主体回转开始转动，同时根据工业摄像机拍摄的实时图像锁定目标钻杆，分析出关节吊机本体与钻杆堆藏区内钻杆的相对位置，使主体回转、主臂、辅臂所在平面缓慢接近目标钻杆，在确定能够抓取到钻杆后，控制关节吊机本体抓取目标钻杆。

所述的关节吊机本体还包括将军柱，所述回转主体安装于将军柱上且能够沿将军柱的中心轴转动。

所述的抓杆控制设备还包括吊机参数监控装置，所述吊机参数监控装置包括安装于主体回转上的第一编码器、安装于主臂上的第一倾角传感器、安装于辅臂上的第二倾角传感器、安装于夹持器上的第二编码器；所述第一编码器、第二编码器、第一倾角传感器和第二倾角传感器的输出端均与上位控制机连接；

所述第一编码器用于实时监测主体回转相对于初始位置回转角度；所述于第二编码器用于实时监测夹持器相对于初始位置回转角度；所述第一倾角传感器用于实时监测主臂与主体回转中心轴之间的相对角度；所述第二倾角传感器用于实时监测辅臂与主臂间的相对角度。

所述的上位控制机包括：

转动控制模块，用于控制主体回转转动；

图像分析模块，用于在主体回转的转动过程中，对工业摄像机拍摄到的图像进行分析，获得关节吊机本体与钻杆堆藏区内钻杆的相对位置；

调整模块，用于锁定目标钻杆，调整主体回转的转动速度，使主体回转、主臂、辅臂所在平面缓慢接近目标钻杆；

判断模块，用于实时判断当前姿态下是否能够成功抓取到钻杆：当目标钻杆与拍摄图像中竖直的一条直线重合时，认为当前姿态能够成功抓取到钻杆；

抓取控制模块，用于在确定能够抓取到钻杆后，控制关节吊机本体抓取目标钻杆，自动运行至钻杆猫道并放下钻杆。

其中，所述的抓取控制模块包括：

回转停止单元，用于控制主体回转停止转动；

辅臂调整单元，用于根据吊机参数监控装置采集到的数据，调整辅臂至该区域对应的工作半径；

夹持器调整单元，用于根据吊机参数监控装置采集到的数据，调整夹持器回转与目标钻杆平行；

抓取单元，用于根据吊机参数监控装置采集到的数据，控制主臂下放，使夹持器抓取钻杆；

放置单元，用于控制关节吊机本体自动运行至钻杆猫道并放下钻杆。

所述的一种关节吊机自动抓放钻杆系统的抓杆方法，包括以下步骤：

S1.上位控制机启动抓取钻杆的命令，并控制主体回转开始转动；