一种模拟四轴飞行器卫星导航定位的方法技术

本发明专利技术公开的一种模拟四轴飞行器卫星导航定位的方法，属于无人机技术领域。本发明专利技术在四轴飞行器位置固定的条件下，通过传感器采集飞行器的姿态信息和电机转速，计算出飞行器位移信息，并模拟卫星导航定位信息的位置坐标发送给飞行器，通过地面站模拟飞行器的卫星导航定位信息并获得模拟飞行轨迹。具有下述优点：(1)无需改变三自由度飞行器姿态模拟平台结构，实现增加三自由度飞行器姿态模拟平台在空间位置坐标下的三个自由度模拟与测试；(2)位移数据直接转换为定位数据发送给飞行器，直接通过地面站读取四轴飞行器的卫星导航定位信息并显示，不需单独设计上位机程序观察四轴飞行器的卫星导航定位信息或位移信息。(3)成本低廉、使用方便。

A method of simulating satellite navigation and positioning for four axis aircraft

The invention discloses a method for simulating the satellite navigation and positioning of a four axis aerocraft, belonging to the technical field of unmanned aerial vehicles. The present invention in the condition of four axis aircraft position is fixed, the speed sensor and motor vehicle attitude information, calculate the displacement information of the aircraft, and the simulation of satellite navigation and positioning information to send coordinates to an aircraft by ground station simulation of aircraft satellite navigation and positioning information and get the simulation of flight trajectory. Has the following advantages: (1) without changing the three degrees of freedom flight simulation platform structure, realize three degrees of freedom simulation and test increase of three degrees of freedom vehicle attitude simulation platform in space coordinates; (2) displacement data directly into the positioning data sent to the vehicle, directly through the ground station of satellite navigation and positioning information read the four axis aircraft and display, no single PC program design on four axis aircraft satellite navigation and positioning information or displacement information. (3) low cost and easy to use.

【技术实现步骤摘要】
一种模拟四轴飞行器卫星导航定位的方法
本专利技术涉及一种模拟多轴飞行器卫星导航定位的方法，尤其涉及一种模拟四轴飞行器卫星导航定位的方法，属于无人机

