一种基于视觉伺服的机械臂自动对接系统专利检索-空间布局建筑物专利检索查询-专利查询网

一种基于视觉伺服的 机械臂自动对接系统

阅读：258发布：2020-05-14

专利汇可以提供一种基于视觉伺服的机械臂自动对接系统专利检索，专利查询，专利分析的服务。并且一种基于视觉伺服与机械臂的飞机自动对接系统，其特征在于，包括，机械臂本体、机械臂控制箱、视觉测量相机及图像处理工控机，其中，机械臂本体与飞机保障设备接头固连，能够通过调整自身各关节状态改变接头位姿；视觉测量相机及图像处理工控机通过拍摄飞机机身图像，对飞机机身接口进行捕捉，并应用视觉伺服方法计算机械臂本体的目标位姿，通过以太网发送至机械臂控制箱；机械臂控制箱根据对接流程与目标位姿指令，进行机械臂末端接头控制，最终实现自动对接；该自动对接系统大幅提高了对接控制精度、效率与信息化水平，可实现减员增效。，下面是一种基于视觉伺服的机械臂自动对接系统专利的具体信息内容。

权利要求

1.一种基于视觉伺服与机械臂的飞机自动对接系统，其特征在于，包括，机械臂本体、机械臂控制箱、视觉测量相机及图像处理工控机，其中，
所述机械臂本体与飞机保障设备接头固连，能够通过调整自身各关节状态改变接头位姿；视觉测量相机及图像处理工控机通过拍摄飞机机身图像，对飞机机身接口进行捕捉，并应用视觉伺服方法计算机械臂本体的目标位姿，通过以太网发送至机械臂控制箱；机械臂控制箱根据对接流程与目标位姿指令，进行机械臂末端接头控制，最终实现自动对接。
2.根据权利要求1所述的系统，其特征在于，飞机停在保障位后，飞机自动对接系统通过视觉相机自动识别、定位机身接口位置，视觉测量系统根据图像信息解算出机身接口端面的位姿信息，并将解算出的位姿信息反馈至控制系统，控制系统驱动机械臂运动并使对接头准确到达目标位置，提高整个接口定位精度。
3.根据权利要求2所述的系统，其特征在于，基于逆运动学分析方法，进行多约束路径规划，即针对飞机接头位姿信息、前起落架舱空间布局、接头周围设备的防碰壁需求等约束条件，开展路径规划优化计算，以关节角度、角速度、角加速度为条件变量，建立运动学方程，求解得出最优路径，并在对接前设置校准点，机械臂在校准点通过视觉测量系统进行位置校准，实现对接前的定位误差补偿，从而得出机械臂接头至飞机机身接口的最优路径，多约束路径规划技术是实现安全、高效完成飞机全自动保障的关键。
4.根据权利要求3所述的系统，其特征在于，所述系统通过高精度定位以及控制系统的高精度控制后，机械臂末端接头与飞机机身接口仍可能存在一定位置偏差，偏差主要体现在中心重合度、深度和角度几个方面，当偏差较小时，根据机械臂关节力矩反馈信息调节各关节的力矩输出，实现接头柔性对接；当偏差较大时，机械臂自动退回，控制系统重新规划路径，再次进行对接。
5.一种基于视觉伺服与机械臂的飞机自动对接方法，采用权利要求4所述的基于视觉伺服与机械臂的飞机自动对接系统，其特征在于，包括如下步骤，
步骤一、机械臂上电到达初始位置P0；
步骤二、机械臂接收开始指令展开至固定位置P1，并将相机位姿信息发送至视觉测量系统；
步骤三、接收自动对接开始；
步骤四、启动视觉相机拍照，并接收来自相机的目标绝对位置脱靶量Δ1；
步骤五、根据目标绝对位置脱靶量Δ1，规划并控制机械臂至二次精确定位位置P2；
步骤六、再次启动相机拍照并将P2处相机位姿发送至视觉测量系统；
步骤七、再次接收视觉测量系统目标的位姿信息，得到目标绝对位置脱靶量Δ2；
步骤八、判断是否具备直线对接条件，如果具备，则执行步骤九，如果不具备跳转到步骤四；
步骤九、启动机械臂直线对接过程，控制对接头直线运动L0距离；
步骤十、机械臂第六关节旋转θ。
步骤十、通过以太网发送对接完成信号
步骤十一、机械臂原路返回至P0。
6.根据权利要求5所述的方法，其特征在于，所述步骤二中，在P1位置，接头距目标
1000mm左右。

