CN111258324B - 多旋翼无人机控制方法、装置、多旋翼无人机及存储介质 - Google Patents
多旋翼无人机控制方法、装置、多旋翼无人机及存储介质 Download PDFInfo
- Publication number
- CN111258324B CN111258324B CN202010062842.5A CN202010062842A CN111258324B CN 111258324 B CN111258324 B CN 111258324B CN 202010062842 A CN202010062842 A CN 202010062842A CN 111258324 B CN111258324 B CN 111258324B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- rotor
- attitude angle
- rotor unmanned
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000004422 calculation algorithm Methods 0.000 claims description 7
- 238000005096 rolling process Methods 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 abstract description 7
- 238000005516 engineering process Methods 0.000 abstract description 4
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本公开涉及一种多旋翼无人机控制方法、装置、多旋翼无人机及存储介质,以解决相关技术中为满足较大的移动速度所需的多旋翼无人机姿态角变化过大过快而带来的较大风阻的问题。所述方法应用于多旋翼无人机,所述方法包括:根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角;根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,其中,所述第二期望姿态角小于所述第一期望姿态角;根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
Description
技术领域
本公开涉及无人机技术领域,具体地,涉及一种多旋翼无人机控制方法、装置、多旋翼无人机及存储介质。
背景技术
无人驾驶飞机简称无人机(Unmanned Aerial Vehicle,简称UAV),是一种不载人飞机。无人机的用途广泛,经常被应用于植保、城市管理、地质、气象、电力、抢险救灾、视频拍摄等行业。
相关技术中对多旋翼无人机的位移运动控制,是通过调节多旋翼无人机的各个旋翼的转速,通过各旋翼之间的转速差来改变多旋翼无人机的姿态角,在姿态角不为零时,旋翼旋转产生的拉力正交分解为平行于铅垂面的分力和平行于水平面的分力,前者用于抵消多旋翼无人机的重力,后者则驱使多旋翼无人机发生水平移动。
然而,由于多旋翼无人机的水平移动速度与其姿态角具有正相关的耦合关系,也就是说,欲使多旋翼无人机达到较大的水平移动速度,则需使多旋翼无人机的姿态角产生较大变化。若姿态角变化过大过快,将带来较大的风阻,进而影响对多旋翼无人机的飞行控制效果。
发明内容
为了克服相关技术中存在的问题,本公开的目的是提供一种多旋翼无人机控制方法、装置、多旋翼无人机及存储介质。
为了实现上述目的,本公开提供一种多旋翼无人机控制方法,应用于多旋翼无人机,所述方法包括:
根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角;
根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,其中,所述第二期望姿态角小于所述第一期望姿态角;
根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
可选地,所述根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,包括:
根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角,θ*为所述多旋翼无人机的第一期望姿态角,θM为所述多旋翼无人机的第二期望姿态角。
可选地,所述根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动,包括:
根据以下公式确定所述多旋翼无人机以所述第二期望姿态角悬停时所述旋翼的目标倾转角:
其中,为所述旋翼的目标倾转角,/>为所述机身的第二期望姿态角;
基于串级PID控制算法,根据所述多旋翼无人机的实时姿态角和角速度以及所述第二期望姿态角确定所述旋翼的期望转速;
根据所述目标倾转角和所述期望转速对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角悬停;
在检测到所述多旋翼无人机进入悬停状态后,以所述旋翼当前相对于所述多旋翼无人机机身的位置为基准,根据所述期望倾转角控制所述旋翼相对于所述基准倾转,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
可选地,所述根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角,包括:
根据以下公式计算所述多旋翼无人机的第一期望姿态角:
θ*=-[A(t-1)·α+A(t)·(1-α)]·Θ
其中,θ*为所述多旋翼无人机的第一期望姿态角,A(t-1)为上一时刻接收到的来自所述遥控器的控制信号,A(t)为当前时刻接收到的来自所述遥控器的控制信号,α为预设系数,Θ为来自所述遥控器的控制信号为满量程时对应的所述多旋翼无人机不发生翻滚的最大姿态角。
本公开还提供一种多旋翼无人机控制装置,应用于多旋翼无人机,所述装置包括:
第一确定模块,用于根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角;
第二确定模块,用于根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,其中,所述第二期望姿态角小于所述第一期望姿态角;
控制模块,用于根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
可选地,所述第二确定模块包括:
第一计算子模块,用于根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角,θ*为所述多旋翼无人机的第一期望姿态角,θM为所述多旋翼无人机的第二期望姿态角。
可选地,所述控制模块包括:
第二计算子模块,用于根据以下公式确定所述多旋翼无人机以所述第二期望姿态角悬停时所述旋翼的目标倾转角:
其中,为所述旋翼的目标倾转角,/>为所述机身的第二期望姿态角;
确定子模块,用于基于串级PID控制算法,根据所述多旋翼无人机的实时姿态角和角速度以及所述第二期望姿态角确定所述旋翼的期望转速;
第一控制子模块,用于根据所述目标倾转角和所述期望转速对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角悬停;
第二控制子模块,用于在检测到所述多旋翼无人机进入悬停状态后,以所述旋翼当前相对于所述多旋翼无人机机身的位置为基准,根据所述期望倾转角控制所述旋翼相对于所述基准倾转,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
可选地,所述第一确定模块包括:
第三计算子模块,用于根据以下公式计算所述多旋翼无人机的第一期望姿态角:
θ*=-[A(t-1)·α+A(t)·(1-α)]·Θ
其中,θ*为所述多旋翼无人机的第一期望姿态角,A(t-1)为上一时刻接收到的来自所述遥控器的控制信号,A(t)为当前时刻接收到的来自所述遥控器的控制信号,α为预设系数,Θ为来自所述遥控器的控制信号为满量程时对应的所述多旋翼无人机不发生翻滚的最大姿态角。
本公开还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现本公开提供的多旋翼无人机控制方法的步骤。
本公开还提供一种多旋翼无人机,包括机身、旋翼以及本公开提供的多旋翼无人机控制装置。
本公开提供的技术方案可以包括以下有益效果:
根据多旋翼无人机的第一期望姿态角和预先设置的多旋翼无人机水平移动的第二姿态角确定多旋翼无人机旋翼的期望倾转角,相当于将多旋翼无人机遥控器给定的多旋翼无人机的第一期望姿态角“映射”为旋翼的期望倾转角,根据多旋翼无人机的第二期望姿态角和旋翼的期望倾转角控制旋翼旋转,以使多旋翼无人机以低于该第一期望姿态角的第二期望姿态角水平移动,这样,多旋翼无人机水平移动的动力将部分或全部由旋翼倾转提供,相当于解除了多旋翼无人机的移动速度与其姿态角之间的耦合关系,解决了相关技术中为满足较大的移动速度所需的多旋翼无人机姿态角变化过大过快而带来的较大风阻的问题,进而提升了对多旋翼无人机的飞行控制效果。
本公开的其他特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本公开的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本公开,但并不构成对本公开的限制。在附图中:
图1是根据本公开一示例性实施例示出的一种多旋翼无人机控制方法的流程图;
图2是根据本公开一示例性实施例示出的一种多旋翼无人机控制装置的框图;
图3是根据本公开另一示例性实施例示出的一种多旋翼无人机控制装置的框图。
具体实施方式
以下结合附图对本公开的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本公开,并不用于限制本公开。
需要说明的是,本公开的说明书和权利要求书以及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必理解为描述特定的顺序或先后次序。
图1是根据本公开一示例性实施例示出的一种多旋翼无人机控制方法的流程图,该方法应用于多旋翼无人机,可由多旋翼无人机中内置的控制器实施。如图1所示,该方法包括以下步骤:
S101、根据接收到的来自多旋翼无人机的遥控器的控制信号,确定多旋翼无人机的第一期望姿态角。
在本公开的实施例中,多旋翼无人机的姿态角是指机体坐标系与地面坐标系之间的夹角,其中,机体坐标系是固定在多旋翼无人机机身上的遵守右手法则的三维正交直角坐标系,其原点O位于多旋翼无人机的中心,X轴沿机身指向机头方向,Y轴垂直于X轴并指向多旋翼无人机沿机头方向的右侧,Z轴垂直于XOY平面并指向多旋翼无人机下方。
具体地,多旋翼无人机的姿态角包括俯仰角θ、滚转角以及偏航角ψ等。其中,俯仰角θ是指机体坐标系的X轴与水平面(即地面坐标系的XOY平面)之间的夹角,当机体坐标系的X轴位于水平面上方时,俯仰角θ为正;当机体坐标系的X轴位于水平面下方时,俯仰角θ为负。滚转角/>是指机体坐标系的Z轴与地面坐标系的XOZ平面之间的夹角,当多旋翼无人机向其右侧翻滚时,滚转角/>为正;当多旋翼无人机向其左侧翻滚时,滚转角/>为负。偏航角ψ是指机体坐标系的Y轴与地面坐标系的YOZ平面之间的夹角,当多旋翼无人机向其右侧偏航时,偏航角ψ为正;当多旋翼无人机向其左侧偏航时,偏航角ψ为负。
多旋翼无人机遥控器发出的控制信号可以是通过例如遥控器的摇杆、按钮等不同机械结构对多旋翼无人机进行控制的信号。例如,控制信号可以为遥控器的摇杆信号,则该控制信号可用于表征飞手推动遥控器摇杆的改变量,其可以是对该摇杆的改变量进行等比例缩放后得到的(-1,1)范围内的控制量。
值得说明的是,多旋翼无人机的遥控器具有不同的控制模式,例如包括位置控制模式(又称作“GPS模式”)、姿态控制模式等。在不同的控制模式下,遥控器发出的控制信号不同。示例地,在位置控制模式下,遥控器发出的控制信号可以包括用于控制多旋翼无人机的水平和/或垂向位置的速度控制量;在姿态控制模式下,遥控器发出的控制信号可以包括用于控制多旋翼无人机姿态的姿态角控制量。
相应地,针对不同的控制模式,可采用的不同方法计算多旋翼无人机的第一期望姿态角。示例地,在多旋翼无人机处于位置控制模式的情况下,可根据遥控器的控制信号确定多旋翼无人机的期望移动速度,进一步根据期望移动速度计算多旋翼无人机的第一期望姿态角。其中,根据期望移动速度计算多旋翼无人机的第二期望姿态角的具体方式为本领域技术人员公知的,此处不再详细阐述。
在多旋翼无人机处于姿态控制模式或者定高模式的情况下,可根据公式(1)计算多旋翼无人机的第一期望姿态角。
θ*=-[A(t-1)·α+A(t)·(1-α)]·Θ (1)
其中,θ*为多旋翼无人机的第一期望姿态角,A(t-1)为上一时刻接收到的来自多旋翼无人机遥控器的控制信号,A(t)为当前时刻接收到的来自多旋翼无人机遥控器的控制信号,α为预设系数,Θ为接收到的控制信号为满量程时对应的多旋翼无人机不发生翻滚的最大姿态角。
S102、根据第一期望姿态角和预先设置的多旋翼无人机水平移动时其机身的第二期望姿态角,确定多旋翼无人机旋翼的期望倾转角。
其中,第二期望姿态角小于第一期望姿态角。
多旋翼无人机旋翼的倾转角用于表征旋翼相对于多旋翼无人机机身的位置,具体地,旋翼的倾转角是指以旋翼垂直于机身的位置为初始基准位置,旋翼所处的位置相对于该初始基准位置的夹角。
在一种可选的实现方式中,可根据公式(2)计算旋翼的期望倾转角。
其中,为多旋翼无人机旋翼的期望倾转角,θ*为多旋翼无人机的第一期望姿态角,θM为多旋翼无人机的第二期望姿态角。
S103、根据多旋翼无人机的第二期望姿态角和旋翼的期望倾转角对旋翼进行控制,以使多旋翼无人机以第二期望姿态角水平移动。
在一种可选的实现方式中,可基于PID控制算法,可以根据多旋翼无人机的实时姿态角和第二期望姿态角确定旋翼的期望转速,并根据旋翼的期望转速和期望倾转角对旋翼进行控制,以使多旋翼无人机以第二期望姿态角水平移动。该实现方式适用于多旋翼无人机处于姿态控制模式的情况下。
在另一种可选的实现方式中,可首先根据以下公式确定多旋翼无人机以第二期望姿态角悬停时旋翼的目标倾转角。接着,基于串级PID控制算法,根据多旋翼无人机的实时姿态角和第二期望姿态角确定旋翼的期望转速,并根据目标倾转角和期望转速对于旋翼进行控制,以使多旋翼无人机以第二期望姿态角悬停。最后,在检测到多旋翼无人机进入悬停状态后,以旋翼当前相对于多旋翼无人机机身的位置为新的基准,根据旋翼的期望倾转角控制旋翼相对于该基准倾转,以使多旋翼无人机以第二期望姿态角水平移动。该实现方式可应用于多旋翼无人机处于位置控制模式的情况下,在该情况下,可实现多旋翼无人机以预先设置的期望姿态角悬停。
在具体实施时,对于根据多旋翼无人机的实时姿态角和第二期望姿态角确定旋翼的期望转速的具体方式,可以将对多旋翼无人机姿态角的控制作为外环PID控制,将对多旋翼无人机姿态角的角速度的控制作为内环PID控制,通过设置在多旋翼无人机中的传感器组件(如陀螺仪)实时获取该多旋翼无人机的姿态角和姿态角的角速度,根据多旋翼无人机的实时姿态角和第二期望姿态角进行PID控制,得到多旋翼无人机的期望角速度。接着,根据多旋翼无人机的实时角速度和期望角速度进行PID控制,得到旋翼的期望转速。进一步地,在得到旋翼的期望转速后,可根据旋翼的期望转速和期望倾转角计算用于控制旋翼旋转的舵机的控制量,将计算出的控制量发送给舵机,以使舵机控制旋翼相对于该基准倾转目标倾转角并以该期望转速旋转。
值得说明的是,根据旋翼的期望转速和期望倾转角计算舵机的控制量的具体方式,属于本领域技术人员公知的,在此不再详细阐述。
另外,可根据实际需要将第二期望姿态角设置为小于第一期望姿态角的任意角度。例如,第一期望姿态角可以为零,即多旋翼无人机在水平移动时其机身保持水平状态,在此种情况下,旋翼的期望倾转角与多旋翼无人机的第一期望姿态角相等,相当于将多旋翼无人机的第一期望姿态角全部“映射”为旋翼的期望倾转角,则多旋翼无人机水平移动的全部动力由旋翼的倾转提供;第二期望姿态角也可以为(0,θ*)之间的任一角度,即多旋翼无人机在水平移动时其机身为非水平状态,在此种情况下,旋翼的期望倾转角小于多旋翼无人机的第一期望姿态角,相当于将多旋翼无人机的第一期望姿态角部分“映射”为旋翼的期望倾转角,则多旋翼无人机水平移动的部分动力由旋翼倾转提供。
采用上述多旋翼无人机控制方法,根据多旋翼无人机的第一期望姿态角和预先设置的多旋翼无人机水平移动的第二姿态角确定多旋翼无人机旋翼的期望倾转角,相当于将多旋翼无人机遥控器给定的多旋翼无人机的第一期望姿态角全部或部分“映射”为旋翼的期望倾转角,根据多旋翼无人机的第二期望姿态角和旋翼的期望倾转角控制旋翼旋转,以使多旋翼无人机以低于该第一期望姿态角的第二期望姿态角水平移动,这样,多旋翼无人机水平移动的动力将部分或全部由旋翼倾转提供,相当于解除了多旋翼无人机的移动速度与其姿态角之间的耦合关系,解决了相关技术中为满足较大的移动速度所需的多旋翼无人机姿态角变化过大过快而带来的较大风阻的问题,进而提升了对多旋翼无人机的飞行控制效果。
图2是根据本公开一示例性实施例示出的一种多旋翼无人机控制装置的框图,该装置应用于多旋翼无人机,如图2所示,该装置200包括:
第一确定模块201,用于根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角;
第二确定模块202,用于根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,其中,所述第二期望姿态角小于所述第一期望姿态角;
控制模块203,用于根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
可选地,如图3所示,所述第二确定模块202包括:
第一计算子模块221,用于根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角,θ*为所述多旋翼无人机的第一期望姿态角,θM为所述多旋翼无人机的第二期望姿态角。
可选地,如图3所示,所述控制模块203包括:
第二计算子模块231,用于根据以下公式确定所述多旋翼无人机以所述第二期望姿态角悬停时所述旋翼的目标倾转角:
其中,为所述旋翼的目标倾转角,/>为所述机身的第二期望姿态角;
确定子模块232,用于基于串级PID控制算法,根据所述多旋翼无人机的实时姿态角和角速度以及所述第二期望姿态角确定所述旋翼的期望转速;
第一控制子模块233,用于根据所述目标倾转角和所述期望转速对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角悬停;
第二控制子模块234,用于在检测到所述多旋翼无人机进入悬停状态后,以所述旋翼当前相对于所述多旋翼无人机机身的位置为基准,根据所述期望倾转角控制所述旋翼相对于所述基准倾转,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
可选地,如图3所示,所述第一确定模块201包括:
第三计算子模块211,用于根据以下公式计算所述多旋翼无人机的第一期望姿态角:
θ*=-[A(t-1)·α+A(t)·(1-α)]·Θ
其中,θ*为所述多旋翼无人机的第一期望姿态角,A(t-1)为上一时刻接收到的来自所述遥控器的控制信号,A(t)为当前时刻接收到的来自所述遥控器的控制信号,α为预设系数,Θ为来自所述遥控器的控制信号为满量程时对应的所述多旋翼无人机不发生翻滚的最大姿态角。
关于上述实施例中的装置,其中各个模块执行操作的具体方式已经在有关该方法的实施例中进行了详细描述,此处将不做详细阐述说明。
另外,本领域的技术人员可以清楚地了解到,为描述的方便和简洁,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将装置的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。
采用上述多旋翼无人机控制装置,根据多旋翼无人机的第一期望姿态角和预先设置的多旋翼无人机水平移动的第二姿态角确定多旋翼无人机旋翼的期望倾转角,相当于将多旋翼无人机遥控器给定的多旋翼无人机的第一期望姿态角全部或部分“映射”为旋翼的期望倾转角,根据多旋翼无人机的第二期望姿态角和旋翼的期望倾转角控制旋翼旋转,以使多旋翼无人机以低于该第一期望姿态角的第二期望姿态角水平移动,这样,多旋翼无人机水平移动的动力将部分或全部由旋翼倾转提供,相当于解除了多旋翼无人机的移动速度与其姿态角之间的耦合关系,解决了相关技术中为满足较大的移动速度所需的多旋翼无人机姿态角变化过大过快而带来的较大风阻的问题,进而提升了对多旋翼无人机的飞行控制效果。
相应地,本公开实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现本公开上述任一实施例所述的多旋翼无人机控制方法的步骤。
相应地,本公开实施例还提供一种多旋翼无人机,该多旋翼无人机包括机身、旋翼以及本公开上述任一实施例所述的多旋翼无人机控制装置。
以上结合附图详细描述了本公开的优选实施方式,但是,本公开并不限于上述实施方式中的具体细节,在本公开的技术构思范围内,可以对本公开的技术方案进行多种简单变型,这些简单变型均属于本公开的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本公开对各种可能的组合方式不再另行说明。
此外,本公开的各种不同的实施方式之间也可以进行任意组合,只要其不违背本公开的思想,其同样应当视为本公开所公开的内容。
Claims (7)
1.一种多旋翼无人机控制方法,其特征在于,应用于多旋翼无人机,所述方法包括:
根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角;
根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,其中,所述第二期望姿态角小于所述第一期望姿态角;
根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动;
其中,所述根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,包括:
根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角,θ*为所述多旋翼无人机的第一期望姿态角,/>为所述第二期望姿态角;
其中,所述根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动,包括:
根据以下公式确定所述多旋翼无人机以所述第二期望姿态角悬停时所述旋翼的目标倾转角:
其中,为所述旋翼的目标倾转角,/>为所述第二期望姿态角;
基于串级PID控制算法,根据所述多旋翼无人机的实时姿态角和角速度以及所述第二期望姿态角确定所述旋翼的期望转速;
根据所述目标倾转角和所述期望转速对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角悬停;
在检测到所述多旋翼无人机进入悬停状态后,以所述旋翼当前相对于所述多旋翼无人机机身的位置为基准,根据所述期望倾转角控制所述旋翼相对于所述基准倾转,以使所述多旋翼无人机以所述第二期望姿态角水平移动;
其中,所述根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角,包括:
根据以下公式计算所述多旋翼无人机的第一期望姿态角:
θ*=-[A(t-1)·α+A(t)·(1-α)]·Θ
其中,θ*为所述多旋翼无人机的第一期望姿态角,A(t-1)为上一时刻接收到的来自所述遥控器的控制信号,A(t)为当前时刻接收到的来自所述遥控器的控制信号,α为预设系数,Θ为来自所述遥控器的控制信号为满量程时对应的所述多旋翼无人机不发生翻滚的最大姿态角。
2.一种使用权利要求1所述方法的多旋翼无人机控制装置,其特征在于,应用于多旋翼无人机,所述装置包括:
第一确定模块,用于根据接收到的来自所述多旋翼无人机的遥控器的控制信号,确定所述多旋翼无人机的第一期望姿态角;
第二确定模块,用于根据所述第一期望姿态角和预先设置的所述多旋翼无人机水平移动的第二期望姿态角,确定所述多旋翼无人机旋翼的期望倾转角,其中,所述第二期望姿态角小于所述第一期望姿态角;
控制模块,用于根据所述第二期望姿态角和所述期望倾转角对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
3.根据权利要求2所述的装置,其特征在于,所述第二确定模块包括:
第一计算子模块,用于根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角,θ*为所述多旋翼无人机的第一期望姿态角,/>为所述多旋翼无人机的第二期望姿态角。
4.根据权利要求2所述的装置,其特征在于,所述控制模块包括:
第二计算子模块,用于根据以下公式确定所述多旋翼无人机以所述第二期望姿态角悬停时所述旋翼的目标倾转角:
其中,为所述旋翼的目标倾转角,/>为所述第二期望姿态角;
确定子模块,用于基于串级PID控制算法,根据所述多旋翼无人机的实时姿态角和角速度以及所述第二期望姿态角确定所述旋翼的期望转速;
第一控制子模块,用于根据所述目标倾转角和所述期望转速对所述旋翼进行控制,以使所述多旋翼无人机以所述第二期望姿态角悬停;
第二控制子模块,用于在检测到所述多旋翼无人机进入悬停状态后,以所述旋翼当前相对于所述多旋翼无人机机身的位置为基准,根据所述期望倾转角控制所述旋翼相对于所述基准倾转,以使所述多旋翼无人机以所述第二期望姿态角水平移动。
5.根据权利要求2至4中任一项所述的装置,其特征在于,所述第一确定模块包括:
第三计算子模块,用于根据以下公式计算所述多旋翼无人机的第一期望姿态角:
θ*=-[A(t-1)·α+A(t)·(1-α)]·Θ
其中,θ*为所述多旋翼无人机的第一期望姿态角,A(t-1)为上一时刻接收到的来自所述遥控器的控制信号,A(t)为当前时刻接收到的来自所述遥控器的控制信号,α为预设系数,Θ为来自所述遥控器的控制信号为满量程时对应的所述多旋翼无人机不发生翻滚的最大姿态角。
6.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1所述方法的步骤。
7.一种多旋翼无人机,其特征在于,包括机身、旋翼以及权利要求2至5中任一项所述的多旋翼无人机控制装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010062842.5A CN111258324B (zh) | 2020-01-19 | 2020-01-19 | 多旋翼无人机控制方法、装置、多旋翼无人机及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010062842.5A CN111258324B (zh) | 2020-01-19 | 2020-01-19 | 多旋翼无人机控制方法、装置、多旋翼无人机及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111258324A CN111258324A (zh) | 2020-06-09 |
CN111258324B true CN111258324B (zh) | 2023-08-18 |
Family
ID=70952336
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010062842.5A Active CN111258324B (zh) | 2020-01-19 | 2020-01-19 | 多旋翼无人机控制方法、装置、多旋翼无人机及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111258324B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113031636B (zh) * | 2021-03-01 | 2024-02-20 | 之江实验室 | 无人机控制方法、装置、电子设备、无人机和存储介质 |
CN113859518A (zh) * | 2021-10-28 | 2021-12-31 | 南京晓航机器人科技有限公司 | 一种多旋翼无人机及提高速度与续航的方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106292680A (zh) * | 2016-09-18 | 2017-01-04 | 上海交通大学 | 多旋翼无人机及其***以及飞行控制方法 |
US9632501B1 (en) * | 2016-04-11 | 2017-04-25 | Zerotech (Shenzhen) Intelligence Robot Co., Ltd | Method and apparatus for controlling UAV, and UAV take-off system |
CN107021218A (zh) * | 2017-05-23 | 2017-08-08 | 福州大学 | 一种抗风扰的非平面飞行器及控制方法 |
CN108427432A (zh) * | 2018-05-25 | 2018-08-21 | 福州大学 | 一种非平面式三旋翼飞行器及控制方法 |
CN108454847A (zh) * | 2018-03-21 | 2018-08-28 | 华南农业大学 | 一种旋翼姿态调节装置以及包括该装置的多旋翼无人机 |
CN108622374A (zh) * | 2017-03-22 | 2018-10-09 | 深圳常锋信息技术有限公司 | 一种无人机的控制方法和装置 |
CN109720553A (zh) * | 2019-02-13 | 2019-05-07 | 深圳创壹通航科技有限公司 | 一种具有垂直起降功能的固定翼无人机、控制方法及介质 |
CN110015415A (zh) * | 2019-05-09 | 2019-07-16 | 福州大学 | 一种双轴倾斜四旋翼飞行器 |
CN110316368A (zh) * | 2019-04-04 | 2019-10-11 | 南京航空航天大学 | 一种分布式动力倾转旋翼无人机及其控制方法 |
CN110641692A (zh) * | 2018-12-14 | 2020-01-03 | 深圳市格上格创新科技有限公司 | 机身平衡无人机及其控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104808674A (zh) * | 2015-03-03 | 2015-07-29 | 广州亿航智能技术有限公司 | 多旋翼飞行器的控制***、终端及机载飞控*** |
TWI603888B (zh) * | 2016-01-18 | 2017-11-01 | 緯創資通股份有限公司 | 任意角度空拋的多軸無人飛行載具的平衡控制方法、其電腦程式產品及其多軸無人飛行載具 |
-
2020
- 2020-01-19 CN CN202010062842.5A patent/CN111258324B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9632501B1 (en) * | 2016-04-11 | 2017-04-25 | Zerotech (Shenzhen) Intelligence Robot Co., Ltd | Method and apparatus for controlling UAV, and UAV take-off system |
CN106292680A (zh) * | 2016-09-18 | 2017-01-04 | 上海交通大学 | 多旋翼无人机及其***以及飞行控制方法 |
CN108622374A (zh) * | 2017-03-22 | 2018-10-09 | 深圳常锋信息技术有限公司 | 一种无人机的控制方法和装置 |
CN107021218A (zh) * | 2017-05-23 | 2017-08-08 | 福州大学 | 一种抗风扰的非平面飞行器及控制方法 |
CN108454847A (zh) * | 2018-03-21 | 2018-08-28 | 华南农业大学 | 一种旋翼姿态调节装置以及包括该装置的多旋翼无人机 |
CN108427432A (zh) * | 2018-05-25 | 2018-08-21 | 福州大学 | 一种非平面式三旋翼飞行器及控制方法 |
CN110641692A (zh) * | 2018-12-14 | 2020-01-03 | 深圳市格上格创新科技有限公司 | 机身平衡无人机及其控制方法 |
CN109720553A (zh) * | 2019-02-13 | 2019-05-07 | 深圳创壹通航科技有限公司 | 一种具有垂直起降功能的固定翼无人机、控制方法及介质 |
CN110316368A (zh) * | 2019-04-04 | 2019-10-11 | 南京航空航天大学 | 一种分布式动力倾转旋翼无人机及其控制方法 |
CN110015415A (zh) * | 2019-05-09 | 2019-07-16 | 福州大学 | 一种双轴倾斜四旋翼飞行器 |
Non-Patent Citations (1)
Title |
---|
潘震,等.基于自抗扰滑模理论的倾转旋翼飞行器非线性姿态控制研究.《航空兵器》.2018,(第6期),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN111258324A (zh) | 2020-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111596693B (zh) | 基于云台相机的无人机对地面目标跟踪控制方法及*** | |
CN105793792A (zh) | 无人机的飞行辅助方法和***、无人机和移动终端 | |
CN106249755B (zh) | 一种无人机自主导航***及导航方法 | |
CN109189088B (zh) | 系留式无人机自适应巡航跟踪方法、终端及存储介质 | |
CN111258324B (zh) | 多旋翼无人机控制方法、装置、多旋翼无人机及存储介质 | |
JP2009173263A (ja) | 無人航空機(uav)によって移動目標物を自律的に追跡するための方法及びシステム | |
CN113419428B (zh) | 基于3d映射制导的机/船协同路径跟踪控制器设计方法 | |
CN105468014A (zh) | 一种单自驾仪一体化的飞行器***及其二维云台控制方法 | |
CN106843275B (zh) | 一种无人机定点绕飞方法、装置以及*** | |
CN111665870B (zh) | 一种轨迹跟踪方法及无人机 | |
Salazar‐Cruz et al. | Embedded control system for a four‐rotor UAV | |
CN112198885B (zh) | 一种满足机动平台自主降落需求的无人机控制方法 | |
US20190011932A1 (en) | Sensor-Centric Path Planning and Control for Robotic Vehicles | |
CN111699451A (zh) | 垂直起降无人机的飞行控制方法、设备及垂直起降无人机 | |
CN112612294A (zh) | 一种带激光雷达自动避障***的无人机 | |
CN111645861B (zh) | 一种旋翼无人机起降用管理平台及方法 | |
CN110737283A (zh) | 一种面向视觉集群的编队解耦控制方法 | |
WO2018068193A1 (zh) | 控制方法、控制装置、飞行控制***与多旋翼无人机 | |
CN106547275A (zh) | 一种新型旋翼类无人机自动定位操控方法 | |
CN112445232A (zh) | 一种便携式体感控制自主巡检机器人 | |
WO2022165311A1 (en) | Geometric control envelope system and method for limiting commands to actuator mapping function | |
CN113625730A (zh) | 一种基于超扭滑模的四旋翼自适应容错控制方法 | |
CN111158388B (zh) | 多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 | |
CN213814412U (zh) | 一种双云台无人机 | |
CN113093770B (zh) | 基于波浪评估的多旋翼无人飞船水面起飞控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |