一种无人机吊挂消摆及控制方法技术

本发明专利技术公开了一种无人机吊挂消摆及控制方法，包括如下步骤：在吊挂系统中安装倾角传感器；对原始纵、横向倾角数据应用倾角修正公式；对原始纵、横向角速度数据应用角速度修正公式；对纵、横向角速度修正值应用摆动速度计算公式；对纵、横向摆动速度修正值应用加速度反馈量计算公式得到加速度反馈量；将加速度反馈量叠加到纵、横向的加速度控制目标；根据能量公式，合适的加速度反馈量可以实现吊挂物摆动能量随时间衰减的消摆目标。本发明专利技术的优点：通过建立倾角传感器修正方法，实现吊挂物摆动幅度和相位的精确感知；根据消摆设计计算方法和系统逻辑建立吊挂物摆动状态对无人机飞行的反馈控制方法，有效抑制吊挂物摆动。有效抑制吊挂物摆动。有效抑制吊挂物摆动。

【技术实现步骤摘要】
一种无人机吊挂消摆及控制方法


[0001]本专利技术属于无人机吊挂运输
，具体涉及一种无人机吊挂消摆及控制方法。

技术介绍

[0002]无人机以其自身独特的优势在空中物流运输行业获得了极大的发展。其中，吊挂形式因其对不同货物外形有良好的适应性，成为了典型的无人机运输投送方式之一。作为一个理想的作业平台，无人机具有灵活的机动好、起降场地限制小、维护准备周期短等特点，可快速、高效地开展高强度、多频次的物资投放作业，在诸多领域得到了越来越广泛的应用。
[0003]无人机进行吊挂飞行时，在飞行状态变化（如加减速、转弯等）及空中气流突变等因素的影响下，吊挂物会受到激励，进而产生摆动。吊挂物的摆动不仅会显著增加吊挂物与建筑、地形障碍物甚至无人机重要部件碰撞的风险，更会大幅增加吊挂物过载，增加吊索断裂的风险。吊挂物质量在无人机飞行重量中可达到较高的占比，吊挂物摆动可能与无人机飞行姿态产生有害耦合，造成摆动幅度发散，使无人机进入复杂飞行状态，威胁飞行安全。因此，有效消除吊挂物摆动对于保证无人机大重量比吊挂任务的飞行安全和任务可靠性至关重要。
[0004]有人直升机在执飞大重量比吊挂任务时，会在机舱内配置观察员。观察员观察吊挂物摆动状态，并及时通报吊挂物摆动相位。飞行员操纵直升机做出相应的飞行机动，以抑制并逐渐消除吊挂物的摆动。对于无人直升机，没有观察员在飞机上观察货物摆动的幅度和相位，并且机上状态下传及飞行操作员在地面的操作指令上传存在延时，如果依赖机上状态感知由飞行操作员处置很难达到精准有效。
专利技术内容
[0005]本专利技术的目的在于：本专利技术提供了一种无人机吊挂消摆及控制方法，解决了无人机吊挂物摆动的问题。
[0006]本专利技术目的通过下述技术方案来实现：一种无人机吊挂消摆及控制方法，包括如下步骤：步骤S01，在吊挂系统中安装倾角传感器；步骤S02，对倾角传感器测得原始纵、横向倾角数据应用倾角修正公式；步骤S03，对倾角传感器测得原始纵、横向角速度数据应用角速度修正公式；步骤S04，对纵、横向角速度修正值应用摆动速度计算公式；步骤S05，对纵、横向摆动速度修正值分别乘以增益系数得到无人机纵、横向加速度反馈量；步骤S06，将无人机纵、横向加速度反馈量叠加到无人机纵、横向的加速度控制目标，进行无人机的加速度控制；
步骤S07，根据能量公式，实现吊挂物摆动能量随时间衰减，实现抑制吊挂物摆动的目的。
[0007]进一步的，步骤S01中，在吊索上安装倾角传感器，传感器在纵向、横向摆动的摆长分别为L
x
'和L
y
'，吊挂物在纵向、横向摆动的摆长分别为L
x
和L
y
，系统在纵向、横向的系统加速度为
x系统
和
y系统
，
x系统
和
y系统
为系统在纵向、横向的系统加速度对时间的导数。
[0008]进一步的，步骤S02中，对纵、横向测量倾角修正：；；其中：α
x真
、α
y真
分别为倾角传感器在纵向、横向的真实角速度，α
x测
、α
y测
分别为倾角传感器在纵向、横向测得的测量角速度，为重力加速度。
[0009]进一步的，步骤S03中，对纵、横向测量角速度修正：；；其中：ω
x真
、ω
y真
分别为倾角传感器在纵向、横向的真实角速度，ω
x测
、ω
y测
分别为倾角传感器在纵向、横向的测量角速度。
[0010]进一步的，步骤S04中，得到吊挂物的摆动速度：；；其中：v
x
、v
y
分别为吊挂物在纵向、横向的摆动线速度。
[0011]进一步的，步骤S05中，得到加速度反馈量：；。
[0012]其中：和分别为无人机纵、横向加速度反馈量，K1、K2分别为纵、横向增益系数。
[0013]进一步的，步骤S06中，在原有飞管系统加速度控制目标中，分别增加基于纵、横向摆动加速度的反馈量，建立吊挂物消摆控制反馈逻辑。
[0014]进一步的，步骤S07中，根据能量公式：；其中：E为吊挂物摆动能量，t为时间，m为吊挂物质量，g为重力加速度，L为吊挂物摆动方向上的摆长；x为吊挂物偏离平衡位置的水平距离，v为吊挂物相对于无人机的运动
速度，为无人机的加速度反馈量；该消摆控制反馈逻辑实现吊挂物摆动能量随时间衰减，实现抑制吊挂物摆动的目的。
[0015]本专利技术的有益效果：通过建立倾角传感器修正方法，实现吊挂物摆动幅度和相位的精确感知；根据消摆设计计算方法和系统逻辑建立吊挂物摆动状态对无人机飞行的反馈控制方法，有效抑制吊挂物摆动，将吊挂物摆动对无人机飞行的不良影响降到最低，增加无人机吊挂物的飞行安全性，并有助于实现精确投放的能力。
[0016]前述本专利技术主方案及其各进一步选择方案可以自由组合以形成多个方案，均为本专利技术可采用并要求保护的方案；且本专利技术，（各非冲突选择）选择之间以及和其他选择之间也可以自由组合。本领域技术人员在了解本专利技术方案后根据现有技术和公知常识可明了有多种组合，均为本专利技术所要保护的技术方案，在此不做穷举。
附图说明
[0017]图1是吊挂物及传感器受力分析图。
[0018]图2是吊挂物与传感器安装位置示意图。
[0019]图3是传感器测量倾角与吊挂物真实倾角偏差示意图。
[0020]图4是纵向铰与横向铰布置示意图。
[0021]图5是无人机控制吊挂物消摆示意图。
具体实施方式
[0022]下列非限制性实施例用于说明本专利技术。
[0023]为实现对吊挂物摆动位置的精确感知，采用在吊挂系统中安装倾角传感器的方案。倾角传感器通过内置陀螺仪、加速度计，测量静态重力加速度，转换成倾角变化，从而可以测量传感器输出相对水平面的倾角和俯仰角度。这种测量方式的局限性在于只适用在静态或慢速变化的动态环境下测量，不适用快速变化的动态环境。本专利技术提供了一套修正方法，克服了这个问题，可通过倾角传感器的测量获得在快速变化环境下吊挂物的真实摆动位置。
[0024]参考图1所示，设吊挂点为O，吊挂点O与无人机固连。索长为L，传感器安装位置距吊挂点O为L'，传感器灵敏轴跟随吊索摆动。
过载
'为传感器过载加速度，
过载
为吊挂物过载加速度；
摆动
'为传感器摆动加速度，
摆动
为吊挂物摆动加速度。对整个吊挂系统的运动分析建立在无人机运动非惯性坐标系内，整个系统存在运动加速度
系统
。
[0025]吊挂物重量远大于吊索重量，吊索为拉直状态，故吊索上各处相对于平衡位置的摆动位移沿索长方向线性分布，吊索上各处相对于平衡位置的摆动速度和摆动加速度沿索长方向也是线性分布的。即：（1）；结合受力分析，可得到：（2）；倾角传感器实际是运用惯性原理本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种无人机吊挂消摆及控制方法，其特征在于，包括如下步骤：步骤S01，在吊挂系统中安装倾角传感器；步骤S02，对倾角传感器测得原始纵、横向倾角数据应用倾角修正公式；步骤S03，对倾角传感器测得原始纵、横向角速度数据应用角速度修正公式；步骤S04，对纵、横向角速度修正值应用摆动速度计算公式；步骤S05，对纵、横向摆动速度修正值分别乘以增益系数得到无人机纵、横向加速度反馈量；步骤S06，将无人机纵、横向加速度反馈量叠加到无人机纵、横向的加速度控制目标，进行无人机的加速度控制；步骤S07，根据能量公式，实现吊挂物摆动能量随时间衰减，实现抑制吊挂物摆动的目的。2.根据权利要求1所述的无人机吊挂消摆及控制方法，其特征在于：步骤S01中，在吊索上安装倾角传感器，传感器在纵向、横向摆动的摆长分别为L
x
'和L
y
'，吊挂物在纵向、横向摆动的摆长分别为L
x
和L
y
，系统在纵向、横向的系统加速为
x系统
和
y系统
，
x系统
和
y系统
为系统在纵向、横向的系统加速度对时间的导数。3.根据权利要求2所述的无人机吊挂消摆及控制方法，其特征在于：步骤S02中，对纵、横向测量倾角修正：；；其中：α
x真
、α
y真
分别为倾角传感器在纵向、横向的真实角速度，α
x测
、α
y测<...

【专利技术属性】
技术研发人员：彭钧，刘帅，王林涛，文厚林，曾东，何晓萍，
申请(专利权)人：四川腾盾科技有限公司，
类型：发明
国别省市：