说明书全文

一种基于视觉伺服的机械臂自动对接系统

技术领域

[0001] 本发明涉及飞机保障领域，具体涉及一种基于视觉伺服的机械臂自动对接系统。

背景技术

[0002] 目前，涉及保障设备接头与飞机机身接口(如飞机受油口)对接类的保障作业全部由人力完成，以飞机加油为例，需要机务勤务人员完成信息交互、加油接头传递等工作，同时加油软管的拖拽以及加油接头的对接工作完全依赖人力，保障效率较低，占用人员多，人员劳动强度大，不利于加油作业人员长期连续作战。目前，基于视觉与机械臂联动的技术方案已在焊接、分拣等工业领域得以应用，但由于应用场合多有小负载、低精度、高重复等特点，无法满足飞机对接过程负载大、精度高的应用需求，国内现无飞机保障自动对接系统。

发明内容

[0003] 本发明的主要针对飞机保障领域自动对接的应用需求，提出了一种基于视觉伺服与机械臂的飞机自动对接系统和方法，该系统包括，

[0004] 机械臂本体、机械臂控制箱、视觉测量相机及图像处理工控机，其中，[0005] 所述机械臂本体与飞机保障设备接头固连，能够通过调整自身各关节状态改变接头位姿；视觉测量相机及图像处理工控机通过拍摄飞机机身图像，对飞机机身接口进行捕捉，并应用视觉伺服方法计算机械臂本体的目标位姿，通过以太网发送至机械臂控制箱；机械臂控制箱根据对接流程与目标位姿指令，进行机械臂末端接头控制，最终实现自动对接；

[0006] 进一步地，飞机停在保障位后，飞机自动对接系统通过视觉相机自动识别、定位机身接口位置，视觉测量系统根据图像信息解算出机身接口端面的位姿信息，并将解算出的位姿信息反馈至控制系统，控制系统驱动机械臂运动并使对接头准确到达目标位置，提高整个接口定位精度；

[0007] 进一步地，所述系统基于逆运动学分析方法，进行多约束路径规划，即针对飞机接头位姿信息、前起落架舱空间布局、接头周围设备的防碰壁需求等约束条件，开展路径规划优化计算，以关节角度、角速度、角加速度为条件变量，建立运动学方程，求解得出最优路径，并在对接前设置校准点，机械臂在校准点通过视觉测量系统进行位置校准，实现对接前的定位误差补偿，从而得出机械臂接头至飞机机身接口的最优路径，多约束路径规划技术是实现安全、高效完成飞机全自动保障的关键；

[0008] 进一步地，所述系统通过高精度定位以及控制系统的高精度控制后，机械臂末端接头与飞机机身接口仍可能存在一定位置偏差，偏差主要体现在中心重合度、深度和角度几个方面，当偏差较小时，根据机械臂关节力矩反馈信息调节各关节的力矩输出，实现接头柔性对接；当偏差较大时，机械臂自动退回，控制系统重新规划路径，再次进行对接。

[0009] 基于视觉伺服与机械臂的飞机自动对接方法，采用上述基于视觉伺服与机械臂的飞机自动对接系统，其特征在于，包括如下步骤，

[0010] 步骤一、机械臂上电到达初始位置P0；

[0011] 步骤二、机械臂接收开始指令展开至固定位置P1，并将相机位姿信息发送至视觉测量系统；