技术介绍
近十几年来，随着复合材料、动力系统、传感器、尤其是飞行控制等技术的研究进展，无人机得到了迅速的发展，正日益成为人们关注的焦点。无人机具有独特的飞行性能及使用价值。无人机驾驶仪作为无人机控制的核心部件，在真正应用于无人机之前，不仅仅要经过多次软件模拟仿真，更需要经过多重严格的地面测试，只有通过机载传感器和执行机构的实际验证，才能保证无人机的可靠实际飞行。基于以上原因，利用三自由度、六自由度飞行模拟实验仿真平台对无人机飞行进行测试是必不可少的，本专利方法要解决的问题就是，消耗较小的硬件软件成本，将三自由度实验仿真平台拓展为六自由度仿真平台，从而模拟更真实的飞行环境，进而保证先进的无人机控制算法能够成功应用于无人机控制中。目前无人机的功能还十分有限，飞行主要由操作手在地面遥控完成，大多还不具备自主飞行能力。无人直升机的自主飞行研究在国际上也是非常前沿的课题。国内的设计方法，多数是通过大量的飞行试验来调整飞行控制参数，最终找到合适的控制律。但是飞行试验一旦失败，无人直升机有坠机的危险，很容易遭到毁灭性的损坏，将造成试验成本大幅度增加和研制周期的加长。因此，飞行控制实验平台成为无人直升机飞行控制系统设计的一个重要步骤。现有飞行控制系统中大多数飞行器仿真实验平台为飞行器姿态模拟三自由度转台，比如专利CN101794524A：《一种飞行器姿态模拟三自由度电动转台》，其三自由度电动转台由基座和三个运动框架组成，模拟飞行器的三维姿态运动。这种方法存在的问题是缺少飞行器的在x、y、z轴方向上的位移控制实验，甚至由于位移数据缺失造成实验结果与架机实操的不一致，带来飞行安全等隐患。由于三自由度实验平台的局限性，目前已经有一部分人开始着手研究六自由度实验平台，比如专利CN102180270A：《一种微小型旋翼飞行器实验平台及应用》，实验台底座固定在地面上或其他平面上，实验台底座与球关节轴承的定子之间连接有六维力传感器，六维力传感器通过电缆连接至上位计算机，球关节轴承的转子与微小型旋翼式飞行器固连，微小型旋翼式飞行器上安装有机载电路硬件，机载电路硬件采用电缆或无线通信的方式与上位计算机进行实时通讯。这些实验平台虽然可以进行六自由度仿真实验，但其结构与三自由度实验平台完全不同，无法简单的将三自由度实验平台改造升级为六自由度实验平台，在已经有三自由度实验平台时需重新购买六自由度实验平台才能进行六自由度实验仿真，成本昂贵，另外，这些实验平台位移数据需要设计单独的上位机程序进行观察，进一步提高了成本，也损失了方便性。再者，国内外关于无人机飞控系统验证平台的相关报道仍然比较少，而商品化的仿真平台，虽然功能齐全，接口完善，能够满足验证飞控算法的需求，但是销售价格非常高，构造也比较复杂，维护成本高，不能广泛应用于学生试验和实际操作。例如Quanser公司的Qball-X4飞控仿真平台，Quanser公司1990年成立于加拿大，一致致力于促进教学科研与实际工程的结合，Qball-X4飞控仿真平台是该公司所研制开发的一套全封闭能够真实模拟四旋翼飞行的实时仿真控制平台，该平台被国内外多所高校所采用，来验证飞行控制算法。QuanserQball-X4基于四旋翼直升机设计，其中四旋翼安装有4个10英寸螺旋桨，整个四旋翼附在一个保护性的碳化纤维笼子里面，保证了飞行中的安全性，使得这种无人机可以在实验室内应用，能最大程度降低潜在的破坏性。然而其高昂的价格阻碍了大多数科研人员和学生的使用。相比于国外而言，国内的飞控系统仿真平台还处在研制阶段，且成本也比较高，因此一套低成本的仿真验证平台就显得格外有价值，这样不仅可以使得学生可以低成本获得仿真平台，从而加快理论研究，也可以广泛应用于学生教学和试验中。
技术实现思路
本专利技术公开的一种模拟四轴飞行器卫星导航定位的方法要解决的技术问题是：基于在四轴飞行器位置固定的条件下实现模拟四轴飞行器的卫星导航定位状态，并获得四轴飞行器的模拟飞行轨迹；此外，具有下述优点：(1)在已有三自由度飞行器姿态模拟平台基础上，无需改变三自由度飞行器姿态模拟平台的结构，能够实现增加已有三自由度飞行器姿态模拟平台在空间位置坐标下的三个自由度模拟与测试；(2)位移数据直接转换为定位数据发送给飞行器，能够直接通过飞行器的地面站直接读取四轴飞行器的卫星导航定位信息并显示在地面站中，不需要设计单独的上位机程序进行观察四轴飞行器的卫星导航定位信息或位移信息。(3)成本低廉、使用方便。本专利技术的目的是通过下述技术方案实现的：本专利技术公开的一种模拟四轴飞行器卫星导航定位的方法，包括如下步骤：步骤一：在四轴飞行器位置固定的条件下，基于已有三自由度飞行器姿态模拟平台，搭建模拟四轴飞行器卫星导航定位的装置。所述的模拟四轴飞行器卫星导航定位的装置包括模拟定位模块、四轴飞行器和地面站。所述的模拟定位模块包括姿态传感器、单片机、反相器。姿态传感器通过串口把四轴飞行器姿态数据发送给单片机。四轴飞行器输出S.BUS信号，并将S.BUS信号经反相器后通过串口将电机转速发送给单片机。单片机通过串口模拟导航定位信号的数据协议格式，将模拟卫星导航定位信息发送给四轴飞行器。四轴飞行器连续接收到的模拟卫星导航定位信息能够显示在地面站的地图界面形成飞行轨迹。步骤二：根据实际使用的四轴飞行器各部分元件的型号，设置四轴飞行器的质量m、桨叶面积A、电机最大、最小转速、四轴飞行器侧面面积、四轴飞行器正面面积、四轴飞行器初始高度等初始化参数；此外，在模拟四轴飞行器卫星导航定位状态之前，需要确定四轴飞行器在卫星导航中的初始位置。步骤二中所述的确定四轴飞行器在卫星导航中的初始位置，优选方法一或方法二：方法一：直接在单片机中设置四轴飞行器在卫星导航中初始位置的经纬度数据。方法二：外接卫星导航定位模块到模拟定位模块中的单片机上，单片机接收到外接卫星导航定位模块的有效定位信息后，将四轴飞行器在卫星导航中的初始位置设置为外接卫星导航定位模块所定位的位置。步骤三：接收并解析四轴飞行器姿态信息和电机转速Ω。姿态传感器通过串口发送四轴飞行器当前姿态信息，单片机通过解析得出四轴飞行器当前的俯仰角θ、横滚角φ和偏航角ψ。四轴飞行器的S.BUS信号经过反相器反相后经过单片机解析，得出四轴飞行器油门大小G，油门的最小值和最大值对应四轴飞行器的电机转速Ω的最大值和最小值，所述的电机转速Ω的最大值和最小值在步骤二中设置，而且，由于当前四轴飞行器多采用无刷直流电机，速度由电调自动调节并稳定在目标速度上，所以油门大小G和电机转速Ω呈线性关系：Ω＝k(G-Gmin)+Ωmin公式1其中：Ω为电机(旋翼)转速；G为油门大小，最大值与最小值之间一般相差1000；Gmin,Ωmin分别为油门最小值和电机转速最小值；k为油门大小和电机转速之间的系数，且其值满足：Ωmax＝k(Gmax-Gmin)+Ωmin公式2其中：Gmax,Ωmax分别为油门最大值和电机转速最大值；通过公式1和公式2，经过单片机处理，得出四轴飞行器的电机转速Ω。步骤四：滤波处理。为避免由于姿态、电机转速采本文档来自技高网...

