CN111158388B - 多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 - Google Patents
多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 Download PDFInfo
- Publication number
- CN111158388B CN111158388B CN202010060343.2A CN202010060343A CN111158388B CN 111158388 B CN111158388 B CN 111158388B CN 202010060343 A CN202010060343 A CN 202010060343A CN 111158388 B CN111158388 B CN 111158388B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- expected
- rotor
- 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 29
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 21
- 238000004364 calculation method Methods 0.000 claims description 19
- 238000001914 filtration Methods 0.000 claims description 14
- 238000004590 computer program Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000004044 response 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),是一种不载人飞机。无人机的用途广泛,经常被应用于植保、城市管理、地质、气象、电力、抢险救灾、视频拍摄等行业。
在一些特定的应用场景下,通常需要控制多旋翼无人机悬停以便更好地进行相关作业。然而,现有的悬停控制方法只能实现多旋翼无人机在机身水平时悬停。
发明内容
本公开的目的是提供一种多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质,以解决相关技术中只能以机身水平悬停的问题。
为了实现上述目的,本公开提供一种多旋翼无人机悬停控制方法,应用于多旋翼无人机,所述方法包括:
根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角;
基于预设的控制算法,计算所述多旋翼无人机以所述第一期望姿态角悬停时所述旋翼的期望转速;
根据所述期望倾转角控制所述旋翼倾转,以及
根据所述期望转速控制所述旋翼旋转。
可选地,所述第一期望姿态角包括所述机身的第一期望俯仰角,所述第二期望姿态角包括所述机身的第二期望俯仰角;
所述根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角,包括:
根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角度;/>为所述机身的第一期望俯仰角;θsp(t)为所述机身的第二期望俯仰角。
可选地,所述控制算法为串级PID控制算法;
所述基于预设的控制算法,计算所述多旋翼无人机以所述第一期望姿态角悬停时所述旋翼的期望转速,包括:
实时获取所述多旋翼无人机的姿态角和角速度;
根据所述多旋翼无人机的实时姿态角和所述第一期望姿态角进行PID控制,得到所述机身的期望角速度;
根据所述多旋翼无人机的实时角速度和所述期望姿态角速度进行PID控制,得到所述旋翼的期望转速。
可选地,在所述根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角之前,还包括:
接收姿态控制信号;
根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角。
可选地,所述根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角,包括:
对所述姿态控制信号进行低通滤波处理;
根据经所述低通滤波处理后的姿态控制信号,计算所述多旋翼无人机的第一期望姿态角。
可选地,所述第一期望姿态角包括所述机身的第一期望俯仰角;
所述根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角,包括:
根据以下公式计算所述机身的第一期望俯仰角:
其中,为所述机身的第一期望俯仰角;A(t-1)为上一时刻的姿态控制信号;A(t)为当前时刻的姿态控制信号;α为预设调节量;Θ为姿态控制信号为满量程时对应的所述机身不发生翻滚的最大俯仰角。
本公开还提供一种多旋翼无人机悬停控制装置,应用于多旋翼无人机,所述装置包括:
第一计算模块,用于根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角;
第二计算模块,用于基于预设的控制算法,计算所述多旋翼无人机以所述第一期望姿态角悬停时所述旋翼的期望转速;
控制模块,用于根据所述期望倾转角控制所述旋翼旋转,以及根据所述期望转速控制所述旋翼旋转。
可选地,所述第一期望姿态角包括所述机身的第一期望俯仰角,所述第二期望姿态角包括所述机身的第二期望俯仰角;
所述第一计算模块包括:
第一计算子模块,用于根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角度;/>为所述机身的第一期望俯仰角;θsp(t)为所述机身的第二期望俯仰角。
可选地,所述控制算法为串级PID控制算法;
所述第二计算模块包括:
获取子模块,用于实时获取所述多旋翼无人机的姿态角和角速度;
第二计算子模块,用于根据所述多旋翼无人机的实时姿态角和所述第一期望姿态角进行PID控制,得到所述机身的期望角速度;
第三计算子模块,用于根据所述多旋翼无人机的实时角速度和所述期望姿态角速度进行PID控制,得到所述旋翼的期望转速。
可选地,所述装置还包括:
接收模块,用于在所述第一计算模块根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角之前,接收姿态控制信号;
确定模块,用于根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角。
可选地,所述确定模块包括:
滤波子模块,用于对所述姿态控制信号进行低通滤波处理;
第四计算子模块,用于根据经所述低通滤波处理后的姿态控制信号,计算所述多旋翼无人机的第一期望姿态角。
可选地,所述第一期望姿态角包括所述机身的第一期望俯仰角;
所述确定模块包括:
第五计算子模块,用于根据以下公式计算所述机身的第一期望俯仰角:
其中,为所述机身的第一期望俯仰角;A(t-1)为上一时刻的姿态控制信号;A(t)为当前时刻的姿态控制信号;α为预设调节量;Θ为姿态控制信号为满量程时对应的所述机身不发生翻滚的最大俯仰角。
本公开还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现本公开提供的多旋翼无人机悬停控制方法的步骤。
本公开还提供一种多旋翼无人机,包括机身、旋翼以及本公开提供的多旋翼无人机悬停控制装置。
本公开提供的技术方案可以包括以下有益效果:
通过多旋翼无人机悬停时的第一期望姿态角和其在机身水平悬停时的第二期望姿态角来计算多旋翼无人机以该第一期望角悬停时旋翼的期望倾转角,并根据该期望倾转角控制旋翼倾转,可以改变多旋翼无人机的受力方向,同时,通过计算多旋翼无人机以第一期望姿态角悬停时旋翼的期望转速并根据该期望转速控制旋翼旋转,可以改变多旋翼无人机的受力大小,通过改变多旋翼无人机的受力方向和受力大小,可以使多旋翼无人机以任意期望姿态角悬停。
本公开的其他特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本公开的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本公开,但并不构成对本公开的限制。在附图中:
图1是根据本公开一示例性实施例示出的一种多旋翼无人机悬停控制方法的流程图
图2是根据本公开一示例性实施例示出的一种旋翼倾转角的示意图;
图3是根据本公开一示例性实施例示出的一种多旋翼无人机悬停控制装置的框图;
图4是根据本公开一示例性实施例示出的另一种多旋翼无人机悬停控制装置的框图。
具体实施方式
以下结合附图对本公开的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本公开,并不用于限制本公开。
需要说明的是,本公开的说明书和权利要求书以及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必理解为描述特定的顺序或先后次序。
图1是根据本公开一示例性实施例示出的一种多旋翼无人机悬停控制方法的流程图,该方法应用于多旋翼无人机,由多旋翼无人机中的控制器实施。如图1所示,该方法可以包括以下步骤:
S101、根据多旋翼无人机的第一期望姿态角和该多旋翼无人机在机身水平悬停时的第二期望姿态角,计算该多旋翼无人机以第一期望姿态角悬停时旋翼的期望倾转角。
在本公开的实施例中,多旋翼无人机的姿态角是指机体坐标系与地面坐标系之间的夹角,其中,如图2所示,机体坐标系是固定在多旋翼无人机上的遵守右手法则的三维正交直角坐标系,其原点O位于多旋翼无人机的中心,X轴沿机身指向机头方向,Y轴垂直于X轴并指向多旋翼无人机右侧,Z轴垂直于XOY平面并指向多旋翼无人机下方。
具体地,多旋翼无人机的姿态角包括多旋翼无人机机身的俯仰角θ、滚转角以及偏航角ψ等。其中,机身的俯仰角θ是指机体坐标系的X轴与水平面(即地面坐标系的XOY平面)之间的夹角,当机体坐标系的X轴位于水平面上方时,俯仰角θ为正;当机体坐标系的X轴位于水平面下方时,俯仰角θ为负。机身的滚转角/>是指机体坐标系的Z轴与地面坐标系的XOZ平面之间的夹角,当机身向其右侧翻滚时,滚转角/>为正;当机身向其左侧翻滚时,滚转角/>为负。机身的偏航角ψ是指机体坐标系的Y轴与地面坐标系的YOZ平面之间的夹角,当机身向其右侧偏航时,偏航角ψ为正;当机身向其左侧偏航时,偏航角ψ为负。
多旋翼无人机旋翼的倾转角是指旋翼平面(如图2中的虚线所示)与机体平面(如图2中的粗实线所示)之间的夹角(如图2中的θM)。
在一种可选的实现方式中,所述第一期望姿态角是指多旋翼无人机以期望姿态悬停时的姿态角,其包括机身的第一期望俯仰角等。所述第二期望姿态角是指多旋翼无人机在机身水平悬停时的姿态角,其包括机身的第二期望俯仰角。在理想状态下,第二期望姿态角为零。相应地,可根据公式(1)计算该多旋翼无人机以该第一期望姿态角悬停时其旋翼的期望倾转角。
其中,为所述旋翼的期望倾转角;/>为所述机身的第一期望俯仰角;θsp(t)为所述机身的第二期望俯仰角。
值得说明的是,多旋翼无人机悬停时的第一期望姿态角可以是预先存储在高多旋翼无人机中的,也可以通过与多旋翼无人机通信的地面站或者与多旋翼无人机的遥控器设定。示例地,以通过多旋翼无人机的遥控器设定多旋翼无人机的第一期望姿态角示意,多旋翼无人机可接收其遥控器发送的姿态控制信号,并根据该姿态控制信号确定多旋翼无人机的第一期望姿态角。其中,姿态控制信号用于表征为该多旋翼无人机的飞手推动遥控器的控制杆时该控制杆的改变量,其可以是对该控制杆的改变量进行等比例缩放后得到的(-1,1)范围内的控制量。而对姿态控制信号进行等比例缩放处理的具体方式,为本领域技术人员公知的,在此不再详细赘述。
进一步地,为了避免姿态控制信号的瞬间变化导致的多旋翼无人机响应时产生过大的超调而引起抖动,可首先对姿态控制信号进行低通滤波处理,再根据处理后得到的姿态控制信号计算多旋翼无人机的第一期望姿态角。
在具体实施时,以第一期望姿态角包括机身的第一期望俯仰角为例,可根据公式(2)计算机身的第一期望俯仰角。
其中,为所述机身的第一期望俯仰角;A(t-1)为上一时刻的姿态控制信号;A(t)为当前时刻的姿态控制信号;α为预设调节量;Θ为姿态控制信号为满量程时对应的所述机身不发生翻滚的最大俯仰角。
S102、基于预设的控制算法,计算该多旋翼无人机以第一期望姿态角悬停时旋翼的期望转速。
在一种可选的实现方式中,预设控制算法为串级PID控制算法。具体地,可将对多旋翼无人机姿态角的控制作为外环PID控制,将对多旋翼无人机姿态角的角速度的控制作为内环PID控制,通过设置在多旋翼无人机中的传感器组件(如陀螺仪)实时获取该多旋翼无人机的姿态角和角速度,根据多旋翼无人机的实时姿态角和第一期望姿态角进行PID控制,得到机身的期望角速度。接着,根据多旋翼无人机的实时角速度和期望姿态角速度进行PID控制,得到旋翼的期望转速。
值得说明的是,对多旋翼无人机的姿态角和角速度进行串级PID控制的具体方式,为本领域技术人员所公知的,在此不再详细说明。
S103、根据期望倾转角控制旋翼倾转。
S104、根据期望转速控制旋翼旋转。
具体地,在计算出旋翼的期望倾转角和期望转速后,可控制旋翼以该期望倾转角进行倾转并以该期望转速旋转。
值得说明的是,在控制旋翼倾转和旋转时,为了保证多旋翼无人机的位置精度,可设定旋翼转速的控制频率高于旋翼倾转的控制频率。
另外,为了保证多旋翼无人机悬停时的抗干扰能力,可设定旋翼的期望倾转角大于多旋翼无人机机体的最大允许俯仰角。
进一步地,为了实现多旋翼无人机机身的平稳变化,可对旋翼倾转的角速率进行限制,例如,可控制旋翼倾转的角速率小于预设阈值。其中,预设阈值可以根据实际情况进行设置,例如,预设阈值可以为60°/s。
采用上述方法,通过多旋翼无人机悬停时的第一期望姿态角和其在机身水平悬停时的第二期望姿态角来计算多旋翼无人机以该第一期望角悬停时旋翼的期望倾转角,并根据该期望倾转角控制旋翼倾转,可以改变多旋翼无人机的受力方向,同时,通过计算多旋翼无人机以第一期望姿态角悬停时旋翼的期望转速并根据该期望转速控制旋翼旋转,可以改变多旋翼无人机的受力大小,通过改变多旋翼无人机的受力方向和受力大小,可以使多旋翼无人机以任意期望姿态角悬停。
图3是根据本公开一示例性实施例示出的一种多旋翼无人机悬停控制装置的框图,该装置应用于多旋翼无人机,如图3所示,该装置300包括:
第一计算模块310,用于根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角;
第二计算模块320,用于基于预设的控制算法,计算所述多旋翼无人机以所述第一期望姿态角悬停时所述旋翼的期望转速;
控制模块330,用于根据所述期望倾转角控制所述旋翼旋转,以及根据所述期望转速控制所述旋翼旋转。
可选地,所述第一期望姿态角包括所述机身的第一期望俯仰角,所述第二期望姿态角包括所述机身的第二期望俯仰角;如图4所示,所述第一计算模块310包括:
第一计算子模块311,用于根据以下公式计算所述旋翼的期望倾转角:
其中,为所述旋翼的期望倾转角度;/>为所述机身的第一期望俯仰角;θsp(t)为所述机身的第二期望俯仰角。
可选地,所述控制算法为串级PID控制算法;如图4所示,所述第二计算模块320包括:
获取子模块321,用于实时获取所述多旋翼无人机的姿态角和角速度;
第二计算子模块322,用于根据所述多旋翼无人机的实时姿态角和所述第一期望姿态角进行PID控制,得到所述机身的期望角速度;
第三计算子模块323,用于根据所述多旋翼无人机的实时角速度和所述期望姿态角速度进行PID控制,得到所述旋翼的期望转速。
可选地,如图4所示,所述装置300还包括:
接收模块340,用于在所述第一计算模块根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角之前,接收姿态控制信号;
确定模块350,用于根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角。
可选地,如图4所示,所述确定模块350包括:
滤波子模块351,用于对所述姿态控制信号进行低通滤波处理;
第四计算子模块352,用于根据经所述低通滤波处理后的姿态控制信号,计算所述多旋翼无人机的第一期望姿态角。
可选地,所述第一期望姿态角包括所述机身的第一期望俯仰角;如图4所示,所述确定模块350包括:
第五计算子模块353,用于根据以下公式计算所述机身的第一期望俯仰角:
其中,为所述机身的第一期望俯仰角;A(t-1)为上一时刻的姿态控制信号;A(t)为当前时刻的姿态控制信号;α为预设调节量;Θ为姿态控制信号为满量程时对应的所述机身不发生翻滚的最大俯仰角。
关于上述实施例中的装置,其中各个模块执行操作的具体方式已经在有关该方法的实施例中进行了详细描述,此处将不做详细阐述说明。
另外,本领域的技术人员可以清楚地了解到,为描述的方便和简洁,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将装置的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。上述描述功能模块的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
采用上述装置,通过多旋翼无人机悬停时的第一期望姿态角和其在机身水平悬停时的第二期望姿态角来计算多旋翼无人机以该第一期望角悬停时旋翼的期望倾转角,并根据该期望倾转角控制旋翼倾转,可以改变多旋翼无人机的受力方向,同时,通过计算多旋翼无人机以第一期望姿态角悬停时旋翼的期望转速并根据该期望转速控制旋翼旋转,可以改变多旋翼无人机的受力大小,通过改变多旋翼无人机的受力方向和受力大小,可以使多旋翼无人机以任意期望姿态角悬停。
相应地,本公开实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现本公开上述任一实施例所述的多旋翼无人机悬停控制方法的步骤。
相应地,本公开实施例还提供一种多旋翼无人机,该多旋翼无人机包括机身、旋翼以及本公开上述任一实施例所述的多旋翼无人机悬停控制装置。
以上结合附图详细描述了本公开的优选实施方式,但是,本公开并不限于上述实施方式中的具体细节,在本公开的技术构思范围内,可以对本公开的技术方案进行多种简单变型,这些简单变型均属于本公开的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本公开对各种可能的组合方式不再另行说明。
此外,本公开的各种不同的实施方式之间也可以进行任意组合,只要其不违背本公开的思想,其同样应当视为本公开所公开的内容。
Claims (12)
1.一种多旋翼无人机悬停控制方法,其特征在于,应用于多旋翼无人机,所述方法包括:
根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角;
基于预设的控制算法,计算所述多旋翼无人机以所述第一期望姿态角悬停时所述旋翼的期望转速;
根据所述期望倾转角控制所述旋翼倾转,以及
根据所述期望转速控制所述旋翼旋转;
所述第一期望姿态角指多旋翼无人机以期望姿态悬停时的姿态角,其包括所述机身的第一期望俯仰角,所述第二期望姿态角包括所述机身的第二期望俯仰角;
所述根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角,包括:
根据以下公式计算所述旋翼的期望倾转角:
其中, 为所述旋翼的期望倾转角度; />为所述机身的第一期望俯仰角;/>为所述机身的第二期望俯仰角。
2.根据权利要求1所述的方法,其特征在于,所述控制算法为串级PID控制算法;
所述基于预设的控制算法,计算所述多旋翼无人机以所述第一期望姿态角悬停时所述旋翼的期望转速,包括:
实时获取所述多旋翼无人机的姿态角和角速度;
根据所述多旋翼无人机的实时姿态角和所述第一期望姿态角进行PID控制,得到所述机身的期望角速度;
根据所述多旋翼无人机的实时角速度和所述期望角速度进行PID控制,得到所述旋翼的期望转速。
3.根据权利要求1或2所述的方法,其特征在于,在所述根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角之前,还包括:
接收姿态控制信号;
根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角。
4.根据权利要求3所述的方法,其特征在于,所述根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角,包括:
对所述姿态控制信号进行低通滤波处理;
根据经所述低通滤波处理后的姿态控制信号,计算所述多旋翼无人机的第一期望姿态角。
5.根据权利要求3所述的方法,其特征在于,所述第一期望姿态角包括所述机身的第一期望俯仰角;
所述根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角,包括:
根据以下公式计算所述机身的第一期望俯仰角:
其中, 为所述机身的第一期望俯仰角;A(t-1)为上一时刻的姿态控制信号;A(t)为当前时刻的姿态控制信号;α为预设调节量;Θ为姿态控制信号为满量程时对应的所述机身不发生翻滚的最大俯仰角。
6.一种多旋翼无人机悬停控制装置,其特征在于,应用于多旋翼无人机,所述装置包括:
第一计算模块,用于根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角;
第二计算模块,用于基于预设的控制算法,计算所述多旋翼无人机以所述第一期望姿态角悬停时所述旋翼的期望转速;
控制模块,用于根据所述期望倾转角控制所述旋翼旋转,以及根据所述期望转速控制所述旋翼旋转;
所述第一期望姿态角指多旋翼无人机以期望姿态悬停时的姿态角,其包括所述机身的第一期望俯仰角,所述第二期望姿态角包括所述机身的第二期望俯仰角;
所述第一计算模块包括:
第一计算子模块,用于根据以下公式计算所述旋翼的期望倾转角:
其中, 为所述旋翼的期望倾转角度; />为所述机身的第一期望俯仰角;/>为所述机身的第二期望俯仰角。
7.根据权利要求6所述的装置,其特征在于,所述控制算法为串级PID控制算法;
所述第二计算模块包括:
获取子模块,用于实时获取所述多旋翼无人机的姿态角和角速度;
第二计算子模块,用于根据所述多旋翼无人机的实时姿态角和所述第一期望姿态角进行PID控制,得到所述机身的期望角速度;
第三计算子模块,用于根据所述多旋翼无人机的实时角速度和所述期望角速度进行PID控制,得到所述旋翼的期望转速。
8.根据权利要求6或7所述的装置,其特征在于,所述装置还包括:
接收模块,用于在所述第一计算模块根据所述多旋翼无人机的第一期望姿态角和所述多旋翼无人机在机身水平悬停时的第二期望姿态角,计算所述多旋翼无人机以所述第一期望姿态角悬停时旋翼的期望倾转角之前,接收姿态控制信号;
确定模块,用于根据所述姿态控制信号确定所述多旋翼无人机的第一期望姿态角。
9.根据权利要求8所述的装置,其特征在于,所述确定模块包括:
滤波子模块,用于对所述姿态控制信号进行低通滤波处理;
第四计算子模块,用于根据经所述低通滤波处理后的姿态控制信号,计算所述多旋翼无人机的第一期望姿态角。
10.根据权利要求8所述的装置,其特征在于,所述第一期望姿态角包括所述机身的第一期望俯仰角;
所述确定模块包括:
第五计算子模块,用于根据以下公式计算所述机身的第一期望俯仰角:
其中, 为所述机身的第一期望俯仰角;A(t-1)为上一时刻的姿态控制信号;A(t)为当前时刻的姿态控制信号;α为预设调节量;Θ为姿态控制信号为满量程时对应的所述机身不发生翻滚的最大俯仰角。
11.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1至5中任一项所述方法的步骤。
12.一种多旋翼无人机,其特征在于,包括机身、旋翼以及权利要求6至10中任一项所述的多旋翼无人机悬停控制装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010060343.2A CN111158388B (zh) | 2020-01-19 | 2020-01-19 | 多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010060343.2A CN111158388B (zh) | 2020-01-19 | 2020-01-19 | 多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111158388A CN111158388A (zh) | 2020-05-15 |
CN111158388B true CN111158388B (zh) | 2023-08-18 |
Family
ID=70564423
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010060343.2A Active CN111158388B (zh) | 2020-01-19 | 2020-01-19 | 多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111158388B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102360217A (zh) * | 2011-07-29 | 2012-02-22 | 中国科学院长春光学精密机械与物理研究所 | 多旋翼无人机全局输入解耦装置及包含该装置的控制系统 |
CN105204514A (zh) * | 2015-09-18 | 2015-12-30 | 西北农林科技大学 | 一种新型倾转旋翼无人机姿态控制系统 |
CN106292680A (zh) * | 2016-09-18 | 2017-01-04 | 上海交通大学 | 多旋翼无人机及其系统以及飞行控制方法 |
CN106892102A (zh) * | 2017-02-28 | 2017-06-27 | 王文正 | 一种垂直起降无人机及其控制方法 |
CN107010211A (zh) * | 2016-07-28 | 2017-08-04 | 张崎 | 一种可变姿态多旋翼飞行器 |
CN107065901A (zh) * | 2017-01-18 | 2017-08-18 | 北京京东尚科信息技术有限公司 | 一种旋翼无人机姿态控制方法、装置及无人机 |
CN107856850A (zh) * | 2017-09-29 | 2018-03-30 | 中国科学院自动化研究所 | 多旋翼无人机及其控制方法 |
JP2019114008A (ja) * | 2017-12-22 | 2019-07-11 | カシオ計算機株式会社 | 飛行装置、飛行装置の制御方法及びプログラム |
CN209097012U (zh) * | 2018-09-26 | 2019-07-12 | 沈阳无距科技有限公司 | 无人机及倾转机构 |
CN110697035A (zh) * | 2019-09-16 | 2020-01-17 | 南京航空航天大学 | 一种六自由度独立可控飞行器及其控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
BRPI0418962A (pt) * | 2004-07-29 | 2007-12-04 | Bell Helicopter Textron Inc | método e aparelho para controle de vÈo de aeronave de rotor inclinável |
JP4240112B2 (ja) * | 2006-11-13 | 2009-03-18 | トヨタ自動車株式会社 | 垂直離着陸機 |
IL217070A0 (en) * | 2011-12-18 | 2012-03-29 | Ofek Eshkolot Res And Dev Ltd | Aircraft with fixed and tilting thrusters |
-
2020
- 2020-01-19 CN CN202010060343.2A patent/CN111158388B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102360217A (zh) * | 2011-07-29 | 2012-02-22 | 中国科学院长春光学精密机械与物理研究所 | 多旋翼无人机全局输入解耦装置及包含该装置的控制系统 |
CN105204514A (zh) * | 2015-09-18 | 2015-12-30 | 西北农林科技大学 | 一种新型倾转旋翼无人机姿态控制系统 |
CN107010211A (zh) * | 2016-07-28 | 2017-08-04 | 张崎 | 一种可变姿态多旋翼飞行器 |
CN106292680A (zh) * | 2016-09-18 | 2017-01-04 | 上海交通大学 | 多旋翼无人机及其系统以及飞行控制方法 |
CN107065901A (zh) * | 2017-01-18 | 2017-08-18 | 北京京东尚科信息技术有限公司 | 一种旋翼无人机姿态控制方法、装置及无人机 |
CN106892102A (zh) * | 2017-02-28 | 2017-06-27 | 王文正 | 一种垂直起降无人机及其控制方法 |
CN107856850A (zh) * | 2017-09-29 | 2018-03-30 | 中国科学院自动化研究所 | 多旋翼无人机及其控制方法 |
JP2019114008A (ja) * | 2017-12-22 | 2019-07-11 | カシオ計算機株式会社 | 飛行装置、飛行装置の制御方法及びプログラム |
CN209097012U (zh) * | 2018-09-26 | 2019-07-12 | 沈阳无距科技有限公司 | 无人机及倾转机构 |
CN110697035A (zh) * | 2019-09-16 | 2020-01-17 | 南京航空航天大学 | 一种六自由度独立可控飞行器及其控制方法 |
Non-Patent Citations (1)
Title |
---|
Atsushi Oosedo等.Development of a quad rotor tail-sitter VTOL UAV without control surfaces and experimental verification.《2013 IEEE International Conference on Robotics and Automation》.2013,全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN111158388A (zh) | 2020-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2018099198A1 (zh) | 无人机姿态控制方法、装置及无人机 | |
CN105549614B (zh) | 无人机目标跟踪方法 | |
CN111596693B (zh) | 基于云台相机的无人机对地面目标跟踪控制方法及系统 | |
CN106155086B (zh) | 一种道路检测无人机及其自动巡航方法 | |
CN107065901B (zh) | 一种旋翼无人机姿态控制方法、装置及无人机 | |
CN106843275B (zh) | 一种无人机定点绕飞方法、装置以及系统 | |
CN105793792A (zh) | 无人机的飞行辅助方法和系统、无人机和移动终端 | |
CN108733066B (zh) | 一种基于吊舱姿态反馈的目标跟踪控制方法 | |
CN108196563B (zh) | 一种多旋翼无人机自抗扰补偿控制方法及系统 | |
CN111966133A (zh) | 一种云台视觉伺服控制系统 | |
CN111665870B (zh) | 一种轨迹跟踪方法及无人机 | |
CN111258324B (zh) | 多旋翼无人机控制方法、装置、多旋翼无人机及存储介质 | |
CN109660721A (zh) | 无人机飞行拍摄质量优化方法、系统、设备及存储介质 | |
CN111699451A (zh) | 垂直起降无人机的飞行控制方法、设备及垂直起降无人机 | |
CN108196570A (zh) | 一种无人机航向修正方法、装置和无人机 | |
CN115857520B (zh) | 一种基于视觉和船状态结合的无人机着舰状态监视方法 | |
CN110673623A (zh) | 一种基于双环pd控制算法控制的四旋翼无人机着陆方法 | |
CN109521785A (zh) | 一种随身拍智能旋翼飞行器系统 | |
CN111158388B (zh) | 多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 | |
CN109656258A (zh) | 一种小型无人机飞行高度及飞行姿态解耦镇定控制方法 | |
CN113608543A (zh) | 飞行器航迹自适应规划的方法、装置、设备及存储介质 | |
CN113110545A (zh) | 基于遥控器姿态的无人机飞行控制方法及其控制系统 | |
CN116301058B (zh) | 一种无人飞行反馈非线性偏航控制方法、系统和设备 | |
CN116149193A (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 |