一种波浪补偿打捞机器人系统技术方案

本实用新型专利技术涉及一种波浪补偿打捞机器人系统，该波浪补偿打捞机器人系统安装在船舶上；其特征在于：包括机械臂机构、惯导传感器、运动控制器、计算机和视觉检测器；本实用新型专利技术装置中的机器人与普通机器人相比较，通过横向导轨和纵向导轨有了更大的工作空间，方便移动，便于存放在船舱和防腐蚀的壳体中；这样，增加了其使用寿命，更加便于维护；本实用新型专利技术装置中采用的是串联形式的机构，与传统并联的波浪补偿平台相比较更加容易得到位置正解，精度更高；本实用新型专利技术装置和控制方法可以有效的替代功能单一的传统波浪补偿装置，使整个补偿系统的结构更加简单、操作更加便捷，工作效率更高；在船舶行进过程中，也可以在甲板上作业进行工件打捞。

A wave compensated fishing robot system

The utility model relates to a wave compensation salvage robot system, the wave compensation salvage robot system installed on the ship; which comprises a mechanical arm mechanism, inertial sensor, motion controller, computer vision and detector; the utility model of the robot compared with ordinary robot, through the transverse and longitudinal rails with guide rail larger work space, easy to move, easy to shell corrosion in the cabin and stored in; so increases the service life, easy maintenance; the utility model is in series form, compared with the traditional parallel wave compensation platform more easy to get the position of positive solutions, more accuracy the utility model has the advantages of high; and the traditional control method can replace the function of a single wave compensation device effectively, make the whole compensation system The structure of the system is simpler, the operation is more convenient and the work efficiency is higher; in the course of the ship's marching, it can also be salvaged on the deck.

