具体实施方式

下面结合附图和具体实施例对本发明做进一步详细描述。

本发明一种复合翼无人机悬停自动对风的方法，无人机在旋翼模态下垂直起降时，分定点悬停阶段、航向调整阶段两个阶段控制无人机机头方向自动对准风的来流方向，使机头迎风以提高无人机的抗风能力。当无人机刚起飞或准备垂直降落时，无人机先进入定点悬停阶段，无人机定点悬停时间t后，即刻进入航向调整阶段，根据滚转角指令判断，结合旋翼拉力的水平分力、旋翼旋转反扭矩差及固定翼方向舵提高无人机偏航角速率的控制能力，调整机头航向，实现自动对风。

本发明的方法主要应用于复合翼无人机垂直起降或悬停时，实现自动对风。复合翼无人机在风向不定，风速经常变化的环境下起降或悬停，通过使用本发明方法，时刻自动调整机头航向，使无人机迎风，有效防止旋翼的控制量饱和，可同时提高无人机的飞行稳定性与旋翼动力系统的续航能力；无人机的自动对风亦可减轻操作人员负担，使工作人员能将主要精力集中在任务上，而非无人机的安全上。

优选方案为：应用本发明方法的复合翼无人机，优选方案如图1所示，无人机由机身、机翼、双尾撑杆、倒“V”尾、发动机T及4个旋翼系统(M1、M2、M3、M4)组成，形成“固定翼+四旋翼”的复合翼无人机。倒“V”尾上安装有操纵舵面，舵面可用作方向舵，在有风环境下可提高无人机起降或悬停时的对风能力。旋翼系统安装与双尾撑杆上，用于无人机的起降与悬停，为无人机提供动力并控制无人机姿态，当其控制量饱和后，将会造成无人机飞行稳定性变差，续航降低。旋翼旋转平面向双尾撑之间倾斜安装，与水平面成3～5°的夹角。这样旋翼的拉力可产生一个指向内侧的水平分力，增强无人机航向控制的能力。

本发明一种复合翼无人机悬停自动对风的方法，如图2所示，优选方案步骤如下：

(1)当无人机刚起飞或准备垂直降落时，无人机先进入定点悬停阶段，使无人机在设定的悬停固定点上及距离悬停固定点设定的距离内，进行定点悬停；优选方案步骤如下：

步骤(1)无人机起飞至离地高度2～5m或准备从离地高度30～50m处垂直降落时，无人机先进入定点悬停阶段，使无人机在设定的悬停固定点上及距离悬停固定点设定的距离L内，进行定点悬停(取L＝2m，此悬停区域为以悬停固定点为圆心，半径为2m的圆形区域)；具体如下：

无人机起飞或降落时，处于旋翼模式控制，无人机切入定点悬停模态，实现无人机定高定点控制，在无人工遥控干预的情况下，通过调整俯仰或滚转姿态实现定点悬停；

处于旋翼模式控制是指：只有旋翼(M1、M2、M3、M4)为无人机提供动力，无其他动力来源(发动机T不工作)，对飞行器进行控制。

定点悬停模态，是指无人机通过位置控制，以设定的悬停固定点为目标位置，逐渐靠近直至到达悬停固定点后进行悬停的状态。

(2)在设定的无人机定点悬停时间t内，判断是否有人工干预，若有，则重新计时，返回定点悬停阶段；否则即刻进入航向调整阶段，根据无人机定点悬停的悬停固定点位置与无人机当前的位置的水平横向距离，确定期望达到的滚转角，形成滚转角指令，根据滚转角指令，判断滚转角指令是否达到设定的滚转角阈值；若达到，进行步骤(3)，否则，不需要调整无人机航向；优选方案步骤如下：

优选方案为：设定的无人机定点悬停时间t，具体要求为：使无人机有足够的时间悬停，产生稳定的俯仰角或者滚转角，同时不损耗太多的续航，优选5s≤t≤10s。

人工干预，是指：通过遥控器或者其他人为手段，调整无人机姿态或位置，使无人机退出在悬停固定点自动悬停的状态。

优选方案为：根据无人机定点悬停的悬停固定点位置与无人机当前的位置的水平横向距离Y，确定期望达到的滚转角，形成滚转角指令，具体为：如图3所示的控制框图，水平横向距离Y的大小决定无人机的横向运动速度V_c，由V_c计算出此时无人机所需达到的滚转角，即为滚转角指令φ_c，控制律如下公式所示，其中分别为距离到速度、速度到滚转角的比例增益，优选为：

优选方案为：根据滚转角指令φ_c，判断滚转角指令φ_c的绝对值|φ_c|是否达到设定的滚转角阈值Φ，具体为：滚转角阈值Φ的大小体现自动调整航向的敏感度，Φ值越小航向调整越敏感。这里把Φ取为5°，当|φ_c|>5°时，则需要调整机头航向对风，否则不需要调整。

在无人工遥控干预的情况下，通过调整俯仰或滚转姿态实现定点悬停，优选方案具体如下：

优选方案为：无风或完全顺逆风情况下，无人机长时间定点悬停，只调整俯仰姿态，顺风时增加旋翼M1、M2的转速，降低旋翼M3、M4的转速，控制无人机抬头，对抗顺风；逆风时降低旋翼M1、M2的转速，增加旋翼M3、M4的转速，控制无人机低头，对抗逆风，直至将无人机控制的悬停区域内，不调整滚转姿态，产生滚转角指令φ_c为0°，此时无需调整机头航向；

