CN115366109A - 一种旋翼飞行机械臂复合分层抗干扰方法 - Google Patents
一种旋翼飞行机械臂复合分层抗干扰方法 Download PDFInfo
- Publication number
- CN115366109A CN115366109A CN202211164762.6A CN202211164762A CN115366109A CN 115366109 A CN115366109 A CN 115366109A CN 202211164762 A CN202211164762 A CN 202211164762A CN 115366109 A CN115366109 A CN 115366109A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- aerial vehicle
- unmanned aerial
- matrix
- interference
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1669—Programme controls characterised by programming, planning systems for manipulators characterised by special application, e.g. multi-arm co-operation, assembly, grasping
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种旋翼飞行机械臂复合分层抗干扰方法,在旋翼飞行机械臂执行空中操作任务时,由于其存在较强的内部动态耦合和质心偏移,以及自身的模型不确定性和基座浮动等问题。针对存在的多源干扰影响,本发明提出了三个子控制器,在无人机控制方面,包括一个鲁棒H∞位置控制器,用于处理施加在无人机位置环的动态耦合力。一个复合自适应抗干扰控制器来保证无人机姿态环的控制精度,在机械臂控制方面,采用一个基于势场的运动学控制器来抑制基座浮动。本发明可以保证无人机在悬停状态下完成对目标物体的精准抓取。
Description
技术领域
本发明属于飞行器姿态控制领域,具体涉及一种旋翼飞行机械臂复合分层抗干扰方法。
背景技术
近些年来,旋翼飞行机械臂作为一种特殊的无人机受到了学术界和工业界的广泛关注。在技术发展以及许多应用可能性的推动下,旋翼飞行机械臂的发展经历了指数级的增长。普通的多旋翼无人机被广泛应用于环保检测、交通监视、农业植保和航拍摄影等领域,旋翼飞行机械臂作为特定的科学研究课题,目前也成为了多数机器人会议的主要研究领域之一。
中国发明专利《一种基于滑模PID控制的飞行机械臂》(公开号:CN108279562 A)公开了一种基于滑膜PID控制的飞行机械臂,该控制方法针对传统PID控制中出现的抗干扰性差、鲁棒性差,以及滑膜控制中存在的抖振问题进行了改善。但是其控制方法只关注于无人机方面的控制精度,忽略了机械臂末端执行器的控制精度。由于旋翼飞行机械臂是一个高度耦合的系统,只关注无人机的控制无法实现整个系统的高精度控制。
中国发明专利《旋翼飞行机械臂自适应RBFNNs测噪自抗扰控制方法》(公开号:CN108398885A)公开了一种旋翼飞行机械臂自适应RBFNNs测噪自抗扰控制方法。该方法利用自适应RBFNNs对飞行机械臂各通道的内外部干扰进行估计并实时补偿,在此基础上设计基于RBFNNs\ADRC的姿态控制器,能有效地补偿机械臂运动对飞行平台的干扰。但是其只考虑了机械臂运动对无人机造成的干扰,但在实际的抓取任务中,应更多考虑机械臂末端执行器的控制精度,因此无人机给机械臂带来的浮动基座干扰不可忽视。
发明内容
针对现有技术中存在的上述问题,本发明提供了一种旋翼飞行机械臂复合分层抗干扰方法,其将无人机和机械臂解耦控制,将其视为两个独立的个体,因此将它们之间的动态耦合分别看作施加在无人机和机械臂上的干扰,在此基础上设计了三个子控制器,能有效的解决系统中存在的浮动基座,质心偏移等干扰,实现旋翼飞行机械臂系统的高精度控制。
为达到上述目的,本发明采用的技术方案如下:
一种旋翼飞行机械臂复合分层抗干扰方法,将无人机和机械臂进行解耦控制,将无人机和机械臂视为两个独立的实体,将它们之间的动态耦合分别看作施加在无人机和机械臂上的干扰;采用了微分平坦的方法,由电机提供的期望升力Fd和期望的旋转矩阵Rd计算得到无机人期望的欧拉角设置干扰观测器对施加在无人机旋转运动上的干扰进行快速补偿;设置姿态速度并基于此设置一个滑膜项s,用于处理旋转运动上的干扰抑制问题,并设置自适应控制项λ用于处理有界干扰,设置无人机姿态环的整体控制输入τ;在无人机的位置环,由于误差的有界性,设置一个线性H∞控制器用于处理作用在无人机上的力扰动以及位置环和姿态环之间的相互作用效应;在机械臂的控制上,设置一个基于势能函数的运动学控制器用于保证在抓取任务过程中,空中操纵器的末端执行器准确地跟踪给定的位置或轨迹指令,同时处理基座浮动问题。
进一步地,为无人机位置环的线性H∞控制器设置一个虚拟控制输入v:
式中,增益矩阵K=WX-1,其中X=P-1,W是根据Schur补引理,通过求解以下线性矩阵不等式得到的:
在无人机的姿态环,设置一个整体控制输入τ:
在机械臂的控制上,设置一个抑制浮动基座的基于势能函数的运动学控制器,提供机械臂各个关节的参考角速度:
进一步地,构造李亚普诺夫函数对设计控制器机械臂末端执行器控制误差收敛的稳定性进行证明:
有益效果:
本发明可以很好的降低无人机基座浮动对机械臂末端控制精度的影响,提升机械臂末端控制的精度,同时保持整个系统的稳定性。
附图说明
图1是本发明所涉及到的旋翼飞行机械臂外观模型示意图。其中:B=[XB YB ZB]为机体坐标系,E=[XE YE ZE]为机械臂末端执行器坐标系,W=[XW YW ZW]为世界坐标系。
图2是本发明的旋翼飞行机械臂复合分层抗干扰方法的流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
图1所示为旋翼飞行机械臂的坐标系,整个系统建立了三个坐标系—世界坐标系∑W,机体坐标系∑B,机械臂末端执行器坐标系∑E。表示无人机期望的欧拉角,Fd表示期望升力,Rd表示由世界坐标系到机体坐标系期望的旋转矩阵。
本发明为了生成欠驱动四旋翼能够实现的平滑轨迹,采用了微分平坦的方法,由电机提供的期望升力Fd和期望的旋转矩阵Rd(由世界坐标系到机体坐标系)计算得到无机人期望的欧拉角设计干扰观测器对施加在无人机旋转运动上的干扰进行快速补偿。为了处理旋转运动上的干扰抑制问题,本发明提出了参考的姿态速度并基于此设计一个滑膜项s。进一步地,为了处理有界干扰,提出了个自适应控制项λ。因此,设计了无人机姿态环的整体控制输入τ。在无人机的位置环,由于误差的有界性,提出了一个线性的H∞控制器来处理作用在无人机上的力扰动以及位置环和姿态环之间的相互作用效应。
在机械臂的控制方面,为了保证在抓取任务过程中,空中操纵器的末端执行器可以准确地跟踪给定的位置或轨迹指令,同时考虑到旋翼飞行机械臂系统存在的浮动基座干扰,设计一个基于势能函数的运动学控制器来处理基座浮动问题。所设计的控制器都通过构造Lyapunov的方法对系统的稳定性进行了证明。
图2所示为整个控制方法的流程图,具体地,本发明的一种旋翼飞行机械臂复合分层抗干扰方法,包括如下步骤:
步骤一:设计期望欧拉角期望机体坐标系的z轴,可以表示为:
因此可以得到无人机期望的欧拉角:
其中,rij代表Rd的(i,j)th个元素。其中,i,j为常数,表示矩阵的i行,j列。
步骤二:设计干扰观测器:
步骤三:设计滑膜项s:
步骤四:设计自适应控制项λ:
式中,κ表示一个正增益。
步骤五:设计无人机姿态环的整体控制输入τ:
式中,Ks和Ka表示正定的矩阵。
将系统整体控制输入带入到无人机系统的姿态环的欧拉-拉格朗日描述:
其中,da为机械臂带来的力矩干扰,dm为模型不确定性带来的干扰。
可以得到:
为了证明姿态环的稳定性,可以设计李亚普诺夫函数如下:
其中,pd表示无人机的期望位置,vd表示无人机的期望速度,位置误差ep=pb-pd。定义一个虚拟控制输入v:
其中,Fd表示无人机的期望力矩,m表示系统的质量,g为重力加速度,e3表示世界坐标系∑W的z轴。
无人机的平动动力学描述如下:
对于干扰项δ,有如下性质:
其中,P为选取的正定对称的矩阵,χ为一正的常值,K为增益矩阵。
虚拟控制输入v设计为:
式中,增益矩阵K=WX-1,其中X=P-1,W是根据Schur补引理,通过求解以下线性矩阵不等式(LMI)得到的:
最后的期望升力Fd可以通过下式得到:
Fd=mν-mge3
其中,e3表示世界坐标系∑W的z轴。
步骤七:基于势能函数的运动学控制器设计:
旋翼飞行机械臂的整体运动学描述为:
为了解决旋翼飞行机械臂系统中存在的浮动基座干扰问题,在运动学水平上提出了机械臂的参考角速度,首先是势能函数P(Δxe)的设计:
其中,N,kp表示正的常数,η表示设定的误差边界,max(),表示两者中的最大值。
式中,Δxe=xe-xd表示机械臂末端执行器跟踪期望轨迹的跟踪误差,η表示一个正的约束,所以参考的角速度控制输入如下:
sat(aΔxe)表示一个饱和函数,定义如下:
式中,μ,a为正的常值,用来描述饱和的线性范围,Δxei表示向量Δxe的元素。
b4的更新为:
κb是一个正增益。
为了证明提出机械臂末端执行器控制误差收敛的稳定性,设计的李亚普诺夫函数如下:
关于无人机的控制部分在simulink中搭建了相关的控制器模型,并进行了仿真和实验验证,关于机械臂的控制部分在机载计算机上完成,并完成了实验验证,证明了提出控制算法的性能以及实用性。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种旋翼飞行机械臂复合分层抗干扰方法,其特征在于,将无人机和机械臂进行解耦控制,将无人机和机械臂视为两个独立的实体,将它们之间的动态耦合分别看作施加在无人机和机械臂上的干扰;采用了微分平坦的方法,由电机提供的期望升力Fd和期望的旋转矩阵Rd计算得到无机人期望的欧拉角设置干扰观测器对施加在无人机旋转运动上的干扰进行快速补偿;设置姿态速度并基于此设置一个滑膜项s,用于处理旋转运动上的干扰抑制问题,并设置自适应控制项λ用于处理有界干扰,设置无人机姿态环的整体控制输入τ;在无人机的位置环,由于误差的有界性,设置一个线性H∞控制器用于处理作用在无人机上的力扰动以及位置环和姿态环之间的相互作用效应;在机械臂的控制上,设置一个基于势能函数的运动学控制器用于保证在抓取任务过程中,空中操纵器的末端执行器准确地跟踪给定的位置或轨迹指令,同时处理基座浮动问题。
2.根据权利要求1所述的旋翼飞行机械臂复合分层抗干扰方法,其特征在于:
为无人机位置环的线性H∞控制器设置一个虚拟控制输入v:
式中,增益矩阵K=WX-1,其中X=P-1,W是根据Schur补引理,通过求解以下线性矩阵不等式得到的:
在无人机的姿态环,设置一个整体控制输入τ:
在机械臂的控制上,设置一个抑制浮动基座的基于势能函数的运动学控制器,提供机械臂各个关节的参考角速度:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211164762.6A CN115366109A (zh) | 2022-09-23 | 2022-09-23 | 一种旋翼飞行机械臂复合分层抗干扰方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211164762.6A CN115366109A (zh) | 2022-09-23 | 2022-09-23 | 一种旋翼飞行机械臂复合分层抗干扰方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115366109A true CN115366109A (zh) | 2022-11-22 |
Family
ID=84072269
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211164762.6A Pending CN115366109A (zh) | 2022-09-23 | 2022-09-23 | 一种旋翼飞行机械臂复合分层抗干扰方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115366109A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116149193A (zh) * | 2023-04-24 | 2023-05-23 | 湖南大学 | 一种基于视觉的旋翼无人机抗扰动控制方法及系统 |
CN116300668A (zh) * | 2023-05-26 | 2023-06-23 | 北京航空航天大学杭州创新研究院 | 一种针对降雨干扰的四旋翼无人机分层抗干扰控制方法 |
CN116301009A (zh) * | 2023-05-25 | 2023-06-23 | 北京航空航天大学杭州创新研究院 | 一种变构型无人机的抗干扰安全控制方法 |
-
2022
- 2022-09-23 CN CN202211164762.6A patent/CN115366109A/zh active Pending
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116149193A (zh) * | 2023-04-24 | 2023-05-23 | 湖南大学 | 一种基于视觉的旋翼无人机抗扰动控制方法及系统 |
CN116149193B (zh) * | 2023-04-24 | 2023-06-23 | 湖南大学 | 一种基于视觉的旋翼无人机抗扰动控制方法及系统 |
CN116301009A (zh) * | 2023-05-25 | 2023-06-23 | 北京航空航天大学杭州创新研究院 | 一种变构型无人机的抗干扰安全控制方法 |
CN116301009B (zh) * | 2023-05-25 | 2023-08-22 | 北京航空航天大学杭州创新研究院 | 一种变构型无人机的抗干扰安全控制方法 |
CN116300668A (zh) * | 2023-05-26 | 2023-06-23 | 北京航空航天大学杭州创新研究院 | 一种针对降雨干扰的四旋翼无人机分层抗干扰控制方法 |
CN116300668B (zh) * | 2023-05-26 | 2023-08-08 | 北京航空航天大学杭州创新研究院 | 一种针对降雨干扰的四旋翼无人机分层抗干扰控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107957730B (zh) | 一种无人飞行器稳定飞行控制方法 | |
Das et al. | Backstepping approach for controlling a quadrotor using lagrange form dynamics | |
CN115366109A (zh) | 一种旋翼飞行机械臂复合分层抗干扰方法 | |
CN109696830B (zh) | 小型无人直升机的强化学习自适应控制方法 | |
Lai et al. | Adaptive position/attitude tracking control of aerial robot with unknown inertial matrix based on a new robust neural identifier | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN107563044B (zh) | 基于在线安全学习的四旋翼无人机路径跟踪控制方法 | |
CN112578805B (zh) | 一种旋翼飞行器的姿态控制方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂系统 | |
CN110703603B (zh) | 一种无人机多层递归收敛神经网络控制器的控制方法 | |
Goodarzi et al. | Global formulation of an extended Kalman filter on SE (3) for geometric control of a quadrotor UAV | |
CN109597426A (zh) | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 | |
CN114815861A (zh) | 一种基于时空径向基函数神经网络的容错飞行控制方法 | |
Emran et al. | Adaptive neural network control of quadrotor system under the presence of actuator constraints | |
CN110377044B (zh) | 一种无人直升机的有限时间高度和姿态跟踪控制方法 | |
CN115431271A (zh) | 一种飞行机械臂末端抗干扰指向控制方法 | |
CN114237270B (zh) | 一种考虑输入饱和的无人直升机跟踪控制方法 | |
CN115556111A (zh) | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 | |
CN110275542B (zh) | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 | |
BOUZID et al. | Generic dynamic modeling for multirotor VTOL UAVs and robust Sliding Mode based Model-Free Control for 3D navigation | |
Alcan et al. | Robust hovering control of a quadrotor using acceleration feedback | |
Song et al. | Research on attitude control of quadrotor uav based on active disturbance rejection control | |
Rodić et al. | Dynamic Inversion Control of quadrotor with complementary Fuzzy logic compensator | |
Jin et al. | The unified tracking controller for a tilt-rotor unmanned aerial vehicle based on the dual quaternion | |
Brahim et al. | Altitude and attitude quadrotor control based on adaptive sliding mode controller with input saturation |
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 |