【技术实现步骤摘要】
一种波浪补偿打捞机器人系统
本技术涉及海上船舶打捞领域，尤其涉及一种波浪补偿打捞机器人系统。
技术介绍
我国是海洋大国，管辖海域广阔，海洋资源可开发利用的潜力很大，随着加快发展海洋产业，促进海洋经济的发展，海洋平台或船舶越来越频繁地进行着海上的作业，由于风浪的影响，海上作业的船舶在打捞时会产生无规律的摇摆，打捞的难度也随之增大，甚至会导致船舶打捞的中断以及危害工作人员的安全。那么由于海浪引起的船舶的横摇、纵摇和艏摇对打捞的影响，将是一个重点和棘手解决的问题。目前，海上船舶打捞装置多为人工操作的吊机式缆索打捞装置。现有的打捞装置是将吊机安装在船甲板上，通过人工对缆索升降的操作进行海上的打捞作业，在进行打捞的过程中，由于风浪的影响，船舶将不停的做摇摆运动，工作人员将会不断的对缆索进行升降补偿，抓取目标的准确度和效率就会很低。同时海上的目标物也会不断地发生位置的相对变化，由于人工的观察到操作缆绳具有一定的延迟性，这将会严重影响工件位置精确度和快速有效的打捞工件。如中国专利201610617770.X所述的一种波浪补偿专用机器人，具有小臂、手腕机构、末端执行器驱动器和末端执行机构，小臂前端连接手腕机构后端，手腕机构前端刚性连接末端执行器驱动器，末端执行器驱动器连接末端执行机构，初始位置时的手腕机构平行于舰船甲板，手腕机构前端指向船头正前方向，其特征是：手腕机构的后端包含第一、第二驱动器，前端包含一个差动机构和两个支撑臂，中间是支撑架，支撑架与小臂前端固接，支撑架的中间位置固联驱动框架，第一、第二驱动器在驱动框架的左、右两侧相对布置且共同连接驱动框架，第一、第二驱动器的中心轴均左右水平布置；支撑架的前侧方固接一左一右布置的两个支撑臂，两个支撑臂之间是差动机构；差动机构由四个锥齿轮、一个偏转轴和两个俯仰主动轴组成，偏转轴上下垂直布置，第一、第二俯仰主动轴中心线共线、与偏转轴的中心线相垂直且一左一右对称布置在偏转轴的两侧，第一、第二俯仰主动轴的一端共同能转动地连接差动机构支撑块，另一端支撑在同侧对应的支撑臂上，偏转轴的中间段同轴间隙穿过差动机构支撑块的中心孔，偏转轴的上段上通过轴承同轴连接第三锥齿轮，偏转轴的下段上同轴固定连接第一锥齿轮；第一俯仰主动轴上同轴固定套装相互固接在一起的第二锥齿轮和第一带轮，第二俯仰主动轴上同轴固定套装相互固接在一起的第四锥齿轮和第三带轮，第一锥齿轮与第二锥齿轮、第四锥齿轮均相啮合，第三锥齿轮与第二锥齿轮、第四锥齿轮也均相啮合；第一驱动器的输出轴同轴固定连接第四带轮，第二驱动器的输出轴同轴固定连接第二带轮，第一带轮通过第一齿形皮带连接第二带轮，第三带轮通过第二齿形皮带连接第四带轮；锥齿轮通过连接件固接末端执行器驱动器。上述专利中采用带轮式的传送结构，导致传动机构复杂，工作空间狭小，维护麻烦且使用寿命低，带轮式的传动精度差；针对上述打捞问题，本技术设计了一种波浪补偿打捞机器人系统。
技术实现思路
本技术要解决的技术问题是提供一种波浪补偿打捞机器人系统，该系统具有波浪补偿和自动识别的功能，能够针对风浪引起船舶的横摇、纵摇和艏摇进行实时补偿确保末端执行器不随海上风浪影响而产生严重晃动并且能够自动拍摄判断海上移动物体的准确位置，以完成高效、准确、可靠的完成打捞任务。为解决上述技术问题，本技术的技术方案为：一种波浪补偿打捞机器人系统，该波浪补偿打捞机器人系统安装在船舶上；其创新点在于：包括机械臂机构、惯导传感器、运动控制器、计算机和视觉检测器；所述机械臂机构包括基座、纵向导轨、横向导轨和机械臂；所述纵向导轨与横向导轨互相垂直且设置在同一水平面上，所述基座通过运动控制器可沿着互相垂直的横向导轨与纵向导轨往复移动；所述机械臂通过螺栓组固定连接在基座上，机械臂跟随基座沿着横向导轨或纵向导轨移动；所述机械臂由伺服电机驱动；所述惯导传感器位于机械臂的旁侧且连接固定在基座上，实时测量因风浪引起的数据变换并向计算机发送所测试的数据；所述计算机分别与惯导传感器、运动控制器和视觉检测器进行数据交换；所述计算机处理惯导传感器输出的数据并进行处理以及建立模型、预测和输出数据；所述计算机向运动控制器发送指令；所述计算机处理视觉检测器的传输数据；所述运动控制器的一端与计算机进行数据交换，运动控制器的另一端与机械臂的伺服电机相连并控制机械臂进行补偿运动；所述视觉处理器包括第一摄像机和第二摄像机；第一摄像机与第二摄像机分别安装在机械臂机构上。所述该系统的工作方法为：S1：首先视觉处理器采集待打捞工件的图像，并将得到的待打捞工件图像根据标定的模板图形进行比对，寻找与所述模板匹配的特征图形，特征图形经计算机提取出反映执行器和工件的位姿偏差信息，根据第一摄像机和第二摄像机的坐标系统与机械臂坐标系统的映射关系进行变换，得到工件在机械臂坐标系统内的坐标，通过图像的特征误差得到机械臂的运动位置增量，并将其传递给机械臂的伺服电机，确定伺服电机的转速和转向，根据带打捞工件坐标计算出机器臂路径轨迹；S1：根据第一摄像机和第二摄像机采集到的坐标数据，通过驱动电机将惯导传感器和机械臂通过横向导轨和纵向导轨移动到工作位置；S2：利用惯导传感器实时检测出船舶因风浪引起的变化来检测到船舶的横摇、纵摇和艏摇运动参数，并将这些数据输入到计算机中，并向计算机提供一个预测算法；S3：惯导传感器输送的数据在计算机中进行滤波预处理和数据归一化处理并建立模型，计算机根据建立的模型和惯导传感器检测到的数据，预测波浪的情况；计算机根据预测的波浪情况确定目标点的在波浪作用下位置坐标，并与实际所明确的目标点坐标进行对比，计算出补偿数据；S4：计算机将补偿数据传递给运动控制器，运动控制器根据船舶的位移和速度变化率的大小，经运算后给出控制信号，并将其传递给机械臂伺服驱动器，伺服驱动器根据控制信号的大小，决定伺服电机的转速和转向，伺服电机驱动机械臂完成波浪补偿功能；S5：惯导传感器不断地将检测到的船舶的实际位移、速度等参数反馈给计算机，计算机处理后反馈给运动控制器，运动控制器根据位移和速度的变化率的大小在计算出下一周期控制信号的大小，并将其传递给机械臂伺服驱动器，进行下一周期的控制；S6：伺服电机根据波浪补偿数据和视觉处理数据，驱动机械臂，待打捞工件的打捞任务。所述惯导传感器能够实时检测出横摇、纵摇、艏摇、纵荡、横荡、垂荡以及纵荡、横荡和垂荡的速度数据并输送给计算机进行处理。所述S3中建立模型为通过将惯导传感器输送的数据在零均值和平稳化处理后通过计算机计算出自相关函数acf和偏相关函数pacf,根据函数曲线判定的AR模型，根据判定的AR模型通过计算机识别出模型参数对船舶进行连续预测。本技术的优点在于：1）本技术装置中的机器人与普通机器人相比较，通过横向导轨和纵向导轨有了更大的工作空间，方便移动，便于存放在船舱和防腐蚀的壳体中。这样，增加了其使用寿命，更加便于维护。2）本技术装置中采用的是串联形式的机构，与传统并联的波浪补偿平台相比较更加容易得到位置正解，精度更高。3）本技术装置和控制方法可以有效的替代功能单一的传统波浪补偿装置，使整个补偿系统的结构更加简单、操作更加便捷，工作效率更高。在船舶行进过程中，也可以在甲板上作业进行物品打捞。附本文档来自技高网...

