[发明专利]一种利用矢量旋转法来进行四旋翼飞机控制的方法

说明书

技术领域

本发明涉及一种四旋翼飞机控制方法，尤其涉及一种利用矢量旋转法来进行四旋翼飞机控制的方法。

背景技术

四旋翼飞行器是一种能实现垂直起降的非共轴式多旋翼飞行器，结构如图1所示，其可以只通过调节蝶形分布的四个旋翼的转速，实现对四旋翼飞行器飞行姿态的控制.其本身是一个具有六自由度和4个控制输入的非线性欠驱动系统，具有对外界和自身抗干扰敏感的特性控制的主要问题是解决强耦合性和不稳定的动力特性。由于不需要尾翼，四旋翼飞行器结构更加紧凑，四个旋翼的提升力比单旋翼更加均匀，因而飞行姿态更加稳定。另外，四旋翼飞行器还具有起飞要求低、可悬停等特点。

在四旋翼飞行器的前后运动和侧向运动都是使飞行器在对应的方向上倾斜一定的角度，即机体上水平角度检测装置测试出来的是沿X方向和Y方向的倾角，遥控器遥杆前后左右的控制分别对应X型四旋翼Y和X方向上的倾角，在物理上的机头、机尾、左侧和右侧方向的控制，参照图1，即机头对应电机1和电机4，机尾对应电机2和电机3，左侧对应电机1和电机2，右侧对应电机3和电机4，对前后运动来说，当机头正向朝前时，遥控器方向遥杆前推，飞机远离操控者，方向遥杆向回拉时，飞机朝操控者飞来，但是当机体旋转一定角度如图8所示，遥控器遥杆前推，飞机会向左前方飞行，对于新手很难控制。

发明内容

为了克服现有技术的上述缺点，本发明提供了一种利用矢量旋转法来进行四旋翼飞机控制的方法。

为了解决上述技术问题，本发明通过下述技术方案得以解决：

一种利用矢量旋转法来进行四旋翼飞机控制的方法，将四旋翼飞机接收到的遥控器发来的Roll和Pitch方向的控制量转换为矢量，对应在坐标系中分别是X方向和Y方向，再根据机身旋转角度对该矢量进行旋转后重新映射到新的坐标系X′Y′中上以控制整个机身前进、后退、左飞、右飞。

一种利用矢量旋转法来进行四旋翼飞机控制的方法，将接收到遥控X方向A控制量和Y 方向B控制量作用于四旋翼控制上，其作用力控制量为大小为和Pitch方向的控制角度为在四旋翼空间坐标系中当机体旋转θ，则对整个机体的控制方向为再对根据机身控制角重新映射在X′和Y′方向，以达到遥控矢量旋转来控制四旋翼飞行的目的。

进一步地，四旋翼飞机带有可检测机体旋转角度的陀螺装置，能够准确计算出旋转角θ。

进一步地，当四旋翼飞行器距离操控者较远，操控者无法辨识机头方向时，四旋翼飞机可通过所述方法自由控制。

进一步地，在遥控数据等效数学模型中，Roll控制参量在X方向为一个大小为A的控制量，Pitch控制参量在Y方向是一个大小为B的控制量，作用在四旋翼上是一个大小为|C|，和机头方向夹角为的矢量，其中

对四旋翼如果机体旋转角θ可通过飞行器陀螺仪装置获取，则遥控器控制飞机机身整体向前则实际作用角度为控制量大小为|C|，所以转换后的X′方向控制矢量A′和Y′方向的控制矢量B′如下：

根据转换后的A′和B′来控制电机的转速即可实现四旋翼的控制。

本发明的一种利用矢量旋转法来进行四旋翼飞机控制的方法可以实现以下三种控制模式：

1.无头控制模式，当四旋翼飞行器距离操控者较远，操控者无法辨识机头方向，可启动该模式自由控制；

2.远距离断线返航，如果远距离飞行器接收不到遥控数据后可根据运动轨迹自动靠近操控者；

3一键返航，通过一个按键触发让飞行器靠近操控者。

附图说明

此处所说明的附图用来提供对本发明的进一步理解，构成本申请的一部分，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：

图1为本发明的四旋翼飞行器结构示意图；

图2为本发明的四旋翼飞行器垂直运动原理示意图；

图3为本发明的四旋翼飞行器滚动运动原理示意图；

图4为本发明的四旋翼飞行器俯仰运动原理示意图；

图5为本发明的四旋翼飞行器偏航运动原理示意图；

图6为本发明的四旋翼飞行器前后运动原理示意图；

图7为本发明的四旋翼飞行器侧向运动原理示意图；

图8为本发明的四旋翼飞行器倾斜角度前进飞行原理示意图；

图9为本发明的四旋翼飞行器飞行姿态原理示意图；

图10为本发明的四旋翼飞行器遥控数据等效数学模型原理示意图；

图11为本发明的四旋翼飞行器的数学模型示意图。