无人机及其云台控制方法与流程

1.本发明涉及涉及无人机技术领域，特别是涉及一种无人机及其云台控制方法。


背景技术：

2.航拍无人机包括消费级航拍无人机和专业级航拍无人机，无论是消费级航拍无人机还是专业级航拍无人机，其航拍质量均取决于无人机机身和云台的控制效果。飞行控制系统(flight control system,fcs)是保证无人机稳定飞行的基本前提，云台控制系统(gimbal control system,gcs)用于改善航拍视频质量，并且通过云台的减振系统来隔离机身的高频振动，其控制精度远高于fcs的控制精度。现有的航拍无人机中，gcs和fcs是独立的，亦即，gcs的俯仰、滚转通道不响应fcs姿态的变化，且gcs的偏航角一阶收敛于fcs的偏航角。
3.这种gcs/fcs独立控制思想存在以下缺点：
4.1、fcs没有gcs的控制权限，gcs只获取无人机实际的偏航角/偏航角速率信息，并且无任何反馈信息与fcs进行实时交互；
5.2、fcs的偏航控制力矩小，偏航控制与俯仰控制、滚转控制存在通道耦合，在受到外界干扰时，会造成fcs偏航通道转速不均匀，从而导致航拍视频不流畅，特别是在fcs控制无人机低转速偏航时，视频卡顿现象严重；
6.3、云台偏航通道的控制受到无人机偏航角控制的影响，并没有将gcs的高精度控制优点有效地发挥出来，造成fcs控制压力增大。


技术实现要素：