[0012] 步骤三、接收自动对接开始；

[0013] 步骤四、启动视觉相机拍照，并接收来自相机的目标绝对位置脱靶量Δ1；

[0014] 步骤五、根据目标绝对位置脱靶量Δ1，规划并控制机械臂至二次精确定位位置P2；

[0015] 步骤六、再次启动相机拍照并将P2处相机位姿发送至视觉测量系统；

[0016] 步骤七、再次接收视觉测量系统目标的位姿信息，得到目标绝对位置脱靶量Δ2；

[0017] 步骤八、判断是否具备直线对接条件，如果具备，则执行步骤九，如果不具备跳转到步骤四；

[0018] 步骤九、启动机械臂直线对接过程，控制对接头直线运动L0距离；

[0019] 步骤十、机械臂第六关节旋转θ。

[0020] 步骤十、通过以太网发送对接完成信号

[0021] 步骤十一、机械臂原路返回至P0

[0022] 进一步地，所述步骤二中，在P1位置，接头距目标1000mm左右。

[0023] 有益效果：

[0024] 与现有技术相比本发明的技术方案具有如下优点：

[0025] 研制的自动对接系统，大幅提高对接控制精度、效率与信息化水平，实现减员增效：

[0026] (1)以加油保障为例，当飞机进入停机位后，加油装置自动升起，并完成接头对接和保障工作。可缩短再次出动准备时间缩短1～2min，结合我国辽宁舰使用经验，可减少作业人员约51名。

[0027] (2)对接控制与过程信息均可进行采集，减少保障过程的人工信息传递环节，实现全流程的数字化、信息化保障。附图说明

[0028] 图1为自动对接系统组成图；

[0029] 图2为自动对接系统示意图；

[0030] 图3为自动对接装置保障接头位置；

[0031] 图4为自动对接动作步骤流程示意图；

[0032] 图5为自动对接系统原理框图；

[0033] 图6为自动对接系统控制流程图；

[0034] 图7为基于图像的视觉伺服定位方法原理图。

具体实施方式

[0035] 下面根据附图和具体实施方式对本发明的技术方案做进一步详细的解释和说明。

[0036] 基于视觉伺服的机械臂自动对接系统主要由机械臂本体、机械臂控制箱及示教器、视觉测量相机及图像处理工控机组成，基动对接系统组成图如图1，自动对接系统示意图如图2，自动对接系统原理框图如图5所示。

[0037] 机械臂本体与飞机保障设备接头固连，能够通过调整自身各关节状态改变接头位姿。视觉测量相机及图像处理工控机通过拍摄飞机机身图像，对飞机机身接口进行捕捉，并应用视觉伺服方法计算机械臂本体的目标位姿，通过以太网发送至机械臂控制箱。机械臂控制箱根据对接流程与目标位姿指令，进行机械臂末端接头控制，最终实现自动对接。

[0038] 若机械臂故障，无法自动完成自动对接时，可将保障接头取下，手动完成与飞机插座的对接，保障接头位置如图3所示。

[0039] 将对接过程分为五步骤，各动作步骤如图4所示：

[0040] 1)机械臂上电到达初始位置P0；

[0041] 2)初始位置P0启动视觉相机拍照得到对接工件的图像特征，与初定位位置P1处的对接工件的图像特征对比，控制机械臂到达初定位位置P1；

[0042] 3)到达P1后再次启动相机拍照得到对接工件的图像特征，与精确定位位置P2处的对接工件的图像特征对比，控制机械臂到达精确定位位置P2；

[0043] 4)满足直线对接条件，启动直线对接过程，控制对接头直线运动L0距离；

[0044] 5)机械臂第六关节旋转θ。

[0045] 综合飞机保障需求，自动对接装置可达到指标如下：

[0046] 1)测量精度：位置测量精度不低于0.5mm，角度测量精度不低于0.5°；