【技术保护点】
一种模拟四轴飞行器卫星导航定位的方法，其特征在于：包括如下步骤，步骤一：在四轴飞行器位置固定的条件下，基于已有三自由度飞行器姿态模拟平台，搭建模拟四轴飞行器卫星导航定位的装置；所述的模拟四轴飞行器卫星导航定位的装置包括模拟定位模块、四轴飞行器和地面站；所述的模拟定位模块包括姿态传感器、单片机、反相器；姿态传感器通过串口把四轴飞行器姿态数据发送给单片机；四轴飞行器输出S.BUS信号，并将S.BUS信号经反相器后通过串口将电机转速发送给单片机；单片机通过串口模拟导航定位信号的数据协议格式，将模拟卫星导航定位信息发送给四轴飞行器；四轴飞行器连续接收到的模拟卫星导航定位信息能够显示在地面站的地图界面形成飞行轨迹；步骤二：根据实际使用的四轴飞行器各部分元件的型号，设置四轴飞行器初始化参数，所述的初始化参数包括质量m、桨叶面积A、电机最大、最小转速、四轴飞行器侧面面积、四轴飞行器正面面积、四轴飞行器初始高度；此外，在模拟四轴飞行器卫星导航定位状态之前，需要确定四轴飞行器在卫星导航中的初始位置；步骤三：接收并解析四轴飞行器姿态信息和电机转速Ω；姿态传感器通过串口发送四轴飞行器当前姿态信息，单片机通过解析得出四轴飞行器当前的俯仰角θ、横滚角φ和偏航角ψ；四轴飞行器的S.BUS信号经过反相器反相后经过单片机解析，得出四轴飞行器油门大小G，油门的最小值和最大值对应四轴飞行器的电机转速Ω的最大值和最小值，所述的电机转速Ω的最大值和最小值在步骤二中设置，而且，由于当前四轴飞行器多采用无刷直流电机，速度由电调自动调节并稳定在目标速度上，所以油门大小G和电机转速Ω呈线性关系：Ω＝k(G‑Gmin)+Ωmin  公式1其中：Ω为电机(旋翼)转速；G为油门大小，最大值与最小值之间一般相差1000；Gmin,Ωmin分别为油门最小值和电机转速最小值；k为油门大小和电机转速之间的系数，且其值满足：Ωmax＝k(Gmax‑Gmin)+Ωmin  公式2其中：Gmax,Ωmax分别为油门最大值和电机转速最大值；通过公式1和公式2，经过单片机处理，得出四轴飞行器的电机转速Ω；步骤四：滤波处理；为避免由于姿态、电机转速采集异常造成的模拟卫星导航定位位置信息计算异常，单片机需要对采集的数据进行滤波处理；步骤五：计算四轴飞行器受到的升力T、阻力f；电机产生的升力T的大小通过电机转速和飞行器参数计算：T＝CτρAR...

