CN112415086A - 一种基于遥操作飞行机械臂的高空金属管道探伤系统 - Google Patents

一种基于遥操作飞行机械臂的高空金属管道探伤系统 Download PDF

Info

Publication number
CN112415086A
CN112415086A CN202011280546.9A CN202011280546A CN112415086A CN 112415086 A CN112415086 A CN 112415086A CN 202011280546 A CN202011280546 A CN 202011280546A CN 112415086 A CN112415086 A CN 112415086A
Authority
CN
China
Prior art keywords
mechanical arm
force
flying
arm
contact detection
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.)
Granted
Application number
CN202011280546.9A
Other languages
English (en)
Other versions
CN112415086B (zh
Inventor
宋光明
郝爽
陈钢
顾玥
毛巨正
宋爱国
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN202011280546.9A priority Critical patent/CN112415086B/zh
Publication of CN112415086A publication Critical patent/CN112415086A/zh
Application granted granted Critical
Publication of CN112415086B publication Critical patent/CN112415086B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
    • G01N27/00—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means
    • G01N27/72—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables
    • G01N27/82—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables for investigating the presence of flaws
    • G01N27/90—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables for investigating the presence of flaws using eddy currents
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64C—AEROPLANES; HELICOPTERS
    • B64C39/00—Aircraft not otherwise provided for
    • B64C39/02—Aircraft not otherwise provided for characterised by special use
    • B64C39/024—Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U10/00—Type of UAV
    • B64U10/10—Rotorcrafts
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U30/00—Means for producing lift; Empennages; Arrangements thereof
    • B64U30/20—Rotors; Rotor supports
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
    • G01N27/00—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means
    • G01N27/72—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables
    • G01N27/82—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables for investigating the presence of flaws
    • G01N27/90—Investigating or analysing materials by the use of electric, electrochemical, or magnetic means by investigating magnetic variables for investigating the presence of flaws using eddy currents
    • G01N27/9013—Arrangements for scanning
    • G01N27/902—Arrangements for scanning by moving the sensors
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2101/00—UAVs specially adapted for particular uses or applications
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2201/00—UAVs characterised by their flight controls
    • B64U2201/20—Remote controls

Abstract

本发明公开了一种基于遥操作飞行机械臂的高空金属管道探伤系统，主要用于工业环境高空金属管道焊缝的无损检测。该系统硬件主要包括主端力反馈手控器设备、主端计算机设备、主从端通信设备、飞行机械臂、包括力传感器、涡流探伤传感器。其中飞行机械臂由刚体机械臂固连于六自由度全驱动无人机组成，飞行机械臂末端执行器集成单轴力传感器与涡流探伤传感器。设计控制器使其对垂直接触表面方向表现出柔顺性，其他方向表现出鲁棒性。进行接触检测时，飞行机械臂由力反馈手控器控制，操作者可以通过力反馈手控器感受飞行机械臂与检测环境的交互力。本发明节约了检测成本，避免了检测人员高空作业，安全高效。

Description

一种基于遥操作飞行机械臂的高空金属管道探伤系统
技术领域
本发明属于机器人技术领域，具体涉及一种基于遥操作飞行机械臂的高空金属管道探伤系统。
背景技术
在工业设施中，结构完整性评估是一个必须定期执行的过程。特别是石化行业，由于金属管道上的低碳钢焊缝可能会出现裂纹或缺陷，因此焊缝的完整性检查非常频繁。这些检测常用无损检测方法，例如利用涡流探伤传感器对焊缝表面缺陷进行检测，这类无损检测传感器多为接触性传感器，需要与检测环境进行接触。石化行业等工业环境中存在大量的高空金属管道，对于这些管道的检测目前大多由工人进行高空作业检测。因此存在检测效率低、成本高以及危险性高等缺点。
近年来，无人机在航拍、巡检及农林植保等方面得到了大量应用。但目前无人机的主要用途在于对环境的观测，缺乏与环境进行物理交互的接触检测能力。飞行机械臂是指无人机与机械臂组成的机器人系统。飞行机械臂可以到达人员无法到达或进入的环境进行作业，例如高空的维修作业、环境检测采样以及接触检测等。飞行机械臂进行接触检测需要与环境进行物理交互，物理交互可能会使飞行机械臂不稳定，因此飞行机械臂需要良好的控制算法以保证飞行机械臂的鲁棒性以及接触空间的柔顺性。
目前，组成飞行机械臂系统的普通的旋翼无人机(四旋翼、六旋翼等)为欠驱动系统，欠驱动旋翼无人机无法主动对环境施加六自由度的力，对于接触检测等需要对环境施加多维可控力的应用场景，一般依靠安装多自由度机械臂与环境进行交互作业。但是这种设计存在以下问题：(1)多自由度机械臂增加了机体重量，影响飞行机械臂的续航；(2)多自由机械臂增加了机械结构的复杂性，增加了设计成本；(3)机械臂进行作业时，机械臂与旋翼无人机之间存在很强的动态耦合，对飞行机械臂的控制造成困难。同时，飞行机械臂飞行时易受到风的影响，飞行机械臂顺利完成任务需要良好的抗扰性。除此之外，考虑到工业环境的复杂性，飞行机械臂无法自主检测；而传统的遥控控制飞行方式，对飞行机械臂控制的灵活度较低，难以进行高精度检测作业，并且操作者难以获得力觉临场感，仅靠视觉反馈难以对突发情况进行快速反应。
基于以上问题，本发明提出一种基于遥操作飞行机械臂的高空金属管道探伤系统。
发明内容
为解决上述问题，本发明公开了一种基于遥操作飞行机械臂的高空金属管道探伤系统，通过对无人机进行改造，可对环境施加多维力以保证复杂表面环境(例如高空金属管道的弧形表面)的接触检测，操作方便灵活，节约了检测成本，避免了检测人员高空作业，安全高效。
为达到上述目的，本发明的技术方案如下：
一种基于遥操作飞行机械臂的高空金属管道探伤系统，包括主端计算机、力反馈手控器、通信系统、飞行机械臂以及飞行机械臂末端执行器(单轴力传感器、涡流探伤传感器)。
所述飞行机械臂由全驱动六旋翼无人机与机械臂组成，相比传统的六旋翼除六个提供动力的电机外，本发明在每个机臂末端增加一个电机以保证机臂实现可控转动，机臂旋转角度与无人机位姿相耦合，根据无人机位姿对机臂旋转角度进行动态调节，构成全驱动无人机；所述机械臂为轻质单杆，机械臂末端装有单轴力传感器，对接触环境的交互力进行测量以及涡流探伤传感器。
全驱动无人机可以进行六维轨迹跟踪，对于机械臂，无人机相当于悬浮的六自由度可控基座，因此固连于全驱动无人机的机械臂可对环境施加多维力以保证复杂表面环境(例如高空金属管道的弧形表面)的接触检测。在接触检测时，主端操作者利用力反馈手控器对飞行机械臂进行控制，以增强操作者的力觉临场感和检测作业灵活性，传感器检测数据以及视觉反馈传回主端计算机供操作者读取。
对于飞行机械臂的控制，设计扰动观测器对外部扰动与接触力进行估计，采用阻抗控制的方法结合扰动观测器，保证飞行机械臂在接触检测空间表现出柔顺性，在其他自由飞行空间表现出鲁棒性。对力反馈手控器与飞行机械臂建立增量式运动学映射，进行接触检测时，将力反馈手控器位姿增量作为飞行机械臂的运动命令信号，增强接触检测的灵活性；力反馈手控器保证了操作者的力觉临场感，增强了接触检测的效率与安全性。其具体实现步骤如下：
步骤1：构造飞行机械臂硬件系统。对于全驱动六旋翼无人机本体，相对于传统的六旋翼，除了提供动力的螺旋桨六个电机外，六个机臂末端安装六个电机保证机臂可控倾转以提供更多的自由度。机械臂固连于全驱动无人机，单轴力传感器和涡流探伤传感器固连于机械臂末端。
步骤2：建立飞行机械臂运动学模型。假设全驱动六旋翼为质量分布均匀的刚体，忽略其弹性形变。
Figure BDA0002780617590000021
为世界坐标系，
Figure BDA0002780617590000022
为以飞行机械臂重心为原点的机体坐标系。
Figure BDA0002780617590000023
表示飞行机械臂
Figure BDA0002780617590000024
在
Figure BDA0002780617590000025
下的位置矢量，v为机体在
Figure BDA0002780617590000027
的速度。Θ＝[ψ，θ，φ]T表示姿态向量，其中ψ是绕轴zb转动的偏航角，θ是按轴yb转动的俯仰角，φ是绕轴xb转动的滚转角。假设无人机不会有大机动运动，即
Figure BDA0002780617590000026
飞行机械臂的运动学方程如下：
Figure BDA0002780617590000031
其中ωb表示机体坐标系下的机体角速度，其中，
Figure BDA0002780617590000032
步骤3：建立飞行机械臂的动力学模型。不考虑各螺旋桨产生气流相互影响的情况下，利用牛顿-欧拉法建立飞行机械臂的刚体动力学模型：
Figure BDA0002780617590000033
上式中下标b表示机体坐标系；
Figure BDA0002780617590000034
分别表示飞行机械臂的力和力矩；
Figure BDA0002780617590000035
分别表示飞行机械臂
Figure BDA0002780617590000036
在
Figure BDA0002780617590000037
下的速度和加速度；ωb，
Figure BDA0002780617590000038
分别表示飞行机械臂的角速度和角加速度；m，Jx分别表示飞行机械臂的质量与惯性。
步骤4：设计控制分配矩阵。飞行机械臂的运动的力通过螺旋桨的转动产生，因此飞行机械臂的控制力和力矩与螺旋桨转速之间存在映射关系，对各个螺旋桨的转速控制即控制分配分配矩阵。对于一般的六旋翼无人机，控制分配矩阵是常数矩阵。本发明提出的全驱动无人机机臂末端装有电机实现机臂倾转，控制分配矩阵是关于机臂倾转角度α的控制分配矩阵：
τact＝A(α)Ω
步骤5：基于扰动观测器的阻抗控制器设计。对于本发明中的飞行机械臂，其动力学模型可简化为：
Figure BDA0002780617590000039
其中，
Figure BDA00027806175900000310
分别为惯性矩阵与哥氏力矩阵；
Figure BDA00027806175900000311
分别为控制力与外部扰动力(主要包括风扰与接触力)。
扰动观测器设计方法如下：
Figure BDA00027806175900000312
其中
Figure BDA00027806175900000313
为外部总扰动力的估计值。
进行检测接触时，飞行机械臂与高空工业管道闭环动力学方程可简化为：
Figure BDA00027806175900000314
其中，Md，Kp，Kd分别为机器人的虚拟质量，刚度，以及阻尼；ex，ev分别为机体坐标系下飞行机械臂的位置误差与速度误差。
将上式与飞行机械臂动力学方程联立，我们可以得到飞行机械臂的控制力：
Figure BDA0002780617590000041
飞行机械臂末端执行器坐标系方向与机体坐标系方向一致，检测接触表面与末端执行器方向垂直，因此我们设置沿机械臂方向的期望质量为较低数值，以保证该方向的柔顺性，而其他方向表现出对扰动的鲁棒性。阻抗控制是通过对位置的控制间接完成力控制，操作者可以通过对飞行机械臂的位置控制进而控制交互检测的接触力。
步骤6：对力反馈手控器进行正运动学建模，人手控制力反馈手控器，经过低通滤波防抖动后，通过正运动学获取笛卡尔空间位姿增量，对其处理后(乘以相应系数和位姿映射矩阵)作为飞行机械臂的位姿命令信号。
步骤7：采用具有力觉临场感的遥操作对飞行机械臂的接触检测作业进行控制时，飞行机械臂末端的力传感器将检测环境的交互力传递到力反馈手控器，操作者可以同时根据力反馈信息调整力反馈手控器的位姿，进而调整飞行机械臂与环境的接触力，以安全高效的完成高空工业管道的无损检测。
本发明的有益效果是：
1、本发明所提出的一种基于遥操作飞行机械臂的高空金属管道探伤系统。该检测系统可以对石化行业等工业环境中的高空金属管道进行结构完整性评估。避免了工人高空作业，提高了检测效率与检测人员安全性，降低了检测成本。
2、本发明所提出的飞行机械臂可以实现复杂表面的接触检测，而不需要附加多自由度机械臂，从而提高了飞行检测时间与飞行稳定性，降低飞行机械臂制造成本。
3、本发明提出的基于扰动观测器的飞行机械臂阻抗控制，保证了接触检测方向的柔顺性，而在其他方向表现出鲁棒性。提高了飞行机械臂的执行能力。
4、本发明所提出的具有力觉临场感的飞行机械臂遥操作控制模式，操作者可以感受到接触检测的交互力，进而可以根据交互力的大小对飞行机械臂的接触检测进行控制，对突发情况可以快速反应。提高了接触检测的效率与安全性。
附图说明
图1为本发明所述一种基于遥操作飞行机械臂的高空金属管道探伤系统的硬件组成图；
图2为本发明所述飞行机械臂组成图；
图3为本发明所述全驱动无人机机臂示意图；
图4为本发明所述全驱动无人机基于扰动观测器的阻抗控制示意图。
附图标记列表：
1-1、力反馈手控器；1-2、主端计算机；1-3、通信系统；1-4、飞行机械臂；1-5单轴力传感器；1-6涡流探伤传感器；2-1、全驱动无人机；2-2、机械臂；3-1、机臂末端电机；3-2机臂倾转角度示意。
具体实施方式
本发明所述一种基于遥操作飞行机械臂的高空金属管道探伤系统，具体实施方式包括以下7个步骤：构造飞行机械臂硬件系统；建立飞行机械臂运动学模型；建立飞行机械臂的动力学模型；设计控制分配矩阵；基于扰动观测器的阻抗控制器设计；对力反馈手控器与飞行机械臂进行运动学映射；对接触检测采用遥操作控制。
步骤1：构造飞行机械臂硬件系统。对于全驱动六旋翼无人机本体，相对于传统的六旋翼，除了提供动力的螺旋桨六个电机外，无人机的六个机臂末端安装六个电机保证机臂倾转以调整角度。增加了一个机械臂固连于全驱动无人机(机械臂的位置位于相邻两个机臂之间)，单轴力传感器和涡流探伤传感器固连于机械臂末端。
步骤2：建立飞行机械臂运动学模型。假设全驱动六旋翼为质量分布均匀的刚体，忽略其弹性形变。
Figure BDA0002780617590000051
为世界坐标系，
Figure BDA0002780617590000052
为以飞行机械臂重心为原点的机体坐标系。
Figure BDA0002780617590000053
表示飞行机械臂
Figure BDA0002780617590000054
在
Figure BDA0002780617590000055
下的位置矢量，v为机体在
Figure BDA0002780617590000056
的速度。Θ＝[ψ，θ，φ]T表示姿态向量，其中ψ是绕轴zb转动的偏航角，θ是按轴yb转动的俯仰角，xb是绕轴转动的滚转角。假设无人机不会有高机动运动，即
Figure BDA0002780617590000057
飞行机械臂的运动学方程如下：
Figure BDA0002780617590000058
其中ωb表示机体坐标系下的机体角速度，其中，
Figure BDA0002780617590000059
步骤3：建立飞行机械臂的动力学模型。不考虑各螺旋桨产生气流相互影响的情况下，利用牛顿-欧拉法建立飞行机械臂的刚体动力学模型：
Figure BDA00027806175900000510
上式中下标b表示机体坐标系；Fb，τb分别表示飞行机械臂的力和力矩；
Figure BDA00027806175900000511
分别表示飞行机械臂在
Figure BDA00027806175900000512
的速度和加速度；ωb，
Figure BDA00027806175900000513
分别表示飞行机械臂的角速度和角加速度；m，Jb分别表示飞行机械臂的质量与惯性。
步骤4：设计控制分配矩阵。飞行机械臂的运动的力通过螺旋桨的转动产生，因此飞行机械臂的控制力和力矩与螺旋桨转速之间存在映射关系，对各个螺旋桨的转速控制即控制分配分配矩阵。对于一般的六旋翼无人机，控制分配矩阵是常数矩阵。本发明全驱动无人机机臂末端装有电机实现机臂倾转，控制分配矩阵是关于机臂倾转角度α的控制分配矩阵：
τact＝A(α)Ω
其中
Figure BDA0002780617590000061
Figure BDA0002780617590000062
为转速；
Figure BDA0002780617590000063
为控制分配矩阵，α为机臂倾转角度。
各螺旋桨产生的推力与力矩与转速存在如下关系：
F＝μn2，τ＝κn2
其中μ，κ为常数，代表推力系数与力矩系数。
Figure BDA0002780617590000064
螺旋桨产生垂直机身向上与横向推力可表示为：
Figure BDA0002780617590000065
根据上式，我们将A(α)转化为静态矩阵我们可以得到，
τact＝A(α)Ω＝Au
其中，
Figure BDA0002780617590000066
A为与α无关的静态常数矩阵。
u＝A′τact
其中
Figure BDA0002780617590000067
为理想的输入力矩，A′为A的伪逆矩阵。
根据以上信息可对各机臂倾转角度αi求解。
步骤5：基于扰动观测器的阻抗控制器设计。对于本发明中的飞行机械臂，其动力学模型可简化为：
Figure BDA0002780617590000068
其中，
Figure BDA0002780617590000069
分别为惯性矩阵与哥氏力矩阵；
Figure BDA00027806175900000610
分别为控制力与外部扰动力(主要包括风扰与接触力)。
扰动观测器设计方法如下：
Figure BDA00027806175900000611
其中
Figure BDA00027806175900000612
为外部总扰动力的估计值。
进行检测接触时，飞行机械臂与高空工业管道闭环动力学方程可简化为：
Figure BDA0002780617590000071
其中，Md，Kp，Kd分别为机器人的虚拟质量，刚度，以及阻尼；ex，ev分别为机体坐标系下飞行机械臂的位置误差与速度误差。
将上式与飞行机械臂动力学方程联立，我们可以得到飞行机械臂的控制力：
Figure BDA0002780617590000072
飞行机械臂末端执行器坐标系方向与机体坐标系方向一致，检测接触表面与末端执行器方向垂直，因此我们设置沿机械臂方向的期望质量为较低数值，以保证该方向的柔顺性，而其他方向表现出对扰动的鲁棒性。阻抗控制是通过对位置的控制间接完成力控制，操作者可以通过对飞行机械臂的位置控制进而控制交互检测的接触力。
步骤6：对力反馈手控器与飞行机械臂进行运动学映射。对力反馈手控器进行正运动学建模，人手控制力反馈手控器，经过低通滤波防抖动后，通过正运动学获取笛卡尔空间位姿增量，对其处理后(乘以相应系数和位姿映射矩阵)作为飞行机械臂的位姿命令信号。
步骤7：对接触检测采用遥操作控制。采用具有力觉临场感的遥操作对飞行机械臂的接触检测作业进行控制时，为保证接触检测的安全稳定，接触力由单轴力传感器测量获得。飞行机械臂末端的力传感器将检测环境的交互力传递到力反馈手控器，操作者可以同时根据力反馈信息调整力反馈手控器的位姿，进而调整飞行机械臂与环境的接触力，以安全高效的完成高空工业管道的无损检测。
本发明方案所公开的技术手段不仅限于上述实施方式所公开的技术手段，还包括由以上技术特征任意组合所组成的技术方案。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也视为本发明的保护范围。

Claims (10)

1.一种基于遥操作飞行机械臂的高空金属管道探伤系统，其特征在于，包括力反馈手控器(1-1)、主端计算机(1-2)、通信系统(1-3)、飞行机械臂(1-4)、单轴力传感器(1-5)、涡流探伤传感器(1-6)。
2.根据权利要求1所述的基于遥操作飞行机械臂的高空金属管道探伤系统，其特征在于：主端包含力反馈手控器(1-1)、主端计算机(1-2)以及通信设备(1-3)，从端包括飞行机械臂(1-4)，所述飞行机械臂(1-4)由全驱动六旋翼无人机与机械臂(2-2)组成，无人机的六个机臂末端安装六个电机置于机身内部，机械臂固连于全驱动无人机相邻两机臂之间，单轴力传感器(1-5)与涡流探伤传感器(1-6)置于机械臂末端。
3.根据权利要求1所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：包括以下步骤：
(1)构造飞行机械臂硬件系统；
(2)建立飞行机械臂运动学模型；
(3)建立飞行机械臂的动力学模型；
(4)设计控制分配矩阵；
(5)基于扰动观测器的阻抗控制器设计；
(6)对力反馈手控器与飞行机械臂进行运动学映射；
(7)对接触检测采用遥操作控制。
4.根据权利要求3所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：步骤(1)所述的构造飞行机械臂硬件系统：
对于全驱动六旋翼无人机本体，相对于传统的六旋翼，除了提供动力的螺旋桨六个电机外，六个机臂末端安装六个电机保证机臂可控倾转以提供更多的自由度，机械臂固连于全驱动无人机，单轴力传感器和涡流探伤传感器固连于机械臂末端。
5.根据权利要求3所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：步骤(2)所述的建立飞行机械臂运动学模型：
假设全驱动六旋翼为质量分布均匀的刚体，忽略其弹性形变，
Figure FDA0002780617580000011
为世界坐标系，
Figure FDA0002780617580000012
为以飞行机械臂重心为原点的机体坐标系；
Figure FDA0002780617580000013
表示飞行机械臂
Figure FDA0002780617580000014
在
Figure FDA0002780617580000015
下的位置矢量，v为机体在
Figure FDA0002780617580000016
的速度；Θ＝[ψ，θ，φ]T表示姿态向量，其中ψ是绕轴zb转动的偏航角，θ是按轴yb转动的俯仰角，φ是绕轴xb转动的滚转角；假设无人机不会有大机动运动，即
Figure FDA0002780617580000017
飞行机械臂的运动学方程如下：
Figure FDA0002780617580000021
其中ωb表示机体坐标系下的机体角速度，其中，
Figure FDA0002780617580000022
6.根据权利要求3所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：步骤(3)所述的建立飞行机械臂的动力学模型：
不考虑各螺旋桨产生气流相互影响的情况下，利用牛顿-欧拉法建立飞行机械臂的刚体动力学模型：
Figure FDA0002780617580000023
上式中下标b表示机体坐标系；
Figure FDA0002780617580000024
分别表示飞行机械臂的力和力矩；
Figure FDA0002780617580000025
分别表示飞行机械臂
Figure FDA0002780617580000026
在
Figure FDA0002780617580000027
下的速度和加速度；ωb，
Figure FDA0002780617580000028
分别表示飞行机械臂的角速度和角加速度；m，Jb分别表示飞行机械臂的质量与惯性。
7.根据权利要求3所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：步骤(4)所述的设计控制分配矩阵；
飞行机械臂的运动的力通过螺旋桨的转动产生，因此飞行机械臂的控制力和力矩与螺旋桨转速之间存在映射关系，对各个螺旋桨的转速控制即控制分配分配矩阵；在全驱动无人机机臂末端装有电机实现机臂倾转，控制分配矩阵是关于机臂倾转角度α的控制分配矩阵：
τact＝A(α)Ω。
8.根据权利要求3所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：步骤(5)所述的基于扰动观测器的阻抗控制器设计：
飞行机械臂，其动力学模型简化为：
Figure FDA0002780617580000029
其中，
Figure FDA00027806175800000210
分别为惯性矩阵与哥氏力矩阵；
Figure FDA00027806175800000211
分别为控制力与外部扰动力，
扰动观测器设计方法如下：
Figure FDA00027806175800000212
其中
Figure FDA00027806175800000213
为外部总扰动力的估计值，
进行检测接触时，飞行机械臂与高空工业管道闭环动力学方程简化为：
Figure FDA0002780617580000031
其中，Md，Kp，Kd分别为机器人的虚拟质量，刚度，以及阻尼；ex，ev分别为机体坐标系下飞行机械臂的位置误差与速度误差；
将上式与飞行机械臂动力学方程联立，得到飞行机械臂的控制力：
Figure FDA0002780617580000032
飞行机械臂末端执行器坐标系方向与机体坐标系方向一致，检测接触表面与末端执行器方向垂直，根据对柔顺型的要求，设置沿机械臂方向的期望质量，低期望质量对应高柔顺性，其他方向表现出对扰动的鲁棒性；阻抗控制是通过对位置的控制间接完成力控制，操作者通过对飞行机械臂的位置控制进而控制交互检测的接触力。
9.根据权利要求3所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：步骤(6)对力反馈手控器进行正运动学建模，人手控制力反馈手控器，经过低通滤波防抖动后，通过正运动学获取笛卡尔空间位姿增量，对其处理后作为飞行机械臂的位姿命令信号。
10.根据权利要求3所述的基于遥操作飞行机械臂的高空金属管道探伤系统的接触检测方法，其特征在于：步骤(7)所述的采用具有力觉临场感的遥操作对飞行机械臂的接触检测作业进行控制时，飞行机械臂末端的力传感器将检测环境的交互力传递到力反馈手控器，操作者根据力反馈信息调整力反馈手控器的位姿，进而调整飞行机械臂与环境的接触力，以安全高效的完成高空工业管道的无损检测。
CN202011280546.9A 2020-11-16 2020-11-16 一种基于遥操作飞行机械臂的高空金属管道探伤系统 Active CN112415086B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011280546.9A CN112415086B (zh) 2020-11-16 2020-11-16 一种基于遥操作飞行机械臂的高空金属管道探伤系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011280546.9A CN112415086B (zh) 2020-11-16 2020-11-16 一种基于遥操作飞行机械臂的高空金属管道探伤系统

Publications (2)

Publication Number Publication Date
CN112415086A true CN112415086A (zh) 2021-02-26
CN112415086B CN112415086B (zh) 2023-09-19

Family

ID=74831406

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011280546.9A Active CN112415086B (zh) 2020-11-16 2020-11-16 一种基于遥操作飞行机械臂的高空金属管道探伤系统

Country Status (1)

Country Link
CN (1) CN112415086B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113408646A (zh) * 2021-07-05 2021-09-17 上海交通大学 无人机的外部扰动分类方法及系统
CN113866194A (zh) * 2021-11-01 2021-12-31 太仓阿尔法数字科技有限公司 一种在役电力设备远程探伤器
CN116372964A (zh) * 2023-06-05 2023-07-04 西湖大学 具有可切换末端执行机构集的空中机器人系统
CN113866194B (zh) * 2021-11-01 2024-04-30 太仓阿尔法数字科技有限公司 一种在役电力设备远程探伤器

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104778872A (zh) * 2015-04-03 2015-07-15 上海交通大学 用于机械臂遥操作人机交互研究的仿真实验训练平台
CN104965516A (zh) * 2015-06-15 2015-10-07 东南大学 一种基于视觉和力反馈的四旋翼飞行器进行空中抓取作业的控制方法
CN106504605A (zh) * 2016-10-21 2017-03-15 东南大学 面向空间站机械臂力反馈遥操作训练的仿真控制系统
CN107650127A (zh) * 2017-08-25 2018-02-02 长沙理工大学 一种变电站金属部件探伤机器人及其应用方法
CN207309929U (zh) * 2017-10-31 2018-05-04 河南明华智能系统研究院有限公司 金刚石合成智能化装置
CN109514520A (zh) * 2018-11-28 2019-03-26 广东电网有限责任公司 一种高压带电作业主从机器人作业装置和方法
CN110667845A (zh) * 2019-09-27 2020-01-10 东南大学 一种面向阀门旋拧的双臂作业型飞行机器人系统及方法
CN111015673A (zh) * 2020-01-02 2020-04-17 福州大学 作业型飞行机器人的四自由度机械臂遥操作系统及方法
AU2020100930A4 (en) * 2019-07-03 2020-07-09 Wuhan University Of Science And Technology Quad-rotor uav-based autonomous inspection method for large storage tank

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104778872A (zh) * 2015-04-03 2015-07-15 上海交通大学 用于机械臂遥操作人机交互研究的仿真实验训练平台
CN104965516A (zh) * 2015-06-15 2015-10-07 东南大学 一种基于视觉和力反馈的四旋翼飞行器进行空中抓取作业的控制方法
CN106504605A (zh) * 2016-10-21 2017-03-15 东南大学 面向空间站机械臂力反馈遥操作训练的仿真控制系统
CN107650127A (zh) * 2017-08-25 2018-02-02 长沙理工大学 一种变电站金属部件探伤机器人及其应用方法
CN207309929U (zh) * 2017-10-31 2018-05-04 河南明华智能系统研究院有限公司 金刚石合成智能化装置
CN109514520A (zh) * 2018-11-28 2019-03-26 广东电网有限责任公司 一种高压带电作业主从机器人作业装置和方法
AU2020100930A4 (en) * 2019-07-03 2020-07-09 Wuhan University Of Science And Technology Quad-rotor uav-based autonomous inspection method for large storage tank
CN110667845A (zh) * 2019-09-27 2020-01-10 东南大学 一种面向阀门旋拧的双臂作业型飞行机器人系统及方法
CN111015673A (zh) * 2020-01-02 2020-04-17 福州大学 作业型飞行机器人的四自由度机械臂遥操作系统及方法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113408646A (zh) * 2021-07-05 2021-09-17 上海交通大学 无人机的外部扰动分类方法及系统
CN113866194A (zh) * 2021-11-01 2021-12-31 太仓阿尔法数字科技有限公司 一种在役电力设备远程探伤器
CN113866194B (zh) * 2021-11-01 2024-04-30 太仓阿尔法数字科技有限公司 一种在役电力设备远程探伤器
CN116372964A (zh) * 2023-06-05 2023-07-04 西湖大学 具有可切换末端执行机构集的空中机器人系统
CN116372964B (zh) * 2023-06-05 2024-02-20 西湖大学 具有可切换末端执行机构集的空中机器人系统

Also Published As

Publication number Publication date
CN112415086B (zh) 2023-09-19

Similar Documents

Publication Publication Date Title
Hamaza et al. Sensor installation and retrieval operations using an unmanned aerial manipulator
CN110667845B (zh) 一种面向阀门旋拧的双臂作业型飞行机器人系统及方法
Arleo et al. Control of quadrotor aerial vehicles equipped with a robotic arm
Lippiello et al. Cartesian impedance control of a UAV with a robotic arm
US6496765B1 (en) Control system and method for payload control in mobile platform cranes
Tavakoli et al. 3DCLIMBER: A climbing robot for inspection of 3D human made structures
Lima et al. POLIBOT–power lines inspection robot
CN112394739B (zh) 主动变形四旋翼飞行器自抗扰飞行控制方法
Tavakoli et al. Development of an industrial pipeline inspection robot
CN110666794B (zh) 一种机器人末端工具负载力和力矩补偿的方法
CN112415086A (zh) 一种基于遥操作飞行机械臂的高空金属管道探伤系统
Fumagalli et al. Mechatronic design of a robotic manipulator for unmanned aerial vehicles
Li et al. Dynamic modelling and control of a tendon-actuated lightweight space manipulator
BostelMan et al. RoboCrane [R] project: an advanced concept for large scale manufacturing
Hancer et al. Designing 3-DOF hardware-in-the-loop test platform controlling multirotor vehicles
Endo et al. A proposal of super long reach articulated manipulator with gravity compensation using thrusters
Ouyang et al. Control of an aerial manipulator using a quadrotor with a replaceable robotic arm
González-Morgado et al. Fully-actuated, corner contact aerial robot for inspection of hard-to-reach bridge areas
Cocuzza et al. Dynamic interaction between robot and UAV in aerial manipulation
Omar et al. Robust active force control of a quadcopter
Li et al. Overview of the Chinese space station manipulator
Anuar et al. Super-twisting sliding mode control with adaptive gain of quadrotor with rigid manipulator
Jenkins Telerobotic work system-space robotics application
Zhang et al. Design and implementation of a novel aerial manipulator with tandem ducted fans
Tsuchiya et al. Contact force control of dual-rotor helicopter with protect frame

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