7.基于此，有必要针对现有技术中的上述问题，提供一种飞控系统和云台控制系统联合控制云台的偏航轴电机，能够消除视频卡顿现象的无人机及其云台控制方法。
8.为解决上述问题，本发明提供了一种无人机云台控制方法，所述无人机包括飞控系统和用于控制所述云台的云台控制系统，包括：
9.所述飞控系统生成所述无人机的偏航角速率指令；
10.所述云台控制系统根据所述无人机的偏航角速率指令，控制所述云台的偏航轴电机。
11.在本发明的一实施例中，所述云台控制系统根据所述无人机的所述偏航角速率指令，控制所述云台的所述偏航轴电机，包括：
12.判断输入所述无人机的偏航角速率指令是否为零；
13.若否，则：
14.所述云台控制系统获取所述云台的实际偏航角速率；
15.所述云台控制系统根据输入所述无人机的所述偏航角速率指令和所述云台的所述实际偏航角速率，生成所述云台的偏航轴电机控制指令；
16.所述云台控制系统获取所述云台的偏航轴电机附加控制指令，其中，所述偏航轴
电机附加控制指令用于控制所述云台的偏航轴电机以使得所述云台搭载的影像设备的视线与所述无人机的航向重合；
17.所述云台控制系统根据所述云台的所述偏航轴电机控制指令和所述云台的所述偏航轴电机附加控制指令，生成所述云台的偏航轴电机控制量；
18.根据所述云台的所述偏航轴电机控制量，控制所述云台的偏航轴电机。
19.在本发明的一实施例中，所述云台控制系统获取所述云台的所述偏航轴电机附加控制指令，包括：
20.所述云台控制系统获取所述云台的实际偏航角和所述无人机的实际偏航角；
21.所述云台控制系统根据所述云台的所述实际偏航角和所述无人机的所述实际偏航角，生成所述云台的所述偏航轴电机附加控制指令。
22.在本发明的一实施例中，该方法还包括：
23.若输入所述无人机的所述偏航角速率指令为零，则：
24.所述云台控制系统获取所述无人机的实际偏航角和所述云台的实际偏航角；
25.所述云台控制系统根据所述无人机的所述实际偏航角和所述云台的所述实际偏航角，生成所述云台的偏航角速率控制指令；
26.所述云台控制系统获取所述云台的实际偏航角速率；
27.所述云台控制系统根据所述云台的所述偏航角速率控制指令和所述云台的所述实际偏航角速率，生成所述云台的偏航轴电机控制量；
28.所述云台控制系统根据所述云台的所述偏航轴电机控制量，控制所述云台的偏航轴电机。
29.在本发明的一实施例中，所述飞控系统生成所述无人机的所述偏航角速率指令，包括：
30.所述飞控系统获取输入所述无人机的位置指令和视线指令中的至少一种；
31.所述飞控系统根据输入所述无人机的所述位置指令和所述视线指令中的至少一种，生成所述无人机的所述偏航角速率指令。
32.在本发明的一实施例中，所述飞控系统生成所述无人机的所述偏航角速率指令，包括：
33.所述飞控系统获取输入所述无人机的速度指令和视线变化率指令中的至少一种；
34.所述飞控系统根据输入所述无人机的所述速度指令和所述视线变化率指令中的至少一种，生成所述无人机的所述偏航角速率指令。
35.在本发明的一实施例中，该方法还包括：
36.所述云台控制系统根据输入所述云台的俯拍角度指令和所述云台的输出状态信息，控制所述云台的俯仰轴电机和滚转轴电机，其中，所述云台的所述输出状态信息包括所述云台的实际姿态角及实际姿态角速率。
37.在本发明的一实施例中，所述云台的所述实际姿态角包括所述云台的实际俯仰角，所述云台的所述实际姿态角速率包括所述云台的实际俯仰角速率；
38.所述云台控制系统根据输入所述云台的俯拍角度指令和所述云台的输出状态信息，控制所述云台的俯仰轴电机和滚转轴电机，包括：
39.所述云台控制系统根据所述云台的所述俯拍角度指令、所述云台的所述实际俯仰
角和所述实际俯仰角速率，生成所述云台的俯仰轴电机控制量；
40.根据所述云台的所述俯仰轴电机控制量，控制所述云台的俯仰轴电机。
41.在本发明的一实施例中，所述云台的所述实际姿态角还包括所述云台的实际滚转角，所述云台的所述实际姿态角速率还包括所述云台的实际滚转角速率；
42.所述云台控制系统根据输入所述云台的俯拍角度指令和所述云台的输出状态信息，控制所述云台的俯仰轴电机和滚转轴电机，包括：
43.所述云台控制系统根据所述云台的所述俯拍角度指令、所述云台的所述实际滚转角和所述实际滚转角速率，生成所述云台的滚转轴电机控制量；
44.所述云台控制系统根据所述云台的所述滚转轴电机控制量，控制所述云台的滚转轴电机。
45.在本发明的一实施例中，所述云台控制系统获取所述云台的所述俯拍角度指令，包括：
46.所述云台控制系统获取由遥控器或智能终端发出的所述云台的所述俯拍角度指令。
47.在本发明的一实施例中，该方法还包括：
48.所述飞控系统根据所述云台的所述输出状态信息，控制所述无人机的姿态。
49.在本发明的一实施例中，所述飞控系统根据所述云台的所述输出状态信息，控制所述无人机的姿态，包括：
50.所述飞控系统根据所述云台的所述实际姿态角，生成所述无人机的姿态角限幅；
51.所述飞控系统获取所述无人机的实际姿态角和输入所述无人机的姿态角指令；
52.所述飞控系统根据所述无人机的所述姿态角限幅、输入所述无人机的所述姿态角指令以及所述无人机的所述实际姿态角，生成所述无人机的姿态角速率控制指令；
53.所述飞控系统根据所述云台的所述实际姿态角速率，生成所述无人机的姿态角速率限幅；
54.所述飞控系统获取所述无人机的实际姿态角速率和输入所述无人机的所述偏航角速率指令；
55.所述飞控系统根据所述无人机的所述姿态角速率控制指令、所述无人机的所述姿态角速率限幅、输入所述无人机的所述偏航角速率指令以及所述无人机的所述实际姿态角速率，生成所述无人机的电机控制指令；
56.所述飞控系统根据所述无人机的所述电机控制指令，控制所述无人机的姿态。
57.为解决其技术问题，本发明还提供了一种无人机，包括：
58.机身；
59.机臂，与所述机身相连；
60.动力装置，设于所述机臂；
61.云台，与所述机身相连；
62.飞控系统，设于所述机身；以及
63.云台控制系统，设于所述云台或机身，且用于控制所述云台；
64.所述飞控系统用于生成所述无人机的偏航角速率指令；
65.所述云台控制系统用于：
66.根据所述飞控系统生成的所述无人机的所述偏航角速率指令，控制所述云台的偏航轴电机。
67.在本发明的一实施例中，所述云台控制系统具体用于：
68.判断所述无人机的偏航角速率是否为零；
69.当所述无人机的所述偏航角速率指令不为零，则：
70.获取所述云台的实际偏航角速率；
71.根据输入所述无人机的所述偏航角速率指令和所述云台的实际偏航角速率，生成所述云台的偏航轴电机控制指令；
72.获取所述云台的偏航轴电机附加控制指令，其中，所述偏航轴电机附加控制指令用于控制所述云台的偏航轴电机以使得所述云台搭载的影像设备的视线与所述无人机的航向重合；
73.根据所述云台的所述偏航轴电机控制指令和所述云台的所述偏航轴电机附加控制指令，生成所述云台的偏航轴电机控制量；以及
74.根据所述云台的所述偏航轴电机控制量，控制所述云台的偏航轴电机。
75.在本发明的一实施例中，所述云台控制系统具体用于：
76.获取所述云台的实际偏航角和所述无人机的实际偏航角；
77.根据所述云台的所述实际偏航角和所述无人机的所述实际偏航角，生成所述云台的所述偏航轴电机附加控制指令。
78.在本发明的一实施例中，当输入所述无人机的偏航角速率指令为零，则所述云台控制系统还用于：
79.获取所述无人机的实际偏航角和所述云台的实际偏航角；
80.根据所述无人机的所述实际偏航角和所述云台的所述实际偏航角，生成所述云台的偏航角速率控制指令；
81.获取所述云台的实际偏航角速率；
82.根据所述云台的所述偏航角速率控制指令和所述云台的所述实际偏航角速率，生成所述云台的偏航轴电机控制量；
83.根据所述云台的所述偏航轴电机控制量，控制所述云台的偏航轴电机。
84.在本发明的一实施例中，所述飞控系统具体用于：
85.获取所述无人机的位置指令和视线指令中的至少一种；以及
86.根据所述无人机的所述位置指令和所述视线指令中的至少一种，生成所述无人机的所述偏航角速率指令。
87.在本发明的一实施例中，所述飞控系统具体用于：
88.获取所述无人机的速度指令和视线变化率指令中的至少一种；
89.根据所述无人机的所述速度指令和所述视线变化率指令中的至少一种，生成所述无人机的所述偏航角速率指令。
90.在本发明的一实施例中，所述云台控制系统还用于：
91.根据输入所述云台的俯拍角度指令和所述云台的输出状态信息，控制所述云台的俯仰轴电机和滚转轴电机，其中，所述云台的所述输出状态信息包括所述云台的实际姿态角及实际姿态角速率。
92.在本发明的一实施例中，所述云台控制系统具体用于：
93.根据所述云台的所述俯拍角度指令、所述云台的所述实际俯仰角和所述实际俯仰角速率，生成所述云台的俯仰轴电机控制量；
94.根据所述云台的所述俯仰轴电机控制量，控制所述云台的俯仰轴电机。
95.在本发明的一实施例中，所述云台控制系统还用于：
96.根据所述云台的所述俯拍角度指令、所述云台的所述实际滚转角和所述实际滚转角速率，生成所述云台的滚转轴电机控制量；
97.根据所述云台的所述滚转轴电机控制量，控制所述云台的滚转轴电机。
98.在本发明的一实施例中，所述云台控制系统具体用于获取由遥控器或智能终端发出的所述云台的所述俯拍角度指令。
99.在本发明的一实施例中，所述飞控系统还用于：
100.根据所述云台的所述输出状态信息，控制所述无人机的姿态。
101.在本发明的一实施例中，所述飞控系统具体用于：
102.根据所述云台的所述实际姿态角，生成所述无人机的姿态角限幅；
103.获取所述无人机的实际姿态角和输入所述无人机的姿态角指令；
104.根据所述无人机的所述姿态角限幅、输入所述无人机的所述姿态角指令以及所述无人机的所述实际姿态角，生成所述无人机的姿态角速率控制指令；
105.根据所述云台的所述实际姿态角速率，生成所述无人机的姿态角速率限幅；
106.获取所述无人机的实际姿态角速率和输入所述无人机的偏航角速率指令；
107.根据所述无人机的所述姿态角速率控制指令、所述无人机的所述姿态角速率限幅、输入所述无人机的所述偏航角速率指令以及所述无人机的所述实际姿态角速率，生成所述无人机的电机控制指令；
108.根据所述无人机的所述电机控制指令，控制所述无人机的姿态。
109.本发明由飞控系统和云台控制系统联合控制云台偏航轴电机，最大限度发挥了云台控制系统高精度控制和快速响应的优点，利用该优点来补偿飞控系统在偏航控制上的不足，实现了对云台偏航通道的增稳，彻底解决了当无人机低速偏航时，航拍视频的卡顿现象。
附图说明
110.图1为本发明一种无人机其中一实施例的结构示意图；
111.图2为本发明无人机中飞控系统和云台控制系统的控制原理框图；
112.图3为本发明无人机中飞控系统的控制原理框图；
113.图4为本发明无人机中云台控制系统的控制原理框图；
114.图5为本发明无人机中飞控系统和云台控制系统对云台的偏航轴电机进行联合控制的原理框图；
115.图6为本发明一种无人机云台控制方法的其中一实施例的流程图；
116.图7为图6所示方法中步骤s200其中一实施例的流程图；
117.图8为图6所示方法中步骤s300中云台控制系统控制俯仰轴电机的流程图；
118.图9为图6所示方法中步骤s300中云台控制系统控制滚转轴电机的流程图；
119.图10为图6所示方法中步骤s400中飞控系统根据云台控制系统的输出状态信息，控制无人机的姿态的流程图。
具体实施方式
120.为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
121.如图1所示，本发明提出的一种无人机30包括机身31、与机身31相连的机臂32、设置在机臂32一端的动力装置33、与机身31相连的云台35、与所述云台35相连的影像设备34以及设置在机身21内的飞控系统、imu、gps以及用于控制所述云台35的云台控制系统。
122.在本实施例中，机臂32的数量为4，即该无人机30为四旋翼飞行器，在其他可能的实施例中，机臂32的数量也可以为3、6、8、10等。无人机30还可以是其他需要对其所处飞行环境进行风速估计或报警的可移动物体，例如行业无人机、载人飞行器、航模、无人飞艇、固定翼无人机和无人热气球等。机臂32可与所述机身31固定连接、一体成型或可相对于所述机身31折叠。
123.动力装置33包括设置在机臂32一端的电机332以及与电机332的转轴相连的螺旋桨331。电机332的转轴转动以带动螺旋桨331旋转从而给无人机30提供飞行所需的拉升力。
124.影像设备34可以为激光传感器、rgbd深度相机或者摄像机等。
125.视觉系统可以包括双目和/或单目摄像头以及视觉芯片。视觉芯片设于所述机身内部，与飞控系统通信连接。双目和/或单目摄像头可以设置在机身的前部、下部和后部中的任意一个或两个位置，也可以设置在任何其他合适的位置。
126.惯性测量单元(imu)(图未示出)是用于测量无人机三轴姿态角以及加速度的装置。imu可以包括三轴陀螺仪和三个方向的加速度计，以此来测量无人机在三维空间中的姿态角信息和加速度信息。imu可以设置在无人机30的机身31的内部，例如，可以设置在无人机30的重心位置，也可以设置在其他合适的位置。
127.全球定位系统(gps)(图未示出)用于测量无人机在三维空间中的位置信息和速度信息。gps可以设置在无人机30的机身31上，也可以设置在机臂32上。在某些实施例中，机身31还可以包括起落架，gps也可以设置在起落架上，以远离其他电子设备的干扰。
128.飞控系统(图未示出)用于稳定无人机30的飞行姿态并控制无人机30自主或半自主飞行。飞控系统可以实时采集无人机各传感器测量的飞行状态数据、接收控制终端发来的控制指令及数据，并将该控制指令和数据输出给执行机构(例如动力装置)以实现对无人机飞行姿态或执行任务的控制。在本发明的实施例中，飞控系统可以包括飞控芯片和与飞控芯片通信连接的处理器等其他必要的单元。飞控系统可以设置在无人机30的机身31内部，也可以设置在机身31的外表面或任何其他可能的位置。
129.在本发明的实施例中，影像设备34通过云台35与机身31相连，云台控制系统控制云台35允许影像设备34相对于无人机30绕至少一个轴转动，且用于减轻甚至消除动力装置33传递给影像设备34的振动，以保证影像设备34能够拍摄出稳定清晰的图像或视频。在本发明的一实施例中，云台35为三轴云台，即云台35允许影像设备34绕偏航轴、滚转轴、俯仰轴转动，因此，云台35相应的具有用于驱动影像设备34绕偏航轴转动的偏航轴电机、用于驱
动影像设备34绕滚转轴转动的滚转轴电机以及用于驱动影像设备34绕俯仰轴转动的俯仰轴电机。
130.在本发明的实施例中，飞控系统和云台控系统能够相互配合以提高无人机在各种状态下(悬停、正常飞行、极端飞行等)低速偏航时，云台35控制影像设备34绕偏航轴转动时影像设备34的航拍质量。
131.因此，本发明提供了一种飞控系统和云台控制系统的联合控制方案，实现了航拍的高精度控制，达到了航拍增稳效果，保证无人机在偏航通道低转速的情况下，云台偏航通道转速的均匀性，彻底解决了低转速航拍时的视频卡顿现象。
132.图2给出了本发明无人机飞控系统36和云台控制系统37的联合控制结构框图。以下将分为几个部分对图2给出的控制机制进行描述。
133.飞控系统对无人机的控制：
134.如图2和图3所示，飞控系统36包括位置控制部分和姿态控制部分，因此可以认为飞控系统36包括位置控制模块361和姿态控制模块362。其中，位置控制模块361用于控制所述无人机30的位置和/或速度。姿态控制模块362用于控制所述无人机30的姿态。
135.飞控系统36获取由无人机30的视觉系统、智能控制终端、遥控器、或导航系统输入无人机30的控制指令101，位置控制模块361根据控制指令101和无人机30的输出状态信息108，输出控制指令102。
136.其中，控制指令101包括无人机30的位置指令和速度指令中的至少一种。在其他可能的实施例中，控制指令101还可以包括视线指令和视线变化率指令中至少一种。控制指令102包括无人机30的姿态角指令102.1、电机的推力指令和输入无人机的偏航角速率指令103。无人机30的输出状态信息108包括无人机的实际速度、无人机的实际姿态角108.2(包括无人机的实际滚转角、实际俯仰角和实际偏航角108.21(如图4))以及无人机的实际姿态角速率108.1(包括无人机的实际滚转角速率、实际俯仰角速率和实际偏航角速率)。
137.姿态控制模块362根据控制指令102、无人机30的输出状态信息108以及云台35的输出状态信息109，输出控制指令104，以对无人机30的执行机构(即，动力装置33)进行控制，从而实现对无人机姿态的控制。
138.在本发明的一实施例中，控制指令104为用于控制无人机30电机的控制信号。在其他实施例中，当无人机为固定翼飞机或混合翼飞机时，控制指令104也可以是固定翼飞机的推力及舵偏角，或者混合翼飞机的混合控制量。云台35的输出状态信息109包括云台的实际姿态角和实际姿态角速率。具体地，云台35的输出状态信息109可以分为状态信息109.1和状态信息109.2(如图4所示)。其中，状态信息109.1包括云台35的实际俯仰角、实际俯仰角速率、实际滚转角及实际滚转角速率。状态信息109.2包括云台35实际偏航角109.21及实际偏航角速率109.22。
139.值得注意的是，当云台35处于不同的航拍角度时，对无人机30姿态的敏感度会有所不同，本发明可针对云台35不同的航拍角度，来动态调整无人机30的姿态角度和/或姿态角速率的限制条件，以保证云台的高精度和稳定性。这是由于不同的飞行状态，云台35受到的扰动不同，尤其在极端飞行情况下，云台30受到的扰动极为明显，因此需要对无人机30的飞行姿态进行限制，此举有利于对云台进行增稳。例如，当云台35的航拍角度为-90
°
～75
°
时，将无人机30的俯仰角限制为
±
20
°
；当云台35的航拍角度为-10
°
～0
°
时，将无人机30的
俯仰角限制为
±
25
°
；其他情况均将无人机30的俯仰角限制在
±
30
°
。
140.具体来说，如图3所示，飞控系统36可根据云台35的输出状态信息109自动生成无人机的姿态角限幅111和无人机的姿态角速率限幅112，从而对无人机30的姿态进行限制。
141.姿态控制模块362根据控制指令102中的姿态角指令102.1、无人机的实际姿态角108.2，以及无人机的姿态角限幅111生成无人机30的姿态角速率控制指令110。
142.姿态控制模块362根据无人机的姿态角速率控制指令110、无人机的偏航角速率指令103、无人机的姿态角速率限幅112和无人机的实际姿态角速率108.1，生成电机控制指令104，并根据该电机控制指令104控制无人机的姿态。
143.在本发明的一实施例中，所述姿态角指令102.1主要包括俯仰角指令和滚转角指令，在其他实施例中个，姿态角指令102.1还可以包括偏航角指令。无人机的实际姿态角108.2主要包括实际俯仰角和实际滚转角，还可以包括实际偏航角。无人机的姿态角限幅111主要包括俯仰角限幅和滚转角限幅。其中，无人机的姿态角限幅111可以根据云台输出状态信息109中的云台的实际姿态角(主要包括云台的实际俯仰角和实际滚转角生成)。无人机的姿态角速率控制指令110主要包括俯仰角速率控制指令和滚转角速率控制指令，无人机的姿态角速率限幅112主要包括俯仰角速率限幅、滚转角速率限幅和偏航角速率限幅。无人机的姿态角速率限幅112可根据云台输出状态信息109中云台35的实际姿态角速率生成。
144.飞控系统和云台控制系统对云台的联合控制：
145.如图4所示，云台控制系统37对云台35的控制可以分为两个部分，一是对云台35的偏航轴电机的控制，二是对云台35的俯仰轴电机和滚转轴电机的控制。其中，对云台35的偏航轴电机的控制是由飞控系统36和云台控制系统37共同完成的。图5为本发明中飞控系统36和云台控制系统37对云台35的偏航轴电机进行联合控制的原理框图。
146.如图5所示，飞控系统36首先将控制指令102中输入无人机的偏航角速率指令103发送给云台控制系统37，云台控制系统37获取输入无人机的偏航角速率指令103后进行逻辑判断。判断输入无人机的偏航角速率指令103是否为零。
147.当输入无人机的偏航角速率指令103不为零时，将云台35的偏航轴电机的控制权限交给飞控系统36，云台35的偏航角速率误差权重较大，偏航角误差只作为补偿，权重较低。具体说来，此时，由于输入无人机的偏航角速率指令103不为零，则云台控制系统37选择控制率1(控制律(control law)，云台控制系统形成控制指令的算法，描述了受控状态变量与系统输入信号之间的函数关系。)，云台控制系统37根据无人机的偏航角速率指令103和云台35的实际偏航角速率109.22，生成云台35的偏航轴电机控制指令。然后，云台控制系统37生成云台35的偏航轴电机附加控制指令，最后根据云台35的偏航轴电机控制指令和云台35的偏航轴电机附加控制指令，生成云台35的偏航轴电机控制量，并根据该偏航轴电机控制量控制云台的偏航轴电机。
148.在本发明的一实施例中，云台35的偏航轴电机附加控制指令是指云台的实际偏航角109.21与无人机的实际偏航角108.21之间的差值。引入云台的偏航轴电机附加控制指令是为了使得云台35搭载的影像设备34的视线与无人机的航向尽量重合或保持一致。
149.无人机的偏航角速率指令103反应了飞控系统对无人机偏航通道的控制期望，云台控制系统37利用其自身具有的高精度控制和快速响应的特点，结合飞控系统给出的无人
机的偏航角速率指令103，来对云台的偏航轴电机进行控制，因此能够最大限度地发挥云台控制系统高精度控制和快速响应的优点，实现对云台偏航轴的增稳，进而消除其搭载的影像设备在偏航轴方向上的卡顿。
150.如图5所示，当输入无人机的偏航角速率指令103为零时将云台35的偏航轴电机的控制权限交给云台控制系统37，云台控制系统37选择控制率2，即由云台控制系统37直接控制云台35的偏航轴电机，云台35的偏航轴电机不受飞控系统36输出指令的影响。此时云台控制系统37获取无人机的实际偏航角108.21和云台的实际偏航角109.21，根据无人机的实际偏航角108.21和云台的实际偏航角109.21生成云台的偏航角速率控制指令，然后再获取云台的实际偏航角速率109.22，最后根据云台的偏航角速率控制指令和云台的实际偏航角速率109.22，生成云台35的偏航轴电机的控制量，控制云台35的偏航轴电机。此时，云台的偏航角一阶收敛于无人机的偏航角。
151.值得注意的是，不论云台控制系统37选择控制率1还是控制率2，云台35的俯仰轴电机和滚转轴电机的控制权限一直属于云台控制系统37。
152.如图4所示，云台控制系统37对俯仰轴电机和滚转轴电机的控制具体为：云台控制系统37获取输入云台35的俯拍角度指令100、云台的实际俯仰角和实际俯仰角速率，根据云台35的俯拍角度指令100、云台的实际俯仰角和实际俯仰角速率生成云台的俯仰轴电机控制量，云台控制系统37根据该俯仰轴电机控制量控制云台35的俯仰轴电机。
153.相似的，云台控制系统37获取输入云台35的俯拍角度指令100，云台的实际滚转角和实际滚转角速率，根据云台的俯拍角度指令100、云台的实际滚转角和实际滚转角速率生成云台的滚转轴电机控制量，云台控制系统37根据该滚转轴电机控制量控制云台35的滚转轴电机。
154.在本发明的一实施例中，上述云台35的俯拍角度指令100可以由遥控器或智能终端(如手机或平板电脑上的app)发出。
155.其中，图4中的状态信息109.1包括云台35的实际俯仰角、实际俯仰角速率、实际滚转角及实际滚转角速率。控制指令107.1包括云台的俯仰轴电机控制量和云台的滚转轴电机控制量。控制指令107.2为云台的偏航轴电机控制量。
156.以上这种由飞控系统和云台控制系统联合控制云台偏航轴电机的方案，巧妙地利用云台控制系统高精度、快速响应的特性来补偿飞控系统在偏航控制上的不足，最大限度发挥了云台控制系统高精度控制和快速响应的优点，利用该优点来补偿飞控系统在偏航控制上的不足，实现了对云台偏航通道的增稳，彻底解决了当无人机低速偏航时，航拍视频的卡顿现象。
157.如图6所示，本发明还提供了一种云台控制方法，包括：
158.s100、飞控系统生成无人机的偏航角速率指令。
159.在本发明的一实施例中，无人机的偏航角速率指令可以由无人机的飞控系统根据输入无人机的位置指令和速度指令中的至少一种生成。在其他可能的实施例中，飞控系统还可以根据视线指令和视线变化率指令中至少一种，生成无人机的偏航角速率指令。在本发明的一实施例中，位置指令、速度指令、视线指令和视线变化率指令中的任意一种均可以为由无人机的视觉系统、智能控制终端、遥控器、或导航系统输入。
160.s200、云台控制系统根据无人机的所述偏航角速率指令，控制云台的偏航轴电机。
161.如图7所示，在本发明的一实施例中，该步骤又包括：
162.s201、判断输入无人机的偏航角速率指令是否为零。
163.在本发明的一实施例中，可以由无人机的云台控制系统判断输入无人机的偏航角速率指令是否为零。无人机的偏航角速率指令是否为零，决定了云台控制系统采用的控制率。可参考图5，当输入无人机的偏航角速率指令不为零时，将云台的偏航轴电机的控制权限交给无人机的飞控系统，云台的偏航角速率误差权重较大，偏航角误差只作为补偿，权重较低。当输入无人机的偏航角速率指令为零时，将云台的偏航轴电机的控制权限交给云台控制系统，即由云台控制系统直接控制云台的偏航轴电机，云台的偏航轴电机不受飞控系统的影响。值得注意的是，不论云台控制系统选择控制率1还是控制率2，云台的俯仰轴电机和滚转轴电机的控制权限一直属于云台控制系统。
164.当输入无人机的偏航角速率指令不为零时，由云台控制系统执行步骤s202-s206：
165.s202：获取云台的实际偏航角速率。
166.在本发明的一实施例中，云台的实际偏航角速率可以由云台的imu测量得到，其中，云台的imu一般安装于云台，并与云台控制系统通信连接。也可以由云台反馈的输出状态信息得到，其中，云台的输出状态信息包括云台的实际姿态角及其角速率，即，云台的实际俯仰角、实际俯仰角速率、实际滚转角、实际滚转角速率、实际偏航角及实际偏航角速率。
167.s203、根据输入无人机的偏航角速率指令和云台的实际偏航角速率，生成云台的偏航轴电机控制指令。
168.s204、获取云台的偏航轴电机附加控制指令。
169.在本发明的一实施例中，云台的偏航轴电机附加控制指令是指云台的实际偏航角与无人机的实际偏航角之间的差值，该指令可保证云台搭载的影像设备的视线与无人机的航向或视线保持一致。其中，云台的实际偏航角可以由云台的imu测量得到，或由云台反馈的输出状态信息得到。无人机的实际偏航角则可由无人机的imu测量得到，或者由无人机反馈的输出状态信息得到。无人机的输出状态信息包括无人机的实际姿态角及其角速率，即，无人机的实际俯仰角、实际俯仰角速率、实际滚转角、实际滚转角速率、实际偏航角及实际偏航角速率。
170.s205、根据云台的偏航轴电机控制指令和云台的偏航轴电机附加控制指令，生成云台的偏航轴电机控制量。
171.s206、根据云台的偏航轴电机控制量，控制云台的偏航轴电机。
172.当输入无人机的偏航角速率指令为零时，执行步骤s207-s211：
173.s207、获取无人机的实际偏航角和云台的实际偏航角。
174.同样的，无人机的实际偏航角可以由无人机的imu测量得到或无人机反馈的输出状态信息得到，云台的实际偏航角可由云台的imu测量得到或云台反馈的输出状态信息得到。
175.s208、根据无人机的实际偏航角和云台的实际偏航角，生成云台的偏航角速率控制指令。
176.s209、获取云台的实际偏航角速率。
177.s210、根据云台的偏航角速率控制指令和云台的实际偏航角速率，生成云台的偏航轴电机控制量。
178.s211、根据云台的偏航轴电机控制量，控制云台的偏航轴电机。
179.在本发明的一实施例中，该方法还包括：
180.s300、云台控制系统根据输入云台的俯拍角度指令和云台的输出状态信息，控制云台的俯仰轴电机和滚转轴电机，其中，所述云台的所述输出状态信息包括所述云台的实际姿态角和实际姿态角速率。
181.在本发明的一实施例中，云台的实际姿态角包括实际俯仰角、实际滚转角和实际偏航角。云台的实际姿态角速率包括实际俯仰角速率、实际滚转角速率和实际偏航角速率。
182.在本发明的一实施例中，输入云台的俯拍角度指令可以由遥控器或智能终端发出，其中，遥控器用于控制无人机，与无人机通信连接。智能终端包括手机、平板电脑等，智能终端上通常安装有用于控制无人机的app。
183.如图8所示，云台控制系统根据输入云台的俯拍角度指令和云台的输出状态信息，控制云台的俯仰轴电机包括：
184.s301、根据云台的俯拍角度指令、云台的实际俯仰角和实际俯仰角速率，生成云台的俯仰轴电机控制量。
185.s302、根据上述云台的俯仰轴电机控制量，控制云台的俯仰轴电机。
186.类似的，云台控制系统对云台的滚转轴电机的控制包括：
187.s303、根据输入云台的俯拍角度指令、云台的实际滚转角和实际滚转角速率，生成云台的滚转轴电机控制量。
188.s304、根据上述云台的滚转轴电机控制量，控制云台的滚转轴电机。
189.在本发明的一实施例中，该方法还包括：
190.s400、飞控系统根据云台的输出状态信息，控制无人机的姿态。
191.其中，所述无人机的姿态包括无人机的姿态角和无人机的姿态角速率。
192.如图10所示，步骤s400进一步包括：
193.s401、根据云台的实际姿态角，生成无人机的姿态角限幅。
194.在本发明的一实施例中，云台的实际姿态角主要包括云台的实际俯仰角和实际滚转角，在其他可能的实施例中，还可以进一步包括云台的实际偏航角。云台的实际姿态角均可以通过云台反馈的输出信息得到。对应的，无人机的姿态角限幅主要包括无人机的俯仰角限幅和滚转角限幅，还可以进一步包括无人机的偏航角限幅。
195.s402、获取无人机的实际姿态角和输入无人机的姿态角指令。
196.在本发明的一实施例中，无人机的实际姿态角可以通过无人机反馈的输出状态信息(包括实际姿态角和实际姿态角速率)得到，也可以通过无人机的imu测量得到。无人机的姿态角指令主要包括输入无人机的俯仰角指令和滚转角指令。其中，输入无人机的俯仰角指令和滚转角指令可以由飞控系统根据输入无人机的位置指令、速度指令、视线指令和视线变化率指令中的至少一种生成。
197.s403、根据无人机的姿态角限幅、输入无人机的姿态角指令、以及无人机的实际姿态角，生成无人机的姿态角速率控制指令。
198.其中，无人机的姿态角控制指令主要包括无人机的俯仰角速率控制指令和滚转角速率控制指令。
199.s404、根据云台的实际姿态角速率，生成无人机的姿态角速率限幅。
200.云台的实际姿态角速率包括云台的实际俯仰角速率、实际滚转角速率即实际偏航角速率。因此，无人机的姿态角速率限幅包括无人机的俯仰角速率限幅、滚转角速率限幅及偏航角速率限幅。
201.s405、获取无人机的实际姿态角速率和输入无人机的偏航角速率指令。
202.输入无人机的偏航角速率指令可以通过步骤s100的方式获取。
203.s406、根据无人机的姿态角速率控制指令、无人机的姿态角速率限幅、输入无人机的偏航角速率指令以及无人机的实际姿态角速率，生成无人机的电机控制指令。
204.s407、根据上述无人机的电机控制指令，控制无人机的姿态。
205.本发明一种云台控制方法的详细描述可参考对无人机实施例的详细描述。
206.本发明的云台控制方法，采用云台控制系统与飞控系统联合控制，最大限度发挥了云台控制系统高精度控制和快速响应的优点，利用该优点来补偿飞控系统在偏航控制上的不足，实现了对云台偏航通道的增稳，彻底解决了当无人机低速偏航时，航拍视频的卡顿现象。
207.本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关的硬件来完成，所述的程序可存储于一非易失性计算机可读取存储介质中，该程序在执行时，可包括如上述各方法的实施例的流程。其中，所述的存储介质可为磁碟、光盘、只读存储记忆体(read-only memory，rom)等。
208.以上所述实施例的各技术特征可以进行任意的组合，为使描述简洁，未对上述实施例中的各个技术特征所有可能的组合都进行描述，然而，只要这些技术特征的组合不存在矛盾，都应当认为是本说明书记载的范围。
209.以上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。