【技术特征摘要】
1.一种模拟四轴飞行器卫星导航定位的方法，其特征在于：包括如下步骤，步骤一：在四轴飞行器位置固定的条件下，基于已有三自由度飞行器姿态模拟平台，搭建模拟四轴飞行器卫星导航定位的装置；所述的模拟四轴飞行器卫星导航定位的装置包括模拟定位模块、四轴飞行器和地面站；所述的模拟定位模块包括姿态传感器、单片机、反相器；姿态传感器通过串口把四轴飞行器姿态数据发送给单片机；四轴飞行器输出S.BUS信号，并将S.BUS信号经反相器后通过串口将电机转速发送给单片机；单片机通过串口模拟导航定位信号的数据协议格式，将模拟卫星导航定位信息发送给四轴飞行器；四轴飞行器连续接收到的模拟卫星导航定位信息能够显示在地面站的地图界面形成飞行轨迹；步骤二：根据实际使用的四轴飞行器各部分元件的型号，设置四轴飞行器初始化参数，所述的初始化参数包括质量m、桨叶面积A、电机最大、最小转速、四轴飞行器侧面面积、四轴飞行器正面面积、四轴飞行器初始高度；此外，在模拟四轴飞行器卫星导航定位状态之前，需要确定四轴飞行器在卫星导航中的初始位置；步骤三：接收并解析四轴飞行器姿态信息和电机转速Ω；姿态传感器通过串口发送四轴飞行器当前姿态信息，单片机通过解析得出四轴飞行器当前的俯仰角θ、横滚角φ和偏航角ψ；四轴飞行器的S.BUS信号经过反相器反相后经过单片机解析，得出四轴飞行器油门大小G，油门的最小值和最大值对应四轴飞行器的电机转速Ω的最大值和最小值，所述的电机转速Ω的最大值和最小值在步骤二中设置，而且，由于当前四轴飞行器多采用无刷直流电机，速度由电调自动调节并稳定在目标速度上，所以油门大小G和电机转速Ω呈线性关系：Ω＝k(G-Gmin)+Ωmin公式1其中：Ω为电机(旋翼)转速；G为油门大小，最大值与最小值之间一般相差1000；Gmin,Ωmin分别为油门最小值和电机转速最小值；k为油门大小和电机转速之间的系数，且其值满足：Ωmax＝k(Gmax-Gmin)+Ωmin公式2其中：Gmax,Ωmax分别为油门最大值和电机转速最大值；通过公式1和公式2，经过单片机处理，得出四轴飞行器的电机转速Ω；步骤四：滤波处理；为避免由于姿态、电机转速采集异常造成的模拟卫星导航定位位置信息计算异常，单片机需要对采集的数据进行滤波处理；步骤五：计算四轴飞行器受到的升力T、阻力f；电机产生的升力T的大小通过电机转速和飞行器参数计算：T＝CτρAR2Ω2公式3其中：Cτ为旋翼姿态参数，可近似取为常数；ρ为空气密度，可近似取为常数；A为桨叶面积，根据实际飞行器设置数值；R为旋翼半径，根据实际飞行器设置数值；空气阻力f的计算公式为：其中：C为空气阻力系数，根据四轴飞行器形状改变，可设置为常数；ρ为空气密度，可近似取为常数；S为物体迎风面积，与飞行器大小及姿态相关，可根据飞行器设置为常数；V为物体与空气的相对运动速度，由于本方法不考虑风速对飞行器的影响，所以V也是四轴飞行器的飞行速度，四轴飞行器的初始飞行速度为0；根据公式4能够计算出四轴飞行器在东、北、天三个方向的空气阻力；步骤六：计算四轴飞行器在东-北-天三个方向的加速度、速度和位移；电机转速产生的力的方向与四轴飞行器坐标系右(X)-前(Y)-上(Z)的Z轴正方向重合；将四轴飞行器坐标系中与Z轴正方向重合的升力，转化到东-北-天的惯性坐标系中，通过坐标变换得出电机产生的升力在东-北-天的惯性坐标系中的坐标...

【专利技术属性】
技术研发人员：费庆，何照江，李保奎，王博，梁建建，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京,11