优选方案为：在侧风环境下，风向来自机翼两侧，无人机控制位置维持定点悬停，不调整俯仰姿态，只调整滚转角，产生滚转角指令φ_c。遇左侧风时，降低旋翼M2、M3的转速，增加旋翼M1、M4的转速，使无人机产生左滚转角，此时φ_c<0°，将无人机控制在悬停区域内；遇右侧风时，增加旋翼M2、M3的转速，降低旋翼M1、M4的转速，使无人机产生右滚转角，此时φ_c>0°，通过控制滚转角对抗侧风，维持无人机悬停在固定点；

优选方案为：无人机进入航向调整阶段后，采用以下控制策略：(1)无人机继续维持定点悬停模态；(2)判断当前滚转角指令φ_c的绝对值|φ_c|是否大于设定的阈值Φ，若当前滚转角指令φ_c的绝对值|φ_c|大于设定的阈值Φ，则产生无人机的偏航角速率控制指令，φ_c<0°时为左滚转，产生逆时针方向的偏航角速率指令，φ_c>0°时为右滚转，产生顺时针方向的偏航角速率指令，控制无人机的偏航角速率，以控制调整无人机机头航向，使机头迎风，完成航向调整。

(3)调整无人机航向，使机头对准来流方向，完成无人机悬停自动对风。优选方案步骤如下：

控制框图如图4所示，当遇左侧风，且φ_c<-5°时，根据优选公式

计算得到无人机的偏航角速率指令dψ_c，该指令控制无人机以偏航角速率dψ＝dψ_c向逆时针旋转做偏航运动，从而使无人机逆时针旋转，实现机头航向的调整，使其对准来流。为滚转角指令到偏航角速率指令的比例增益，体现自动对风的灵敏度，优选取此时，电机M1、M3转速提高，电机M2、M4转速降低，无人机受到逆时针方向的旋转力矩。同时，由于旋翼旋转平面与水平面成3～5°夹角，M1向左的水平分力与M3向右的水平分力增大，M2向右的水平分力与M4向左的水平分力减小，增加无人机逆时针旋转的力矩。且无人机的倒“V”尾有一定的风标效应，使无人机自然地向来流方向旋转，此时配合方向舵左偏转，可增加无人机逆时针旋转的力矩，以最少的能量实现对风，有效提高无人机的续航能力。

本发明无人机受到的总旋转力矩，优选如下：

总旋转力矩＝旋翼旋转的反扭力矩+旋翼拉力的水平分力距+方向舵产生的力矩

当遇右侧风，且φ_c>5°时，同理得到偏航角速率指令dψ_c，控制无人机以偏航角速率dψ＝dψ_c向顺时针旋转做偏航运动，调整无人机机头航向，使其对准来流，调整方式与遇左侧风时相反。

机头对准来流方向，具体为：调整机头航向转向来流方向，此过程中随着机头航向的调整，侧风逐渐转为逆风，所需滚转角指令绝对值|φ_c|也逐渐减小，当|φ_c|<5°时，航向调整结束，此时则认为无人机机头航向已对准来流方向。

本发明实现自动对风稳定性提高的方案：

无人机通过俯仰控制量δ_pitch、滚转控制量δ_roll、航向控制量δ_yaw控制无人机的稳定悬停。无人机侧风悬停时，δ_roll和δ_yaw将增加，易出现|δ_roll+δ_yaw|≥0.2，导致控制量饱和。通过自动对风，可减小δ_roll和δ_yaw，但δ_pitch稍有增大，当满足条件：|δ_pitch+δ_roll+δ_yaw|≤0.1(其中-0.2≤δ_pitch≤0.2，-0.2≤δ_roll≤0.2，-0.2≤δ_yaw≤0.2)，无人机有足够的控制余量，其稳定性得到提高。

本发明实现自动对风效率提高的进一步优选方案：

无人机自动对风时，通过旋翼的航向控制量δ_yaw与方向舵控制量δ_rud实现无人机偏航运动，其中航向控制量δ_yaw能同时产生旋翼旋转反扭力矩和旋翼拉力F水平分力F_y的力矩，方向舵控制量δ_rud在风速大时有较好的效果。在不影响控制效果的情况下，δ_yaw越小无人机对风的效率越高，飞行稳定性也越高。所以保证升力F_L足够的前提下，增大旋翼拉力的水平分力力矩可提高自动对风的效率，有F_y＝F*sin(τ),F_L＝F*cos(τ)，τ为旋翼旋转平面与水平面的夹角。当满足条件：F_L/F≥99.5％，且F_Y/F≥0.2％，即取τ＝3°～5°时，对升力影响小，同时能提高自动对风的效率。

优选方案为：在侧风5m/s的环境下测试飞行，若保持航向悬停，不做自动对风，俯仰控制量为δ_pitch＝0，滚转控制量为δ_roll＝0.1，航向控制量为δ_yaw＝0.15，|δ_pitch+δ_roll+δ_yaw|＝0.25>0.2，控制量饱和，飞行稳定性变差；当实行自动对风，将侧风转为逆风，无人机的稳定悬停控制量如下：δ_pitch＝0.08，δ_roll＝0，δ_yaw＝0，|δ_pitch+δ_roll+δ_yaw|＝0.08<0.1，说明尚留有控制余量，满足无人机稳定悬停条件。通过完成自动对风之后，无人机飞行稳定性提高，续航提高。

本发明分两个阶段的控制，有效解决了复合翼无人机在垂直起降阶段或者悬停时抗侧风的问题，避免了因航向控制导致姿态控制余量不足的情况，能有效减少能力损耗，提高续航能力；本发明将侧风转为迎风，提高无人机的抗风能力，使无人机可在风速更大的环境起降，完成任务需求，节约时间成本。

本发明通过旋翼反扭力矩、升力平面倾斜及方向舵三者共同作用，有利于提高无人机的偏航控制能力，使无人机快速有效响应自动对风的控制。