[0047] 2)测量距离：400mm～1500mm；

[0048] 3)对接时间：不超过3min。

[0049] 飞机停在保障位后，飞机自动对接系统通过视觉相机自动识别、定位机身接口位置，视觉测量系统根据图像信息解算出机身接口端面的位姿信息，并将解算出的位姿信息反馈至控制系统，控制系统驱动机械臂运动并使对接头准确到达目标位置，提高整个接口定位精度，基于图像的视觉伺服定位方法原理图如图7所示；

[0050] 所述系统基于逆运动学分析方法，进行多约束路径规划，即针对飞机接头位姿信息、前起落架舱空间布局、接头周围设备的防碰壁需求等约束条件，开展路径规划优化计算，以关节角度、角速度、角加速度为条件变量，建立运动学方程，求解得出最优路径，并在对接前设置校准点，机械臂在校准点通过视觉测量系统进行位置校准，实现对接前的定位误差补偿，从而得出机械臂接头至飞机机身接口的最优路径，多约束路径规划技术是实现安全、高效完成飞机全自动保障的关键；

[0051] 所述系统通过高精度定位以及控制系统的高精度控制后，机械臂末端接头与飞机机身接口仍可能存在一定位置偏差，偏差主要体现在中心重合度、深度和角度几个方面，当偏差较小时，根据机械臂关节力矩反馈信息调节各关节的力矩输出，实现接头柔性对接；当偏差较大时，机械臂自动退回，控制系统重新规划路径，再次进行对接。

[0052] 基于视觉伺服与机械臂的飞机自动对接方法，采用上述基于视觉伺服与机械臂的飞机自动对接系统，如图6所示，包括如下步骤，

[0053] 步骤一、机械臂上电到达初始位置P0；

[0054] 步骤二、机械臂接收开始指令展开至固定位置P1(接头距目标1000mm左右)，并将相机位姿信息发送至视觉测量系统；

[0055] 步骤三、接收自动对接开始；

[0056] 步骤四、启动视觉相机拍照，并接收来自相机的目标绝对位置脱靶量Δ1；

[0057] 步骤五、根据目标绝对位置脱靶量Δ1，规划并控制机械臂至二次精确定位位置P2；

[0058] 步骤六、再次启动相机拍照并将P2处相机位姿发送至视觉测量系统；

[0059] 步骤七、再次接收视觉测量系统目标的位姿信息，得到目标绝对位置脱靶量Δ2；

[0060] 步骤八、判断是否具备直线对接条件，如果具备，则执行步骤九，如果不具备跳转到步骤四；

[0061] 步骤九、启动机械臂直线对接过程，控制对接头直线运动L0距离；

[0062] 步骤十、机械臂第六关节旋转θ。

[0063] 步骤十、通过以太网发送对接完成信号

[0064] 步骤十一、机械臂原路返回至P0

[0065] 上述实例仅用以说明本发明的技术方案而非对其进行限制，尽管参照最佳实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对本发明的技术方案进行修改或者等同替换，而这些修改或者等同替换亦不能使修改后的技术方案脱离本发明技术方案的精神和范围。

标题	发布/更新时间	阅读量
基于地理位置数据的资源利用关联网络模型规划方法	2020-05-11	607
心磁测量系统	2020-05-11	375
一种新型固井车	2020-05-08	276
一种基于壳体固定的导引头框架式连杆驱动装置	2020-05-11	477
一种充气柜	2020-05-11	375
一种卫星姿控动量轮真空密封阀及抽气辅助装置	2020-05-11	260
一种包装膜进给机构	2020-05-08	78
全地形车	2020-05-11	94
一种管件成型机构	2020-05-12	793
一种车灯涂装线	2020-05-13	589

一种基于视觉伺服的机械臂自动对接系统

一种基于视觉伺服的机械臂自动对接系统

技术领域

背景技术

发明内容

具体实施方式

该功能需要专业版企业版VIP权限，您可以：