一种无人机滑跑纠偏控制装置及方法制造方法及图纸

本发明专利技术提供一种无人机滑跑纠偏控制装置及方法。所述装置包括：GPS模块、磁航向仪、纠偏控制器、惯性测量单元舵机伺服控制器、前轮舵机；GPS模块无人机的经纬度和地面速度矢量信息；所述磁航向仪获取无人机的磁航向信息；所述惯性测量单元获取无人机运动的三轴姿态角、三轴角速率和机体坐标系速度矢量信息；纠偏控制器根据GPS模块、磁航向仪和惯性测量单元获取的上述参数进行纠偏控制计算，形成舵机控制指令送往舵机伺服控制器；所述舵机伺服控制器接收所述纠偏控制器发送的舵机控制指令，产生功率放大信号，用以驱动前轮舵机；所述前轮舵机根据所述舵机伺服控制器输出的功率放大信号形成前轮偏转，进而引起无人机的纠偏运动轨迹跟踪。

【技术实现步骤摘要】
【专利摘要】本专利技术提供。所述装置包括：GPS模块、磁航向仪、纠偏控制器、惯性测量单元舵机伺服控制器、前轮舵机；GPS模块无人机的经纬度和地面速度矢量信息；所述磁航向仪获取无人机的磁航向信息；所述惯性测量单元获取无人机运动的三轴姿态角、三轴角速率和机体坐标系速度矢量信息；纠偏控制器根据GPS模块、磁航向仪和惯性测量单元获取的上述参数进行纠偏控制计算，形成舵机控制指令送往舵机伺服控制器；所述舵机伺服控制器接收所述纠偏控制器发送的舵机控制指令，产生功率放大信号，用以驱动前轮舵机；所述前轮舵机根据所述舵机伺服控制器输出的功率放大信号形成前轮偏转，进而引起无人机的纠偏运动轨迹跟踪。【专利说明】
本专利技术属于飞行器控制
，涉及无人机自主起降过程中滑跑纠偏控制，特别涉及滑跑纠偏控制器的装置及方法。
技术介绍
无人机的发射和回收阶段是整个飞行过程中的关键阶段，对发射、回收阶段有效安全的控制是无人机控制的关键内容之一。目前无人机的发射方式主要包括轨道发射(橡筋绳弹射、气动发射、液压/气动发射和旋转发射)、零长发射(火箭助推发射、手抛发射、车载发射和飞轮发射)及轮式发射；回收方式主要包括轮式滑停回收、拦阻网回收、空中打捞回收和伞降回收。长航时等大型无人机一般具有较大的重量，飞机本身价格昂贵，在回收阶段需要对机体提供高度的保护。对这类飞机，宜采用轮式发射和回收方式，即轮式起降。轮式起降中的滑跑纠偏控制是轮式起降中的重要方面。飞机结构不可避免地存在不对称性，机场跑道存在凸凹，机场存在各种风扰动，飞机着陆触地时相对于跑道一般都存在偏航角和侧向偏移。所有这些因素将导致飞机在起飞或着陆滑跑中出现相对于跑道的侧向偏差。若不及时对侧偏距进行纠正，飞机可能侧偏出跑道，造成严重事故。可以认为，滑跑纠偏控制是飞机起飞着陆主要控制任务之一，而纠偏控制装置是纠偏控制的关键部件。目前无人机纠偏控制装置一般采用经典控制方法，如PID控制，其特点在于形式简单、调参方便、需要参量少。但问题在于无人机自主起降过程中速度是变化的，起飞时加速，着陆时是减速；在变速运动过程中，基于PID控制方法的纠偏控制往往难以适应，导致不同阶段的纠偏性能下降，甚至系统发散。
技术实现思路
(一 )要解决的技术问题本专利技术所要解决的技术问题是提供一种基于预瞄跟随方法的无人机滑跑纠偏控制装置，以实现不同速度下的偏移预测和自适应纠偏控制，保证在滑跑速度范围内的纠偏控制性能，为无人机滑跑纠偏控制提供实际控制装置。( 二 )技术方案本专利技术公开了一种无人机滑跑纠偏控制装置，包括GPS模块、磁航向仪、纠偏控制器、惯性测量单元舵机伺服控制器、前轮舵机；其中，所述GPS模块用于获取无人机的经纬度和地面速度矢量信息；所述磁航向仪用于获取无人机的磁航向信息；所述惯性测量单元用于获取无人机运动的三轴姿态角、三轴角速率和机体坐标系速度矢量信息；纠偏控制器根据所述GPS模块、磁航向仪和惯性测量单元获取的上述参数进行纠偏控制计算，形成舵机控制指令送往舵机伺服控制器；所述舵机伺服控制器接收所述纠偏控制器发送的舵机控制指令，产生功率放大信号，用以驱动前轮舵机；所述前轮舵机根据所述舵机伺服控制器输出的功率放大信号形成前轮偏转，进而引起无人机的纠偏运动轨迹跟踪。本专利技术还公开了一种无人机滑跑纠偏控制方法，其包括:获取无人机的运动参数，包括运动的经纬度、地面速度矢量信息、磁航向信息、三轴姿态角、三轴角速率和机体坐标系速度矢量信息；对所述运动参数进行数据融合和纠偏控制指令计算，形成舵机控制指令；根据所述舵机控制指令驱动所述无人机的前轮发生偏转，进而对所述无人机的滑动进行纠偏控制。(三)有益效果本专利技术提供一种基于预瞄跟随方法的无人机滑跑纠偏控制装置，在预瞄跟随方法下，给出了纠偏控制计算(预瞄跟随方法)的计算方法。算法对具有强非线性且时变的无人机前轮操纵动力学模型进行了一阶等效线性化，并利用带遗忘因子的递归最小二乘方法进行了等效参考模型的参数在线辨识，最终按照理想的预瞄跟随器的结构进行了转向特性估计，建立了自整定控制器的参数在线调节方法，可以实现在不同速度下的自适应纠偏控制；针对无人机动力学强非线性时变特性，采用基于预瞄跟随方法提出了预瞄式自适应控制算法，该控制算法可较为精确地控制无人机滑跑纠偏跟随预期轨迹，且自适应控制算法的采用也提高了控制系统的鲁棒性和适应性，并完成了纠偏控制装置的软硬件设计，从而为无人机纠偏控制系统提供了一条可实现的装置。【专利附图】【附图说明】图1是本专利技术中无人机滑跑纠偏控制装置结构图；图2是本专利技术中纠偏控制器的结构图；图3是本专利技术中无人机滑跑纠偏控制装置的计算流程图；图4是本专利技术中预瞄跟随方法下的理想侧向加速度计算示意图；图5是本专利技术中纠偏控制计算(预瞄跟随方法)的原理图。【具体实施方式】为使本专利技术的目的、技术方案和优点更加清楚明白，以下结合具体实施例，并参照附图，对本专利技术作进一步的详细说明。图1示出了本专利技术中无人机滑跑纠偏控制装置的结构图。如图1所示，无人机滑跑纠偏控制装置包括GPS模块31、磁航向仪32、纠偏控制器33、惯性测量组件34、舵机伺服控制器35、前轮舵机36、数传电台37、遥控接收机38、地面控制站39。所述无人机滑跑纠偏控制装置3安装在无人机I上，使得无人机I在自主起降地面滑跑过程中始终沿着跑道中心线2进行轨迹跟踪。所述纠偏控制器33与GPS模块31、磁航向仪32、惯性测量组件34连接，用于提取无人机I的滑跑运动参数，并且根据这些参数进行纠偏控制计算，形成舵机控制指令送往舵机伺服控制器35。舵机伺服控制器35形成功率放大信号驱动前轮舵机36，进行滑跑纠偏控制。GPS模块31提供无人机I运动的经纬度、地面速度矢量信息。磁航向仪32提供无人机I运动的磁航向信息。惯性测量组件34提供无人机I运动的三轴姿态角(滚转、俯仰、偏航角)、三轴角速率(滚转、俯仰、偏航角速率)，以及惯性导航地速。舵机伺服控制器35接收纠偏控制器33发送的舵机控制指令，产生功率放大信号，用以驱动液压舵机。前轮舵机36作为无人机I滑跑纠偏控制的执行机构，采用液压舵机，接收舵机伺服控制器35的功率放大信号，形成前轮偏转，进而引起无人机的纠偏运动轨迹跟踪。数传电台37用于接收地面控制站39发送的无人机滑跑纠偏控制装置的运动指令(如启动、停车、转弯、直线跟踪)、数据链控制指令(数据发送启动、停止)、配置指令(如速度指令的大小等)，并将其传送至纠偏控制器33，并且纠偏控制器33通过所述数传电台37向地面控制站39回传无人机滑跑纠偏控制装置3的状态信息。遥控接收机38用于无人机滑跑纠偏控制装置3处于遥控状态时接收地面遥控人员手持遥控器381发送的遥控指令，并将接收到的遥控指令发送给舵机伺服控制器35，一般用于测试状态。地面控制站39用于无人机滑跑纠偏控制装置3的指令发送以及状态显示。无人机滑跑纠偏控制装置3的工作机制如下:GPS模块31提供无人机I运动的经纬度、地面速度矢量信息；磁航向仪32提供无人机I运动的磁航向信息；惯性测量组件34提供无人机I运动的三轴姿态角(滚转、俯仰、偏航角)、三轴角速率(滚转、俯仰、偏航角速率)、机体坐标系速度矢量信息。纠偏控制器33通过对GPS模块31、磁航向仪32、本文档来自技高网...

【技术保护点】
一种无人机滑跑纠偏控制装置，其特征在于：包括GPS模块、磁航向仪、纠偏控制器、惯性测量单元舵机伺服控制器、前轮舵机； 其中，所述GPS模块用于获取无人机的经纬度和地面速度矢量信息； 所述磁航向仪用于获取无人机的磁航向信息； 所述惯性测量单元用于获取无人机运动的三轴姿态角、三轴角速率和机体坐标系速度矢量信息；纠偏控制器根据所述GPS模块、磁航向仪和惯性测量单元获取的上述参数进行纠偏控制计算，形成舵机控制指令送往舵机伺服控制器； 所述舵机伺服控制器接收所述纠偏控制器发送的舵机控制指令，产生功率放大信号，用以驱动前轮舵机； 所述前轮舵机根据所述舵机伺服控制器输出的功率放大信号形成前轮偏转，进而引起无人机的纠偏运动轨迹跟踪。

【技术特征摘要】

【专利技术属性】
技术研发人员：范国梁，袁如意，常红星，易建强，
申请(专利权)人：中国科学院自动化研究所，
类型：发明
国别省市：北京;11