【技术保护点】
一种波浪补偿打捞机器人系统，该波浪补偿打捞机器人系统安装在船舶上；其特征在于：包括机械臂机构、惯导传感器、运动控制器、计算机和视觉检测器；所述机械臂机构包括基座、纵向导轨、横向导轨和机械臂；所述纵向导轨与横向导轨互相垂直且设置在同一水平面上，所述基座通过运动控制器可沿着互相垂直的横向导轨与纵向导轨往复移动；所述机械臂通过螺栓组固定连接在基座上，机械臂跟随基座沿着横向导轨或纵向导轨移动；所述机械臂由伺服电机驱动；所述惯导传感器位于机械臂的旁侧且连接固定在基座上，实时测量因风浪引起的数据变换并向计算机发送所测试的数据；所述计算机分别与惯导传感器、运动控制器和视觉检测器进行数据交换；所述计算机处理惯导传感器输出的数据并进行处理以及建立模型、预测和输出数据；所述计算机向运动控制器发送指令；所述计算机处理视觉检测器的传输数据；所述运动控制器的一端与计算机进行数据交换，运动控制器的另一端与机械臂的伺服电机相连并控制机械臂进行补偿运动；所述视觉处理器包括第一摄像机和第二摄像机；第一摄像机与第二摄像机分别安装在机械臂机构上。

【技术特征摘要】
2017.03.28 CN 20172031196091.一种波浪补偿打捞机器人系统，该波浪补偿打捞机器人系统安装在船舶上；其特征在于：包括机械臂机构、惯导传感器、运动控制器、计算机和视觉检测器；所述机械臂机构包括基座、纵向导轨、横向导轨和机械臂；所述纵向导轨与横向导轨互相垂直且设置在同一水平面上，所述基座通过运动控制器可沿着互相垂直的横向导轨与纵向导轨往复移动；所述机械臂通过螺栓组固定连接在基座上，机械臂跟随基座沿着横向导轨或纵向导轨移动；所述机械臂由伺服...

【专利技术属性】
技术研发人员：卢道华，陈文君，王佳，韩彬，
申请(专利权)人：江苏科技大学，江苏科技大学海洋装备研究院，
类型：新型
国别省市：江苏,32