CN110949684A - 基于机械灵巧抓手式***的低速无人机空基回收*** - Google Patents
基于机械灵巧抓手式***的低速无人机空基回收*** Download PDFInfo
- Publication number
- CN110949684A CN110949684A CN201911274706.6A CN201911274706A CN110949684A CN 110949684 A CN110949684 A CN 110949684A CN 201911274706 A CN201911274706 A CN 201911274706A CN 110949684 A CN110949684 A CN 110949684A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- coordinate system
- subsystem
- recovery
- 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.)
- Pending
Links
- 238000011084 recovery Methods 0.000 title claims abstract description 80
- 230000000007 visual effect Effects 0.000 claims abstract description 32
- 238000005259 measurement Methods 0.000 claims abstract description 11
- 239000000463 material Substances 0.000 claims abstract description 10
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 7
- 230000033001 locomotion Effects 0.000 claims description 29
- 230000009977 dual effect Effects 0.000 claims description 18
- 238000000034 method Methods 0.000 claims description 12
- 230000008878 coupling Effects 0.000 claims description 11
- 238000010168 coupling process Methods 0.000 claims description 11
- 238000005859 coupling reaction Methods 0.000 claims description 11
- 230000008859 change Effects 0.000 claims description 7
- 238000013519 translation Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 4
- 238000013459 approach Methods 0.000 claims description 3
- 238000004891 communication Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 claims description 3
- 230000004927 fusion Effects 0.000 claims description 3
- 230000008595 infiltration Effects 0.000 claims description 3
- 238000001764 infiltration Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000007781 pre-processing Methods 0.000 claims description 2
- 238000004064 recycling Methods 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 230000015572 biosynthetic process Effects 0.000 description 8
- 238000006243 chemical reaction Methods 0.000 description 5
- 238000013016 damping Methods 0.000 description 3
- 230000007123 defense Effects 0.000 description 3
- 238000013461 design Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 238000012938 design process Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000006835 compression Effects 0.000 description 1
- 238000007906 compression Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64F—GROUND OR AIRCRAFT-CARRIER-DECK INSTALLATIONS SPECIALLY ADAPTED FOR USE IN CONNECTION WITH AIRCRAFT; DESIGNING, MANUFACTURING, ASSEMBLING, CLEANING, MAINTAINING OR REPAIRING AIRCRAFT, NOT OTHERWISE PROVIDED FOR; HANDLING, TRANSPORTING, TESTING OR INSPECTING AIRCRAFT COMPONENTS, NOT OTHERWISE PROVIDED FOR
- B64F1/00—Ground or aircraft-carrier-deck installations
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64F—GROUND OR AIRCRAFT-CARRIER-DECK INSTALLATIONS SPECIALLY ADAPTED FOR USE IN CONNECTION WITH AIRCRAFT; DESIGNING, MANUFACTURING, ASSEMBLING, CLEANING, MAINTAINING OR REPAIRING AIRCRAFT, NOT OTHERWISE PROVIDED FOR; HANDLING, TRANSPORTING, TESTING OR INSPECTING AIRCRAFT COMPONENTS, NOT OTHERWISE PROVIDED FOR
- B64F1/00—Ground or aircraft-carrier-deck installations
- B64F1/04—Ground or aircraft-carrier-deck installations for launching aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/12—Target-seeking control
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Mechanical Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
基于机械灵巧抓手式***的低速无人机空基回收***，涉及低速无人机空基回收领域，针对现有技术中针对小型固定翼无人机空中回收效率低的问题，包括：双立柱桁架机器人子***、循环料库子***、机械灵巧抓手子***、视觉导航子***和回收控制子***；所述双立柱桁架机器人子***和机械灵巧抓手子***用于对无人机进行捕捉；所述循环料库子***用于载机机舱内无人机的回收和码垛；所述视觉导航子***用于获取视觉传感器的测量数据，并根据该数据得到飞行控制***所需的导航数据；所述回收控制子***用于控制无人机的飞行姿态和飞行轨迹。本发明提出的机械灵巧抓手回收方案中两只机械手臂可以交替进行无人机捕捉工作，提高无人机群的回收效率。
Description
技术领域
本发明涉及低速无人机空基回收领域，具体为一种基于机械灵巧抓手式***的低速无人机空基回收***。
背景技术
随着防空体系的发展，以提高作战效率的协同作战模式受到越来越多的重视，其中蜂群式无人机协同作战***可以饱和敌人防空，更容易突破敌人的防线，成为未来无人机协同作战的作战模式。而小型固定翼无人机由于质量小、作战半径有限，成为制约蜂群无人机协同作战发展的障碍，为了解决上述问题，就要求小型固定翼无人机具有空中可回收功能，因此，蜂群式无人机作战***要求提高小型固定翼无人机空中回收效率，实现空中快速回收无人机。全球现阶段的固定翼无人机空中回收技术仍然处于较低水平，回收效率很低，影响无人机的作战效能。所以开展固定翼低速无人机空中回收方案论证及设计研究有十分重要的意义。国际上小型固定翼低速无人机的空中回收方式主要包括刚性回收和柔性回收。刚性回收主要包括：空中钩取回收、机械臂抓取回收、空中网回收和空中托盘回收等，但大多处于方案阶段；柔性回收主要是缆绳浮标回收方式，该方案目前正处于理论分析和数值仿真阶段。
发明内容
本发明的目的是：针对现有技术中针对小型固定翼无人机空中回收效率低的问题，提出一种基于机械灵巧抓手式***的低速无人机空基回收***。
本发明为了解决上述技术问题采取的技术方案是：
基于机械灵巧抓手式***的低速无人机空基回收***，包括：双立柱桁架机器人子***、循环料库子***、机械灵巧抓手子***、视觉导航子***和回收控制子***；
所述双立柱桁架机器人子***和机械灵巧抓手子***用于对无人机进行捕捉；
所述循环料库子***用于载机机舱内无人机的回收和码垛；
所述视觉导航子***用于获取视觉传感器的测量数据，并根据该数据得到飞行控制***所需的导航数据；
所述回收控制子***用于控制无人机的飞行姿态和飞行轨迹。
进一步的，所述双立柱桁架机器人子***包括横移轴模块、竖直轴模块和抓手模块，所述横移轴模块采用齿轮齿条驱动横向移动，竖轴模块采用多层叉臂结构，所述机械灵巧抓手模块与竖轴模块相连。
进一步的，所述视觉导航子***包括设置在无人机机机体上的位姿识别辅助标志、设置在载机上的CCD摄像机及设置在CCD摄像机上的850mm近红外滤波片、视觉导航计算机和综合导航计算机；
所述位姿识别辅助标志由5个850mm近红外LED组成；
所述视觉导航计算机用于图像信号的处理以及位姿参数的计算，所述综合导航计算机用于接收GPS模块、惯性测量元件传感器的测量数据，并将该数据与视觉导航计算机处理结果进行数据融合，得到无人机飞行控制***所需的导航数据，该数据经由通讯链路传送至无人机。
进一步的，所述视觉导航子***的执行如下操作：
S1、利用CCD摄像机及850mm近红外滤波片获取待测目标图像；
S2、利用视觉导航计算机对获取的图像进行预处理；
S3、利用视觉导航计算机对预处理后的图像进行无人机的特征点提取；
S4、利用视觉导航计算机判断获取的特征点是否满足位姿估计要求，若满足则执行S5；若不满足则执行S1；
S5、利用视觉导航计算机根据获取的特征点进行无人机的位姿与姿态的估计。
进一步的，所述回收控制子***的设计过程如下：
步骤一：建立无人机机体坐标系下位置姿态耦合对偶四元数动力学方程；
步骤二：利用快速非奇异终端滑模技术设计控制器。
进一步的，所述步骤一具体包括以下步骤：
步骤一一：对无人机位姿耦合运动学和动力学方程建立所需坐标系定义；
步骤一二：建立无人机机体坐标系下质心运动学模型；
步骤一三：建立无人机机体坐标系下绕质心转动的运动学方程；
步骤一四：建立无人机机体坐标系下质心运动的动力学方程；
步骤一五:建立无人机机体坐标系下绕质心转动的动力学方程；
步骤一六：根据步骤一一至步骤一五得到描述无人机的空间运动方程组，并运用对偶四元数求解位姿耦合动力学方程。
进一步的，所述步骤一一的详细步骤为：
步骤一一一、地面坐标系：
Axyz，A是发射点即起飞时刻无人机质心所在的位置，Ax是在包含了地球质心、A点，目标点T的地球大圆内，与该地球大圆相切，指向目标方向为正，Ay是在OeAT平面内，过A点垂直与Ax指向上为正，Az轴与其它两个轴垂直并构成右手坐标系；
步骤一一二、机体坐标系：
Oxbybzb，O位于飞行器的质心，Oxb轴在飞行器对称平面内，平行于机身轴线或机翼的平均气动弦线，指向前为正，Ozb轴亦在对称平面内，垂直于Oxb轴指向下为正，Oyb轴与其它两个轴垂直并构成右手坐标系；
步骤一一三、气流坐标系：
Oxayaza，气流坐标系又称速度坐标系，O位于飞行器质心，Oxa轴始终指向飞行器的空速方向，Oza轴位于对称平面内，垂直于Oxa轴，指向下为正，Oya轴与其它两个轴垂直并构成右手坐标系；
步骤一一四、航迹坐标系：
Oxkykzk，航迹坐标系又称弹道固连坐标系，O位于飞行器质心，Oxk轴始终指向飞行器的地速方向，Ozk轴位于包含Oxk轴铅垂面内，垂直于Oxk轴，指向下为正，Oyk轴与其它两个轴垂直并构成右手坐标系。
进一步的，所述步骤一二中无人机机体坐标系下质心运动学模型的表达式为：
展开后为：
其中，
为机体坐标系与地面坐标系之间的转换矩阵，人机飞行速度在机体坐标系下的表示为[u,v,w]T；
所述步骤一三中无人机机体坐标系下绕质心转动的运动学方程的表达式为：
展开后得：
所述步骤一四中无人机机体坐标系下质心运动的动力学方程的表达式为：
其中，
Cx0是零升阻力，
是攻角变化所产生的诱导阻力系数，
是侧滑角变化所产生的诱导阻力系数，Cy0是攻角为零时的升力系数，
是升力系数关于攻角的偏导数，
为升力系数关于z方向舵偏的偏导数，
为侧向力关于侧滑角的偏导数，
为侧向力关于z方向的舵偏的偏导数，
表示动压大小，ρ为空气密度，在无人机飞行高度变化不大的情况下可视为常值，S为无人机浸润面积。
进一步的，所述步骤一五中无人机机体坐标系下绕质心转动的动力学方程的表达式为：
所述步骤一六中描述无人机的空间运动方程组表达式为：
对偶四元数动力学方程：
其中，
表示一般性刚体运动，先转动qb接着平动pb，该运动的角速度记为ξb，ε为幂零项，即ε2＝0,ε≠0，pb，ξb是在本体坐标系下表示的平动和角速度；
pb＝(x y z)T,qb＝(θ ψ φ)T,ξb＝(0 p q r)T,
结合上述无人机空间运动方程组，可得
其中，
运用单位对偶四元数理论可以将上述运动方程组改写为：
M＝[ε J-1C+εA]；
基于对偶四元数跟踪误差以及速度旋量跟踪误差可以得到无人机的误差运动学和动力学方程：
进一步展开整理为：
进一步的，所述步骤二中控制器的表达式为：
若
或
成立，则上式变为快速终端滑模面，即
将不断趋近于原点，且该收敛过程将持续到
和
均成立时结束。
本发明的有益效果是：
(1)由于机械灵巧抓手直接锁定无人机上方的矩形架，因此抓捕过程对无人机无损伤，特别适合重量较轻的无人机的抓取，该结构还可以用于无人机发射，并且无其他附件无人机回收后占地空间小。
(2)本发明提出的机械灵巧抓手回收方案中两只机械手臂可以交替进行无人机捕捉工作，提高无人机群的回收效率。
(3)安装于载机的姿态测量单元将测得的载机姿态数据反馈给伺服控制器，控制伺服台的运动，补偿由于载机自身对回收装置的干扰，达到对回收装置的增稳效果。
(4)建立无人机机体坐标系下位置姿态耦合对偶四元数动力学方程，并通过快速非奇异终端滑模对控制器进行设计，实现无人机有限时间对载机位姿跟踪，控制无人机以预设姿态到达无人机回收区域，进而实现对无人机的精准回收。
附图说明
图1为机械灵巧抓手抓取原理图；
图2为无人机回收阶段示意图；
图3为桁架机器人子***原理图；
图4为视觉导航***的工作流程图；
其中，1为双立柱桁架机器人子***，2为循环料库子***，3为机械灵巧抓手子***。
具体实施方式
具体实施方式一：参照图1具体说明本实施方式，本实施方式所述的基于机械灵巧抓手式***的低速无人机空基回收***，包括：双立柱桁架机器人子***、循环料库子***、机械灵巧抓手子***、视觉导航子***和回收控制子***；
所述双立柱桁架机器人子***和机械灵巧抓手子***用于对无人机进行捕捉；
所述循环料库子***用于载机机舱内无人机的回收和码垛；
所述视觉导航子***用于获取视觉传感器的测量数据，并根据该数据得到飞行控制***所需的导航数据；
所述回收控制子***用于控制无人机的飞行姿态和飞行轨迹。
本发明回收装置包括双立柱桁架机器人子***(如图3所示)、循环料库子***、机械灵巧抓手子***、视觉导航子***(工作流程图如图4所示)、回收控制子***、待回收无人机等。其中，所述桁架机器人子***由横移轴、竖直轴、抓手等模块构成，横移轴采用齿轮齿条驱动横向移动，竖轴采用多层叉臂结构。所述机械灵巧抓手子***与双立柱桁架机器人子***的竖轴相连，当执行无人机回收任务时，载机舱门打开，与竖轴相连的机械灵巧抓手式捕捉器完成对无人机的捕捉。所述循环料库子***起到载机机舱内的无人机高效回收和码垛的作用，所述视觉导航子***由安装在无人机机头的辅助标识标志、安装在载机上的一台CCD摄像机及850mm近红外滤波片、视觉导航计算机、综合导航计算机等构成，所述辅助识别标志由2个850mm近红外LED组成，所述视觉导航计算机用于图像信号的处理以及位姿参数的计算，所述综合导航计算机用于接收GPS模块、惯性测量元件等传感器的测量数据，并将该数据与视觉导航计算机处理结果进行数据融合，得到飞行控制***所需的导航数据。该数据经由通讯链路传送至无人机，从而无人机控制自身按照预设轨迹飞行，实现准确回收。所述回收控制子***一方面用于控制无人机的飞行姿态和飞行轨迹另一方面起到对回收装置的增稳效果，在对无人机飞行姿态和飞行轨迹的控制上，借助于对偶四元数以及无人机体坐标系下的位姿耦合模型，实现低速无人机对载机位置和姿态的协同，并满足回收时刻，无人机飞行速度与载机巡航速度相同，通过快速非奇异终端滑模对***的稳定性进行了证明。
所述双立柱桁架机器人子***的竖轴采用多层叉臂结构，压缩比可达10以上，极大地提高了空间利用率。
所述桁架机器人子***的竖轴长度受到载机机舱高度、无人机自身尺寸以及载机尾流对无人机的干扰限制，为了确定对桁架机器人子***的数轴长度，建立了桁架机器人子***动力学模型，对方案进行了动力学特性仿真。基于仿真结果，本发明中的桁架机器人子***的竖轴长度设定为10米。
所述机械灵巧抓手式回收装置的回收速率设定为每分钟不少于一架无人机。
所述待回收无人机的翼展尺寸，或机身长度不超过载机舱门最大截面尺寸。无人机的飞行速度应大于载机巡航飞行速度。
所述无人机回收过程分为四个阶段，分别为大范围初始对准阶段、密集编队飞行阶段、预回收阶段与空中回收阶段，在大范围初始对准阶段，载机和无人机通过一定预先约定方式各自进入指定空域，并完成初始对准。密集编队飞行阶段，根据任务规划要求，确定好无人机回收次序，并以密集编队飞行方式进入等待状态，无人机集群保持密集编队飞行。本发明主要针对无人机空中回收任务的预回收阶段和空中回收阶段进行研究。如图2所示。
所述回收控制子***在无人机机体坐标系下建立无人机位姿耦合运动学和动力学方程，运用对偶四元数将上述方程转为对偶四元数动力学方程，并借助于快速非奇异终端滑模设计满足控制要求的控制器，基于Lyapunov函数完成了***稳定性的证明。
所述回收控制子***设计过程如下：
(1)无人机位姿耦合运动学和动力学方程建立所需坐标系定义
1.1)地面坐标系
Axyz，A是发射点即起飞时刻无人机质心所在的位置，Ax是在包含了地球质心、A点，目标点T的地球大圆内，与该地球大圆相切，指向目标方向为正，Ay是在OeAT平面内，过A点垂直与Ax指向上为正。Az轴与其它两个轴垂直并构成右手坐标系。
1.2)机体坐标系
Oxbybzb，O位于飞行器的质心，Oxb轴在飞行器对称平面内，平行于机身轴线或机翼的平均气动弦线，指向前为正，Ozb轴亦在对称平面内，垂直于Oxb轴指向下为正，Oyb轴与其它两个轴垂直并构成右手坐标系。
1.3)气流坐标系
Oxayaza，气流坐标系又称速度坐标系，O位于飞行器质心，Oxa轴始终指向飞行器的空速方向，Oza轴位于对称平面内，垂直于Oxa轴，指向下为正，Oya轴与其它两个轴垂直并构成右手坐标系。
1.4)航迹坐标系
Oxkykzk，航迹坐标系又称弹道固连坐标系，O位于飞行器质心，Oxk轴始终指向飞行器的地速方向，Ozk轴位于包含Oxk轴铅垂面内，垂直于Oxk轴，指向下为正，Oyk轴与其它两个轴垂直并构成右手坐标系
(2)无人机机体坐标系下质心运动学模型
无人机飞行速度在机体坐标系下的表示为[u,v,w]T，[x,y,z]T为在地面坐标系下的无人机坐标，建立无人机质心相对于地面坐标系Axyz的位置方程如下：
展开后得到：
(3)无人机机体坐标系下绕质心转动的运动学方程
无人机旋转角速度在机体坐标系下的表示为[p,q,r]T，在空间的姿态角表示为[θ,ψ,φ]T，建立无人机质心相对于地面坐标系的转动动力学方程如下：
展开后得：
(4)无人机机体坐标系下质心运动的动力学方程
由牛顿第二定理：
Ω,V在机体坐标系下表示为[p,q,r]T,[u,v,w]T，F为除去推力外无人机所有外力和，包括总空气动力R、重力G等，作用在无人机上的总空气动力R在气流坐标系下可分解为阻力X、升力Y、侧向力Z，根据气流坐标系与机体坐标系的转换关系，可得：
作用在无人机上的重力G在地面坐标系下沿着Ay的负轴，根据地面坐标系与机体坐标系的转换关系，可得：
作用在无人机体系下的推力P＝[P,0,0]T
展开整理后可得无人机质心运动的动力学方程为：
其中，
Cx0是零升阻力，
是攻角变化所产生的诱导阻力系数，
是侧滑角变化所产生的诱导阻力系数。Cy0是攻角为零时的升力系数，
是升力系数关于攻角的偏导数，
为升力系数关于z方向舵偏的偏导数。
为侧向力关于侧滑角的偏导数，
为侧向力关于z方向的舵偏的偏导数。
表示动压大小，ρ为空气密度，在无人机飞行高度变化不大的情况下可视为常值。S为无人机浸润面积。
(5)无人机机体坐标系下绕质心转动的动力学方程
在机体坐标系下建立无人机绕质心转动的动力学方程，由动量矩守恒定理：
假设机体坐标系即为惯性主轴系，即机体坐标系各轴的惯性积为零，以Jx,Jy,Jz表示机体轴的转动惯量。在体系下，
M＝[Mx,My,Mz]为作用于无人机机体轴坐标系下的力矩分量。Ω×H＝[(Jz-Jy)qr,(Jx-Jz)pr,(Jy-Jx)pq]T，MP为由于发动机偏心安装产生的干扰力矩，尾喷管或者侧力发动机产生的主动力矩，在本研究中默认MP可以忽略。
其中，
上式展开整理后可得无人机绕质心转动动力学方程：
综上，即组成描述无人机的空间运动方程组：
(6)运用对偶四元数求解位姿耦合动力学方程
对偶四元数动力学方程：
其中，
表示一般性刚体运动，先转动qb接着平动pb，该运动的角速度记为ξb，ε为幂零项，即ε2＝0,ε≠0，pb，ξb是在本体坐标系下表示的平动和角速度。
pb＝(x y z)T,qb＝(θ ψ φ)T,ξb＝(0 p q r)T,
结合上述无人机空间运动方程组，可得
其中，
运用单位对偶四元数理论可以将上述运动方程组改写为：
M＝[ε J-1C+εA]
对于无人机位姿一体化的跟踪控制问题，其控制目标是：设计控制器使得无人机的运动状态
渐进收敛于期望的运动状态
对偶四元数跟踪误差
速度旋量误差为
因此控制器的设计目标转为使无人机的跟踪误差
渐进收敛于
基于对偶四元数跟踪误差以及速度旋量跟踪误差可以得到无人机的误差运动学和动力学方程：
进一步展开整理为：
(7)设计基于快速非奇异终端滑模的位姿跟踪控制：
构造滑模面
i＝1,2,3
其中，k＝1,2,3,α1＞0,α2＞0,r1＝(2-γ)ηγ-1,r2＝(γ-1)ηγ-2，0＜γ＜1以及0＜η＜1，
符号⊙的定义为：
设计如下控制器：
其中，
为关于
的饱和函数，K＝[K1,K2,K3]T＞0
分析控制器的稳定性，定义Lyapunov函数：
由
i＝1,2,3，设计
对上式求导得：
将控制器u带入得
其中，
由定理：设***y＝f(x)，其中
若存在连续可微的正定函数V(x)，其定义域为
且存在参数a＞0,0＜ρ＜1，使得
成立。则存在某区域
使得初始时刻位于
中的V(x)能在有限时间内到达V(x)≡0。此外，V(x)≡0的到达时间T为：
因此所设计V(x)将在有限时间内收敛到零。
当V(x)≡0时，
即
i＝1,2,3，
因此在收敛过程中
始终有界，并且存在
k＝1,2,3使得
成立，则如下关系式成立：
上式可以重写为如下两种形式：
若
或
成立，则上式变为快速终端滑模面，即
将不断趋近于原点，且该收敛过程将持续到
和
均成立时结束，因此
和
将在有限时间内收敛到原点的领域。
所述无人机回收过程分为四个阶段，分别为大范围初始对准阶段、密集编队飞行阶段、预回收阶段与空中回收阶段，在大范围初始对准阶段，载机和无人机通过一定预先约定方式各自进入指定空域，并完成初始对准。密集编队飞行阶段，根据任务规划要求，确定好无人机回收次序，并以密集编队飞行方式进入等待状态，无人机集群保持密集编队飞行。本方案主要针对无人机空中回收任务的预回收阶段和空中回收阶段进行研究。
需要注意的是，具体实施方式仅仅是对本发明技术方案的解释和说明，不能以此限定权利保护范围。凡根据本发明权利要求书和说明书所做的仅仅是局部改变的，仍应落入本发明的保护范围内。
Claims (10)
1.基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于包括：双立柱桁架机器人子***、循环料库子***、机械灵巧抓手子***、视觉导航子***和回收控制子***；
所述双立柱桁架机器人子***和机械灵巧抓手子***用于对无人机进行捕捉；
所述循环料库子***用于载机机舱内无人机的回收和码垛；
所述视觉导航子***用于获取视觉传感器的测量数据，并根据该数据得到飞行控制***所需的导航数据；
所述回收控制子***用于控制无人机的飞行姿态和飞行轨迹。
2.根据权利要求1所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述双立柱桁架机器人子***包括横移轴模块、竖直轴模块和抓手模块，所述横移轴模块采用齿轮齿条驱动横向移动，竖轴模块采用多层叉臂结构，所述机械灵巧抓手模块与竖轴模块相连。
3.根据权利要求1所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述视觉导航子***包括设置在无人机机机体上的位姿识别辅助标志、设置在载机上的CCD摄像机及设置在CCD摄像机上的850mm近红外滤波片、视觉导航计算机和综合导航计算机；
所述位姿识别辅助标志由5个850mm近红外LED组成；
所述视觉导航计算机用于图像信号的处理以及位姿参数的计算，所述综合导航计算机用于接收GPS模块、惯性测量元件传感器的测量数据，并将该数据与视觉导航计算机处理结果进行数据融合，得到无人机飞行控制***所需的导航数据，该数据经由通讯链路传送至无人机。
4.根据权利要求3所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述视觉导航子***的执行如下操作：
S1、利用CCD摄像机及850mm近红外滤波片获取待测目标图像；
S2、利用视觉导航计算机对获取的图像进行预处理；
S3、利用视觉导航计算机对预处理后的图像进行无人机的特征点提取；
S4、利用视觉导航计算机判断获取的特征点是否满足位姿估计要求，若满足则执行S5；若不满足则执行S1；
S5、利用视觉导航计算机根据获取的特征点进行无人机的位姿与姿态的估计。
5.根据权利要求1所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述回收控制子***的设计过程如下：
步骤一：建立无人机机体坐标系下位置姿态耦合对偶四元数动力学方程；
步骤二：利用快速非奇异终端滑模技术设计控制器。
6.根据权利要求5所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述步骤一具体包括以下步骤：
步骤一一：对无人机位姿耦合运动学和动力学方程建立所需坐标系定义；
步骤一二：建立无人机机体坐标系下质心运动学模型；
步骤一三：建立无人机机体坐标系下绕质心转动的运动学方程；
步骤一四：建立无人机机体坐标系下质心运动的动力学方程；
步骤一五:建立无人机机体坐标系下绕质心转动的动力学方程；
步骤一六：根据步骤一一至步骤一五得到描述无人机的空间运动方程组，并运用对偶四元数求解位姿耦合动力学方程。
7.根据权利要求6所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述步骤一一的详细步骤为：
步骤一一一、地面坐标系：
Axyz，A是发射点即起飞时刻无人机质心所在的位置，Ax是在包含了地球质心、A点，目标点T的地球大圆内，与该地球大圆相切，指向目标方向为正，Ay是在OeAT平面内，过A点垂直与Ax指向上为正，Az轴与其它两个轴垂直并构成右手坐标系；
步骤一一二、机体坐标系：
Oxbybzb，O位于飞行器的质心，Oxb轴在飞行器对称平面内，平行于机身轴线或机翼的平均气动弦线，指向前为正，Ozb轴亦在对称平面内，垂直于Oxb轴指向下为正，Oyb轴与其它两个轴垂直并构成右手坐标系；
步骤一一三、气流坐标系：
Oxayaza，气流坐标系又称速度坐标系，O位于飞行器质心，Oxa轴始终指向飞行器的空速方向，Oza轴位于对称平面内，垂直于Oxa轴，指向下为正，Oya轴与其它两个轴垂直并构成右手坐标系；
步骤一一四、航迹坐标系：
Oxkykzk，航迹坐标系又称弹道固连坐标系，O位于飞行器质心，Oxk轴始终指向飞行器的地速方向，Ozk轴位于包含Oxk轴铅垂面内，垂直于Oxk轴，指向下为正，Oyk轴与其它两个轴垂直并构成右手坐标系。
8.根据权利要求7所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述步骤一二中无人机机体坐标系下质心运动学模型的表达式为：
展开后为：
其中，
为机体坐标系与地面坐标系之间的转换矩阵，人机飞行速度在机体坐标系下的表示为[u,v,w]T；
所述步骤一三中无人机机体坐标系下绕质心转动的运动学方程的表达式为：
展开后得：
所述步骤一四中无人机机体坐标系下质心运动的动力学方程的表达式为：
其中，
Cx0是零升阻力，
是攻角变化所产生的诱导阻力系数，
是侧滑角变化所产生的诱导阻力系数，Cy0是攻角为零时的升力系数，
是升力系数关于攻角的偏导数，
为升力系数关于z方向舵偏的偏导数，
为侧向力关于侧滑角的偏导数，
为侧向力关于z方向的舵偏的偏导数，
表示动压大小，ρ为空气密度，在无人机飞行高度变化不大的情况下可视为常值，S为无人机浸润面积。
9.根据权利要求8所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述步骤一五中无人机机体坐标系下绕质心转动的动力学方程的表达式为：
所述步骤一六中描述无人机的空间运动方程组表达式为：
对偶四元数动力学方程：
其中，
表示一般性刚体运动，先转动qb接着平动pb，该运动的角速度记为ξb，ε为幂零项，即ε2＝0,ε≠0，pb，ξb是在本体坐标系下表示的平动和角速度；
pb＝(x y z)T,qb＝(θ ψ φ)T,ξb＝(0 p q r)T,
结合上述无人机空间运动方程组，可得
其中，
运用单位对偶四元数理论可以将上述运动方程组改写为：
M＝[ε J-1C+εA]；
基于对偶四元数跟踪误差以及速度旋量跟踪误差可以得到无人机的误差运动学和动力学方程：
进一步展开整理为：
10.根据权利要求9所述的基于机械灵巧抓手式***的低速无人机空基回收***，其特征在于所述步骤二中控制器的表达式为：
若
或
成立，则上式变为快速终端滑模面，即
将不断趋近于原点，且该收敛过程将持续到
和
均成立时结束。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911274706.6A CN110949684A (zh) | 2019-12-12 | 2019-12-12 | 基于机械灵巧抓手式***的低速无人机空基回收*** |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911274706.6A CN110949684A (zh) | 2019-12-12 | 2019-12-12 | 基于机械灵巧抓手式***的低速无人机空基回收*** |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN110949684A true CN110949684A (zh) | 2020-04-03 |
Family
ID=69981186
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911274706.6A Pending CN110949684A (zh) | 2019-12-12 | 2019-12-12 | 基于机械灵巧抓手式***的低速无人机空基回收*** |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110949684A (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113867394A (zh) * | 2021-10-20 | 2021-12-31 | 中国人民解放军国防科技大学 | 一种无人机集群回收仿真***、方法、电子设备及介质 |
| CN113879537A (zh) * | 2021-11-03 | 2022-01-04 | 南京航空航天大学 | 一种无人机空基回收装置及方法 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106892129A (zh) * | 2017-03-22 | 2017-06-27 | 哈尔滨工业大学 | 一种小型固定翼无人机回收*** |
| CN108791937A (zh) * | 2018-06-12 | 2018-11-13 | 吉林大学 | 基于机械抓取的车载旋翼无人机回收装置及方法 |
| US20190126478A1 (en) * | 2017-07-28 | 2019-05-02 | The Government Of The United States Of America, As Represented By The Secretary Of The Navy | Method and Apparatus for Robotic Launch and Capture of a UAV |
| CN109747851A (zh) * | 2017-11-07 | 2019-05-14 | 中国科学院沈阳自动化研究所 | 一种小型固定翼无人机回收*** |
| CN110329530A (zh) * | 2019-07-22 | 2019-10-15 | 黑龙江大学 | 一种弹射网捕捉式空中低速无人机回收装置 |
| CN110347173A (zh) * | 2019-08-21 | 2019-10-18 | 哈尔滨工业大学 | 一种基于非连续自适应控制的航天器姿态跟踪控制方法 |
-
2019
- 2019-12-12 CN CN201911274706.6A patent/CN110949684A/zh active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106892129A (zh) * | 2017-03-22 | 2017-06-27 | 哈尔滨工业大学 | 一种小型固定翼无人机回收*** |
| US20190126478A1 (en) * | 2017-07-28 | 2019-05-02 | The Government Of The United States Of America, As Represented By The Secretary Of The Navy | Method and Apparatus for Robotic Launch and Capture of a UAV |
| CN109747851A (zh) * | 2017-11-07 | 2019-05-14 | 中国科学院沈阳自动化研究所 | 一种小型固定翼无人机回收*** |
| CN108791937A (zh) * | 2018-06-12 | 2018-11-13 | 吉林大学 | 基于机械抓取的车载旋翼无人机回收装置及方法 |
| CN110329530A (zh) * | 2019-07-22 | 2019-10-15 | 黑龙江大学 | 一种弹射网捕捉式空中低速无人机回收装置 |
| CN110347173A (zh) * | 2019-08-21 | 2019-10-18 | 哈尔滨工业大学 | 一种基于非连续自适应控制的航天器姿态跟踪控制方法 |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113867394A (zh) * | 2021-10-20 | 2021-12-31 | 中国人民解放军国防科技大学 | 一种无人机集群回收仿真***、方法、电子设备及介质 |
| CN113867394B (zh) * | 2021-10-20 | 2024-01-26 | 中国人民解放军国防科技大学 | 一种无人机集群回收仿真***、方法、电子设备及介质 |
| CN113879537A (zh) * | 2021-11-03 | 2022-01-04 | 南京航空航天大学 | 一种无人机空基回收装置及方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107368091B (zh) | 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 | |
| Guenard et al. | A practical visual servo control for an unmanned aerial vehicle | |
| Çetinsoy et al. | Design and construction of a novel quad tilt-wing UAV | |
| CN109895099B (zh) | 一种基于自然特征的飞行机械臂视觉伺服抓取方法 | |
| Herisse et al. | Hovering flight and vertical landing control of a VTOL unmanned aerial vehicle using optical flow | |
| CN108248845A (zh) | 一种基于动态重心补偿的旋翼飞行机械臂***及算法 | |
| CN110427043B (zh) | 基于作业飞行机器人重心偏移的位姿控制器设计方法 | |
| Bai et al. | Robust control of quadrotor unmanned air vehicles | |
| CN109116860B (zh) | 三旋翼无人机的非线性鲁棒控制方法 | |
| CN108873929B (zh) | 一种固定翼飞机自主着舰方法及*** | |
| CN107491083B (zh) | 一种基于饱和自适应滑模控制的四旋翼自主着船方法 | |
| Pan et al. | Development of vision stabilizing system for a large-scale flapping-wing robotic bird | |
| CN110329530B (zh) | 一种弹射网捕捉式空中低速无人机回收装置 | |
| CN110949684A (zh) | 基于机械灵巧抓手式***的低速无人机空基回收*** | |
| CN110162078A (zh) | 一种牵引式无人机空中回收***及姿态控制方法 | |
| CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
| Garcia et al. | Attitude stabilization with real-time experiments of a tail-sitter aircraft in horizontal flight | |
| CN106569502A (zh) | 多旋翼飞行器抓捕目标后的复合体姿态自适应控制方法 | |
| CN115431271A (zh) | 一种飞行机械臂末端抗干扰指向控制方法 | |
| CN113580127B (zh) | 一种多旋翼飞行器仿人双机械臂***及其动态自平衡控制设计方法 | |
| CN113879537B (zh) | 一种无人机空基回收装置及方法 | |
| Zhang et al. | Quadrotor aircraft control without velocity measurements | |
| Ali et al. | Modeling and controlling the dynamic behavior of an aerial manipulator | |
| CN106585963A (zh) | 空中机器人 | |
| Lee et al. | Landing Site Inspection and Autonomous Pose Correction for Unmanned Aerial Vehicles |
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 | ||
| WD01 | Invention patent application deemed withdrawn after publication | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200403 |