WO2018099198A1 - Control method and device for attitude of unmanned aerial vehicle, and unmanned aerial vehicle - Google Patents

Control method and device for attitude of unmanned aerial vehicle, and unmanned aerial vehicle Download PDF

Info

Publication number
WO2018099198A1
WO2018099198A1 PCT/CN2017/106341 CN2017106341W WO2018099198A1 WO 2018099198 A1 WO2018099198 A1 WO 2018099198A1 CN 2017106341 W CN2017106341 W CN 2017106341W WO 2018099198 A1 WO2018099198 A1 WO 2018099198A1
Authority
WO
WIPO (PCT)
Prior art keywords
attitude
adjustment
interval
attitude angle
angular velocity
Prior art date
Application number
PCT/CN2017/106341
Other languages
French (fr)
Chinese (zh)
Inventor
孙勇
刘艳光
吴海超
李海军
张文凯
郄新越
Original Assignee
北京京东尚科信息技术有限公司
北京京东世纪贸易有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 北京京东尚科信息技术有限公司, 北京京东世纪贸易有限公司 filed Critical 北京京东尚科信息技术有限公司
Publication of WO2018099198A1 publication Critical patent/WO2018099198A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Definitions

  • the present application is based on the application of the CN application number 201611088682.1, the filing date of which is the priority date of
  • the present disclosure relates to the field of drone technology, and in particular, to a drone attitude control method, apparatus, and drone.
  • the drone referred to as the "unmanned aerial vehicle" is a non-manned aircraft operated by radio remote control equipment and its own program control device.
  • the controller uses the joystick of the remote control terminal to adjust the pitch angle of the drone, the roll angle attitude and the tilt angle of the rotor, so that the drone can obtain acceleration, and the drone can also be adjusted by adjusting the angle of the rotor of the drone. Longitudinal and lateral lateral flight is achieved with the same roll attitude.
  • the attitude control loop of the drone calculates the difference between the desired attitude angle and the attitude angle of the drone obtained by the attitude reference system, and takes the difference as The attitude angle deviation in the ground coordinate system, and the desired attitude adjustment angular rate in the ground coordinate system is obtained by the proportional controller, and the attitude angle is adjusted by the attitude adjustment angle.
  • the proportional controller to control the attitude adjustment angular rate, if the proportional parameter is too large, the attitude adjustment angular rate is too high, so that the response speed of the attitude adjustment is fast but the overshoot is easy to cause low frequency oscillation. If the proportional parameter is too small, then The attitude adjustment angular rate is too small, which can reduce the overshoot amount but the response speed of the attitude adjustment is slow, which affects the performance of the drone and reduces the user experience.
  • One or more embodiments of the present disclosure provide a drone attitude control method, apparatus, and drone.
  • An embodiment of the present disclosure provides a UAV attitude control method, including: determining a posture angle deviation that needs to be adjusted according to a target attitude angle that the UAV needs to adjust, and a current actual posture angle of the UAV;
  • the adjustment interval of the deviation is divided into N angular velocity control intervals, and the correspondence relationship between the attitude adjustment angular velocity and the attitude angular deviation value in each angular velocity control interval is determined; wherein, the N is greater than or equal to 2;
  • the angle is adjusted to the target attitude angle, wherein the attitude adjustment angular rate is controlled according to a correspondence corresponding to the N angular velocity control intervals in the adjustment. .
  • the correspondence relationship includes: a proportional function relationship and an inverse parabolic function relationship.
  • the dividing the adjustment interval of the attitude angle deviation into N angular velocity control intervals includes: The numerical interval of the attitude angle deviation is divided into a continuous first angular velocity control interval and a second angular velocity control interval, wherein an absolute value of the attitude angular deviation value in the first angular velocity control interval is smaller than the second angular velocity control interval An absolute value of the attitude angle deviation value; the determining the correspondence between the attitude adjustment angular rate and the attitude angle deviation value in each angular velocity control interval includes: determining the posture adjustment angular rate in the first angular velocity control interval And the attitude angle deviation value is a proportional function relationship; in the second angular velocity control interval, determining that the attitude adjustment angular rate and the posture angle deviation value are inverse parabolic function relations.
  • the controlling the attitude adjustment angular rate according to the correspondence relationship corresponding to the N angular velocity control intervals in the adjusting comprises: in the first angular velocity control interval, based on the posture angular deviation And controlling the attitude adjustment angular rate according to the proportional function relationship; acquiring the attitude angle deviation value in real time, and determining that the posture angle deviation value is increased to the first angular velocity control interval and the first In the interval limit value of the two-angle speed control section, the attitude adjustment angular rate is controlled based on the attitude angle deviation value and switching to the inverse parabola function relationship.
  • Rate des k p ⁇ Att error ;
  • Rate des is the angular rate of the attitude adjustment
  • k p is a proportional control parameter
  • Att error is the attitude angle deviation value
  • the target attitude angle and the actual posture angle are one or more of a pitch angle, a yaw angle, and a roll angle.
  • An embodiment of the present disclosure provides a UAV attitude control apparatus, including: an adjustment data acquisition module, configured to acquire a target attitude angle that the UAV needs to adjust; and an attitude data acquisition module, configured to acquire a current actual posture of the UAV
  • An angle parameter control module is configured to determine an attitude angle deviation that needs to be adjusted according to the target attitude angle and the actual posture angle, and divide the adjustment interval of the attitude angle deviation into N angular speed control intervals, and determine Each Corresponding relationship between the attitude adjustment angular rate and the attitude angle deviation value in the angular velocity control interval; wherein the N is greater than or equal to 2; the attitude angle control module is configured to adjust the attitude angle of the drone to the target posture angle, wherein The attitude adjustment angular rate is controlled according to a correspondence relationship corresponding to the N angular velocity control intervals in the adjustment.
  • the correspondence relationship includes: a proportional function relationship and an inverse parabolic function relationship.
  • control parameter setting module includes: a section dividing unit, configured to divide the numerical interval of the attitude angle deviation into a continuous first angular velocity control interval and a second angular velocity control interval, where the An absolute value of the attitude angle deviation value in the one angular velocity control interval is smaller than an absolute value of the attitude angular deviation value in the second angular velocity control interval; and a control function determining unit configured to determine in the first angular velocity control interval
  • the attitude adjustment angular rate and the attitude angle deviation value are proportional to a function relationship; in the second angular velocity control interval, determining that the attitude adjustment angular rate and the attitude angle deviation value are inverse parabolic function relationships.
  • the attitude angle control module includes: a first adjustment unit, configured to adjust the posture according to the attitude angle deviation value according to the proportional function relationship in the first angular velocity control interval The angular rate is controlled; the second adjusting unit is configured to acquire the attitude angle deviation value in real time by using the attitude data acquiring module, and determine that the posture angle deviation value is increased to the first angular speed control interval and the first In the interval limit value of the two-angle speed control section, the attitude adjustment angular rate is controlled based on the attitude angle deviation value and switching to the inverse parabola function relationship.
  • control function determining unit determines the proportional function relationship
  • Rate des k p ⁇ Att error ;
  • Rate des adjusts the angular rate for the posture
  • k p is a proportional control parameter
  • Att error is the attitude angle deviation value
  • the control function determining unit determines the inverse parabolic function relationship
  • control function determining unit determines the interval threshold value
  • the target attitude angle and the actual posture angle are one or more of a pitch angle, a yaw angle, and a roll angle.
  • An embodiment of the present disclosure provides a drone, including the drone attitude control device of any of the above.
  • An embodiment of the present disclosure provides a drone attitude control apparatus including: a memory; and a processor coupled to the memory, the processor configured to execute the above based on an instruction stored in the memory The UAV attitude control described.
  • An embodiment of the present disclosure provides a computer readable storage medium having stored thereon computer program instructions that, when executed by one or more processors, implement the steps of any of the methods described above.
  • the UAV attitude control method, device and UAV provided by the present disclosure divide the adjustment interval of the attitude angle deviation into a plurality of angular velocity control intervals, and according to the corresponding relationship with the angular velocity control interval in the adjustment Controlling the attitude adjustment angular rate, you can use the fast proportional control at the initial stage of the attitude adjustment, use the larger proportional parameters, speed up the response speed, and quickly eliminate the error.
  • the anti-parabolic control algorithm can be used to limit the angular acceleration during the adjustment. It can reduce the overshoot and obtain the desired attitude angular velocity, which can improve the attitude adjustment of the drone and the stability of flight.
  • FIG. 1 is a flow chart showing an embodiment of a drone attitude control method according to the present disclosure
  • FIG. 2 is a control logic diagram of one embodiment of a drone attitude control method according to the present disclosure
  • FIG. 3 is a block diagram of an embodiment of a drone attitude control device in accordance with the present disclosure.
  • FIG. 4 is a block diagram showing a control parameter setting module in one embodiment of a drone attitude control device according to the present disclosure
  • FIG. 5 is a block diagram of a posture angle control module in one embodiment of a drone attitude control device according to the present disclosure
  • FIG. 6 is a block diagram of another embodiment of a drone attitude control device in accordance with the present disclosure.
  • FIG. 1 is a schematic flow chart of an embodiment of a UAV attitude control method according to the present disclosure, as shown in FIG. 1:
  • Step 101 Obtain a target attitude angle that the drone needs to adjust, and a current actual attitude angle of the drone.
  • the target attitude angle and the actual attitude angle are three-channel attitude angles, that is, one or more of a pitch angle, a yaw angle, and a roll angle.
  • the actual attitude angle of the drone can be obtained by analyzing and processing data collected by sensors such as accelerometers, gyroscopes, and magnetic compasses.
  • the position and speed of the drone can be obtained by analyzing and processing data obtained by sensors such as GP, ultrasonic sensors, and vision sensors. .
  • Step 102 Determine an attitude angle deviation that needs to be adjusted according to the target posture angle and the actual posture angle.
  • the attitude angle deviation Att error Att des -Att rel is calculated.
  • the drone can be acquired.
  • Att des is the target attitude angle that needs to be adjusted. It is the desired attitude angle obtained according to the input of the remote control lever or the target attitude angle calculated by the desired position of the drone.
  • Att rel is the actual attitude angle.
  • the present disclosure does not limit the manner in which the coordinate system of the azimuth reference system is set.
  • Step 103 The adjustment interval of the attitude angle deviation is divided into N angular velocity control intervals, N is greater than or equal to 2, and the correspondence relationship between the attitude adjustment angular velocity and the attitude angular deviation value in each angular velocity control interval is determined.
  • the attitude angle deviation can be positive or negative.
  • the adjustment interval of the attitude angle deviation is a numerical interval of the attitude angle deviation in the process of adjusting the attitude angle of the drone to the target posture angle. For example, if the attitude angle deviation is positive 20 degrees, [0, 20] is an adjustment interval of the attitude angle deviation.
  • the adjustment interval [0, 20] of the attitude angle deviation is divided into three angular velocity control intervals, which are [0, 5], [0, 10], [10, 20], respectively, and the angular velocity control interval [0, 5] is determined.
  • Correspondence relationships can be a variety of functional relationships, such as proportional function relationships, inverse parabolic function relationships, and the like.
  • Step 104 In the adjustment, the attitude adjustment angular rate is controlled according to the correspondence relationship corresponding to the N angular velocity control sections, and the attitude angle of the drone is adjusted to the target posture angle.
  • the attitude angle adjustment of the drone is realized by controlling the throttle rudder amount, the aileron rudder amount, the rudder amount and the rudder amount of the drone, and the pitch angle, the yaw angle and the roll are adjusted.
  • the corner adjusts the attitude angle of the drone to the target attitude angle so that the drone conforms to the current flight action that needs to be performed.
  • the numerical interval of the attitude angle deviation is divided into a continuous first angular velocity control interval and a second angular velocity control interval, and the absolute value of the attitude angular deviation value in the first angular velocity control interval is smaller than the second angular velocity control interval.
  • the attitude adjustment angular rate and the attitude angle deviation value are proportional function relationships. For example, the determined proportional function relationship is:
  • Rate des k p ⁇ Att error ;
  • Rate des is the attitude adjustment angular rate
  • k p is the proportional control parameter
  • k p >0 is the attitude angle deviation value.
  • the attitude adjustment angular rate and the attitude angle deviation value are inverse parabolic function relationships.
  • the determined inverse parabolic function relationship is:
  • the attitude adjustment angular rate is controlled based on the attitude angle deviation value and based on the proportional function relationship.
  • the attitude angle deviation value is obtained in real time, and when the posture angle deviation value is determined to increase to the interval threshold value of the first angular velocity control interval and the second angular velocity control interval, the attitude adjustment angle is switched based on the attitude angle deviation value and switched to the inverse parabolic function relationship The rate is controlled.
  • the attitude angle deviations of the pitch angle, the yaw angle, and the roll angle need to be adjusted respectively, and the adjustment intervals of the three attitude angle deviations are respectively divided into the angular velocity control intervals, and the attitude adjustment angular rate in each angular velocity control interval is determined. Correspondence with the deviation value of the attitude angle.
  • the attitude adjustment angular rate of the pitch angle, the yaw angle, and the roll angle is controlled according to the corresponding relationship corresponding to the angular velocity control section of the pitch angle, the yaw angle, and the roll angle.
  • the abscissa Att_err in the figure is the attitude angle deviation, that is, the deviation of the pitch angle, the deviation of the pitch angle is greater than 0, and the ordinate Rate_des is the attitude adjustment angle.
  • the rate the attitude of the pitch angle, adjusts the angular rate.
  • the angular velocity control interval for the pitch angle adjustment of the drone and the corresponding relationship between the attitude adjustment angular velocity and the attitude angle deviation value are:
  • the slope of the linear function is kp, which is the proportional control parameter of the design. kp>0, the larger the kp, the more the line flutters, and the physical meaning is that the response of the attitude adjustment angular rate (ordinate) is faster, but Too fast will lead to a large overshoot.
  • the mode is switched to the anti-parabolic control mode, and the desired attitude adjustment angular rate is smoothly achieved without overshoot.
  • the UAV attitude control method divides the adjustment interval of the attitude angle deviation into a plurality of angular velocity control intervals, and controls the attitude adjustment angular rate according to the correspondence relationship corresponding to the angular velocity control interval during the adjustment, which may be
  • fast proportional control is used, which uses large proportional parameters to speed up the response and quickly eliminate the error.
  • the anti-parabolic control algorithm can be used to limit the angular acceleration during adjustment, which can reduce the overshoot and obtain the expectation.
  • the angular rate of the gesture is used to limit the angular acceleration during adjustment, which can reduce the overshoot and obtain the expectation.
  • the present disclosure provides a UAV attitude control device 30, including: an adjustment data acquisition module 31, an attitude data acquisition module 32, a control parameter setting module 33, and a posture angle control module. 34 and so on.
  • the adjustment data acquisition module 31 acquires a target attitude angle that the drone needs to adjust.
  • the attitude data acquisition module 32 acquires the current actual attitude angle of the drone.
  • the control parameter setting module 33 determines the attitude angle deviation that needs to be adjusted according to the target attitude angle and the actual posture angle, divides the adjustment interval of the attitude angle deviation into N angular velocity control intervals, and determines the posture adjustment angle in each angular velocity control interval. Correspondence between the rate and the attitude angle deviation value, where N is greater than or equal to 2.
  • the attitude angle control module 34 adjusts the attitude angle of the drone to the target attitude angle, wherein the attitude adjustment angular rate is controlled according to the correspondence relationship corresponding to the N angular velocity control sections in the adjustment. Correspondence relationships include: proportional function relationships, inverse parabolic function relationships, and so on.
  • the target attitude angle and the actual attitude angle are one or more of a pitch angle, a yaw angle, and a roll angle.
  • the control parameter setting module 33 includes an interval dividing unit 331 and a control function determining unit 332.
  • the section dividing unit 331 divides the numerical interval of the attitude angle deviation into a continuous first angular velocity control interval and a second angular velocity control interval, wherein the absolute value of the posture angular deviation value in the first angular velocity control interval is smaller than the second angular velocity control The absolute value of the attitude angle deviation value in the interval.
  • the control function determining unit 332 determines, in the first angular velocity control section, a proportional function relationship between the attitude adjustment angular rate and the attitude angle deviation value. In the second angular velocity control interval, it is determined that the attitude adjustment angular rate and the attitude angle deviation value are inverse parabolic function relationships.
  • the control function determining unit 332 determines the proportional function relationship as:
  • Rate des k p ⁇ Att error ;
  • Rate des is the attitude adjustment angular rate
  • k p is the proportional control parameter
  • k p >0 is the attitude angle deviation value.
  • the control function determining unit 332 determines that the inverse parabolic function relationship is:
  • the control function determines 332 the unit to determine the interval limit value:
  • the attitude angle control module 34 includes a first adjustment unit 341 and a second adjustment unit 342.
  • the first adjustment unit 341 controls the attitude adjustment angular rate based on the attitude angle deviation value and based on the proportional function relationship in the first angular velocity control section.
  • the second adjusting unit 342 acquires the attitude angle deviation value in real time through the attitude data acquiring module, and when determining that the posture angle deviation value is increased to the interval threshold value of the first angular velocity control interval and the second angular velocity control interval, based on the attitude angle deviation value, and Switching to an anti-parabolic function relationship controls the attitude adjustment angular rate.
  • the present disclosure provides a drone comprising: the drone attitude control device as above.
  • the apparatus can include a memory 61, a processor 62, a communication interface 63, and a bus 64.
  • the memory 61 is for storing instructions
  • the processor 62 is coupled to the memory 61
  • the processor 62 is configured to perform the above-described drone attitude control method based on the instructions stored by the memory 61.
  • the memory 61 may be a high speed RAM memory, a non-volatile memory, or the like, and the memory 61 may be a memory array.
  • the memory 61 may also be partitioned, and the blocks may be combined into a virtual volume according to certain rules.
  • the processor 62 may be a central processing unit CPU, or an application specific integrated circuit (ASIC), or one or more integrated circuits configured to implement the drone attitude control method of the present disclosure.
  • the functional unit modules described above may be implemented as a general purpose processor, a Programmable Logic Controller (PLC), and a Digital Signal Processor (Digital Signal Processor) for performing the functions described in the present disclosure.
  • DSP Digital Signal Processor
  • ASIC Application Specific Integrated Circuit
  • FPGA Field-Programmable Gate Array
  • the unmanned aerial vehicle attitude control method and device and the unmanned aerial vehicle provided by the above embodiments divide the adjustment interval of the attitude angle deviation into a plurality of angular velocity control intervals, and adjust the attitude according to the correspondence relationship corresponding to the angular velocity control interval during the adjustment.
  • Rate control which can use fast proportional control at the initial stage of attitude adjustment, use larger proportional parameters, speed up response, and quickly eliminate errors.
  • the anti-parabolic control algorithm can limit the angular acceleration during adjustment and can reduce The overshoot amount and the desired attitude angular rate can improve the attitude adjustment of the drone and the stability of the flight, improve the flight safety factor, and improve the user experience.
  • the present disclosure further provides a computer readable storage medium, wherein the computer readable storage medium stores computer instructions that, when executed by the processor, implement the drone attitude control method of any of the above embodiments.
  • the present disclosure may be provided as a method, apparatus, or computer program product. Accordingly, the present disclosure may take the form of an entirely hardware embodiment, an entirely software embodiment, or a combination of software and hardware aspects.
  • the present disclosure may take the form of a computer program product embodied on one or more computer-usable non-transitory storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer usable program code. .
  • the methods and systems of the present disclosure may be implemented in a number of ways. For example, via software, hardware, firmware or Any combination of software, hardware, firmware, to implement the methods and systems of the present disclosure.
  • the above-described sequence of steps for the method is for illustrative purposes only, and the steps of the method of the present disclosure are not limited to the order specifically described above unless otherwise specifically stated.
  • the present disclosure may also be embodied as programs recorded in a recording medium, the programs including machine readable instructions for implementing a method in accordance with the present disclosure.
  • the present disclosure also covers a recording medium storing a program for executing the method according to the present disclosure.

Abstract

A control method and device for an attitude of an unmanned aerial vehicle, and an unmanned aerial vehicle, relating to the technical field of unmanned aerial vehicles. The method comprises: determining an attitude angle deviation needing to be adjusted; and dividing an adjustment interval of the attitude angle deviation into N angular speed control intervals and controlling an attitude adjustment angular rate according to correlations corresponding to the N angular speed control intervals during adjustment. According to the control method and device for an attitude of an unmanned aerial vehicle, and the unmanned aerial vehicle, by dividing an adjustment interval of the attitude angle deviation into a plurality of angular speed control intervals, control can be implemented using a rapid proportion during an initial period of attitude adjustment, the response speed is increased, and errors are rapidly eliminated; the overshoot can be reduced using an inverse parabolic control algorithm during the late period of attitude adjustment, the stability for attitude adjustment and flight of the unmanned aerial vehicle can be improved, the safety coefficient of flight is improved, and user experience can be improved.

Description

无人机姿态控制方法、装置及无人机UAV attitude control method, device and drone
本申请是以CN申请号为201611088682.1,申请日为2016年12月1日的申请为基础,并主张其优先权,该CN申请的公开内容在此作为整体引入本申请中。The present application is based on the application of the CN application number 201611088682.1, the filing date of which is the priority date of
技术领域Technical field
本公开涉及无人机技术领域,尤其涉及一种无人机姿态控制方法、装置及无人机。The present disclosure relates to the field of drone technology, and in particular, to a drone attitude control method, apparatus, and drone.
背景技术Background technique
无人驾驶飞机简称“无人机”,是利用无线电遥控设备和自备的程序控制装置操纵的不载人飞机。操控者利用遥控终端的控制杆调节无人机的俯仰角、滚转角姿态以及旋翼的倾斜角度,使无人机获得加速度,也可以通过调节无人机的旋翼的角度,使得无人机在俯仰或滚转姿态不变的情况下实现纵向和横侧向飞行。目前,在对无人机的姿态进行控制时,无人机的姿态控制回路计算期望的姿态角与通过航姿参考系统解算得到的无人机的姿态角的差值,将此差值作为地面坐标系下姿态角偏差,并经过比例控制器得到地面坐标系下期望的姿态调整角速率,采用此姿态调整角速率调整姿态角度。在使用比例控制器对姿态调整角速率进行控制时,如果比例参数过大,则姿态调整角速率过高,使得姿态调整的响应速度快但易超调引起低频振荡,如果比例参数过小,则姿态调整角速率过小,可以减小超调量但姿态调整的响应速度慢,影响无人机的性能并降低用户体验。The drone, referred to as the "unmanned aerial vehicle", is a non-manned aircraft operated by radio remote control equipment and its own program control device. The controller uses the joystick of the remote control terminal to adjust the pitch angle of the drone, the roll angle attitude and the tilt angle of the rotor, so that the drone can obtain acceleration, and the drone can also be adjusted by adjusting the angle of the rotor of the drone. Longitudinal and lateral lateral flight is achieved with the same roll attitude. At present, when controlling the attitude of the drone, the attitude control loop of the drone calculates the difference between the desired attitude angle and the attitude angle of the drone obtained by the attitude reference system, and takes the difference as The attitude angle deviation in the ground coordinate system, and the desired attitude adjustment angular rate in the ground coordinate system is obtained by the proportional controller, and the attitude angle is adjusted by the attitude adjustment angle. When using the proportional controller to control the attitude adjustment angular rate, if the proportional parameter is too large, the attitude adjustment angular rate is too high, so that the response speed of the attitude adjustment is fast but the overshoot is easy to cause low frequency oscillation. If the proportional parameter is too small, then The attitude adjustment angular rate is too small, which can reduce the overshoot amount but the response speed of the attitude adjustment is slow, which affects the performance of the drone and reduces the user experience.
发明内容Summary of the invention
本公开的一个或多个实施例提供一种无人机姿态控制方法、装置及无人机。One or more embodiments of the present disclosure provide a drone attitude control method, apparatus, and drone.
本公开的实施例提供一种无人机姿态控制方法,包括:根据无人机需要调整的目标姿态角度,以及无人机当前的实际姿态角度确定需要调整的姿态角偏差;将所述姿态角偏差的调整区间划分为N个角速度控制区间,并确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系;其中,所述N大于等于2;将无人机的姿态角度调整到所述目标姿态角度,其中,在调整中根据与所述N个角速度控制区间相对应的对应关系对所述姿态调整角速率进行控制。。An embodiment of the present disclosure provides a UAV attitude control method, including: determining a posture angle deviation that needs to be adjusted according to a target attitude angle that the UAV needs to adjust, and a current actual posture angle of the UAV; The adjustment interval of the deviation is divided into N angular velocity control intervals, and the correspondence relationship between the attitude adjustment angular velocity and the attitude angular deviation value in each angular velocity control interval is determined; wherein, the N is greater than or equal to 2; The angle is adjusted to the target attitude angle, wherein the attitude adjustment angular rate is controlled according to a correspondence corresponding to the N angular velocity control intervals in the adjustment. .
可选地,所述对应关系包括:比例函数关系、反抛物线函数关系。Optionally, the correspondence relationship includes: a proportional function relationship and an inverse parabolic function relationship.
可选地,所述将所述姿态角偏差的调整区间划分为N个角速度控制区间包括:将所述 姿态角偏差的数值区间划分为连续的第一角速度控制区间和第二角速度控制区间,其中,所述第一角速度控制区间中的姿态角偏差值的绝对值小于所述第二角速度控制区间中的姿态角偏差值的绝对值;所述确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系包括:在所述第一角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为比例函数关系;在所述第二角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为反抛物线函数关系。Optionally, the dividing the adjustment interval of the attitude angle deviation into N angular velocity control intervals includes: The numerical interval of the attitude angle deviation is divided into a continuous first angular velocity control interval and a second angular velocity control interval, wherein an absolute value of the attitude angular deviation value in the first angular velocity control interval is smaller than the second angular velocity control interval An absolute value of the attitude angle deviation value; the determining the correspondence between the attitude adjustment angular rate and the attitude angle deviation value in each angular velocity control interval includes: determining the posture adjustment angular rate in the first angular velocity control interval And the attitude angle deviation value is a proportional function relationship; in the second angular velocity control interval, determining that the attitude adjustment angular rate and the posture angle deviation value are inverse parabolic function relations.
可选地,所述在调整中根据与所述N个角速度控制区间相对应的对应关系对所述姿态调整角速率进行控制包括:在所述第一角速度控制区间中,基于所述姿态角偏差值、并根据所述比例函数关系对所述姿态调整角速率进行控制;实时获取所述姿态角偏差值,当确定所述姿态角偏差值增大至所述第一角速度控制区间与所述第二角速度控制区间的区间界限值时,基于所述姿态角偏差值、并切换为所述反抛物线函数关系对所述姿态调整角速率进行控制。Optionally, the controlling the attitude adjustment angular rate according to the correspondence relationship corresponding to the N angular velocity control intervals in the adjusting comprises: in the first angular velocity control interval, based on the posture angular deviation And controlling the attitude adjustment angular rate according to the proportional function relationship; acquiring the attitude angle deviation value in real time, and determining that the posture angle deviation value is increased to the first angular velocity control interval and the first In the interval limit value of the two-angle speed control section, the attitude adjustment angular rate is controlled based on the attitude angle deviation value and switching to the inverse parabola function relationship.
可选地,确定所述比例函数关系Optionally, determining the proportional function relationship
Ratedes=kp·AtterrorRate des = k p · Att error ;
其中,Ratedes为所述姿态调整角速率,kp为比例控制参数,kp>0,Atterror为所述姿态角偏差值;确定所述反抛物线函数关系为:Where, Rate des is the angular rate of the attitude adjustment, k p is a proportional control parameter, k p >0, and Att error is the attitude angle deviation value; determining the inverse parabolic function relationship is:
Figure PCTCN2017106341-appb-000001
Figure PCTCN2017106341-appb-000001
其中,a为旋转加速度的最大阈值。Where a is the maximum threshold of the rotational acceleration.
可选地,确定所述区间界限值Optionally, determining the interval threshold value
Figure PCTCN2017106341-appb-000002
Figure PCTCN2017106341-appb-000002
可选地,所述目标姿态角度与所述实际姿态角度为俯仰角度、偏航角度、滚转角度中的一个或多个。Optionally, the target attitude angle and the actual posture angle are one or more of a pitch angle, a yaw angle, and a roll angle.
本公开的实施例提供一种无人机姿态控制装置,包括:调整数据获取模块,用于获取无人机需要调整的目标姿态角度;姿态数据获取模块,用于获取无人机当前的实际姿态角度;控制参数设定模块,用于根据所述目标姿态角度与所述实际姿态角度确定需要调整的姿态角偏差,将所述姿态角偏差的调整区间划分为N个角速度控制区间,并确定在每个 角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系;其中,所述N大于等于2;姿态角度控制模块,用于将无人机的姿态角度调整到所述目标姿态角度,其中,在调整中根据与所述N个角速度控制区间相对应的对应关系对所述姿态调整角速率进行控制。An embodiment of the present disclosure provides a UAV attitude control apparatus, including: an adjustment data acquisition module, configured to acquire a target attitude angle that the UAV needs to adjust; and an attitude data acquisition module, configured to acquire a current actual posture of the UAV An angle parameter control module is configured to determine an attitude angle deviation that needs to be adjusted according to the target attitude angle and the actual posture angle, and divide the adjustment interval of the attitude angle deviation into N angular speed control intervals, and determine Each Corresponding relationship between the attitude adjustment angular rate and the attitude angle deviation value in the angular velocity control interval; wherein the N is greater than or equal to 2; the attitude angle control module is configured to adjust the attitude angle of the drone to the target posture angle, wherein The attitude adjustment angular rate is controlled according to a correspondence relationship corresponding to the N angular velocity control intervals in the adjustment.
可选地,所述对应关系包括:比例函数关系、反抛物线函数关系。Optionally, the correspondence relationship includes: a proportional function relationship and an inverse parabolic function relationship.
可选地,所述控制参数设定模块,包括:区间划分单元,用于将所述姿态角偏差的数值区间划分为连续的第一角速度控制区间和第二角速度控制区间,其中,所述第一角速度控制区间中的姿态角偏差值的绝对值小于所述第二角速度控制区间中的姿态角偏差值的绝对值;控制函数确定单元,用于在所述第一角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为比例函数关系;在所述第二角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为反抛物线函数关系。Optionally, the control parameter setting module includes: a section dividing unit, configured to divide the numerical interval of the attitude angle deviation into a continuous first angular velocity control interval and a second angular velocity control interval, where the An absolute value of the attitude angle deviation value in the one angular velocity control interval is smaller than an absolute value of the attitude angular deviation value in the second angular velocity control interval; and a control function determining unit configured to determine in the first angular velocity control interval The attitude adjustment angular rate and the attitude angle deviation value are proportional to a function relationship; in the second angular velocity control interval, determining that the attitude adjustment angular rate and the attitude angle deviation value are inverse parabolic function relationships.
可选地,所述姿态角度控制模块,包括:第一调整单元,用于在所述第一角速度控制区间中,基于所述姿态角偏差值、并根据所述比例函数关系对所述姿态调整角速率进行控制;第二调整单元,用于通过所述姿态数据获取模块实时获取所述姿态角偏差值,当确定所述姿态角偏差值增大至所述第一角速度控制区间与所述第二角速度控制区间的区间界限值时,基于所述姿态角偏差值、并切换为所述反抛物线函数关系对所述姿态调整角速率进行控制。Optionally, the attitude angle control module includes: a first adjustment unit, configured to adjust the posture according to the attitude angle deviation value according to the proportional function relationship in the first angular velocity control interval The angular rate is controlled; the second adjusting unit is configured to acquire the attitude angle deviation value in real time by using the attitude data acquiring module, and determine that the posture angle deviation value is increased to the first angular speed control interval and the first In the interval limit value of the two-angle speed control section, the attitude adjustment angular rate is controlled based on the attitude angle deviation value and switching to the inverse parabola function relationship.
可选地,所述控制函数确定单元确定所述比例函数关系Optionally, the control function determining unit determines the proportional function relationship
Ratedes=kp·AtterrorRate des = k p · Att error ;
其中,Ratedes为所述姿态调整角速率,kp为比例控制参数,kp>0,Atterror为所述姿态角偏差值;所述控制函数确定单元确定所述反抛物线函数关系Wherein, Rate des adjusts the angular rate for the posture, k p is a proportional control parameter, k p >0, and Att error is the attitude angle deviation value; and the control function determining unit determines the inverse parabolic function relationship
Figure PCTCN2017106341-appb-000003
Figure PCTCN2017106341-appb-000003
其中,a为旋转加速度的最大阈值。Where a is the maximum threshold of the rotational acceleration.
可选地,所述控制函数确定单元确定所述区间界限值Optionally, the control function determining unit determines the interval threshold value
Figure PCTCN2017106341-appb-000004
Figure PCTCN2017106341-appb-000004
可选地,所述目标姿态角度与所述实际姿态角度为俯仰角度、偏航角度、滚转角度中的一个或多个。 Optionally, the target attitude angle and the actual posture angle are one or more of a pitch angle, a yaw angle, and a roll angle.
本公开的实施例提供一种无人机,包括如上任一所述的无人机姿态控制装置。An embodiment of the present disclosure provides a drone, including the drone attitude control device of any of the above.
本公开的实施例提供一种无人机姿态控制装置,包括:存储器;以及耦接至所述存储器的处理器,所述处理器被配置为基于存储在所述存储器中的指令,执行如上所述的无人机姿态控制。An embodiment of the present disclosure provides a drone attitude control apparatus including: a memory; and a processor coupled to the memory, the processor configured to execute the above based on an instruction stored in the memory The UAV attitude control described.
本公开实施例提供一种计算机可读存储介质,其上存储有计算机程序指令,该指令被一个或多个处理器执行时实现如上任意一所述的方法的步骤。An embodiment of the present disclosure provides a computer readable storage medium having stored thereon computer program instructions that, when executed by one or more processors, implement the steps of any of the methods described above.
由上述方案可知,本公开提供的无人机姿态控制方法、装置及无人机,将姿态角偏差的调整区间划分为多个角速度控制区间,在调整中根据与角速度控制区间相对应的对应关系对姿态调整角速率进行控制,可以在姿态调整初期使用快速比例控制,使用较大的比例参数,加快响应速度,快速消除误差,在姿态调整后期采用反抛物线控制算法,能够限制调整中的角加速度,可以减小超调量,得到期望的姿态角速率,能够提高无人机姿态调整以及飞行的稳定性。It can be seen from the above proposal that the UAV attitude control method, device and UAV provided by the present disclosure divide the adjustment interval of the attitude angle deviation into a plurality of angular velocity control intervals, and according to the corresponding relationship with the angular velocity control interval in the adjustment Controlling the attitude adjustment angular rate, you can use the fast proportional control at the initial stage of the attitude adjustment, use the larger proportional parameters, speed up the response speed, and quickly eliminate the error. In the later stage of the attitude adjustment, the anti-parabolic control algorithm can be used to limit the angular acceleration during the adjustment. It can reduce the overshoot and obtain the desired attitude angular velocity, which can improve the attitude adjustment of the drone and the stability of flight.
通过以下参照附图对本公开的示例性实施例的详细描述,本公开的其它特征及其优点将会变得清楚。Other features of the present disclosure and its advantages will be apparent from the following detailed description of exemplary embodiments.
附图说明DRAWINGS
此处所说明的附图用来提供对本公开的进一步理解,构成本申请的一部分,本公开的示意性实施例及其说明用于解释本公开,并不构成对本公开的不当限定。在附图中:The drawings described herein are provided to provide a further understanding of the present disclosure, which is a part of the present disclosure, and the description of the present disclosure and the description thereof are not intended to limit the disclosure. In the drawing:
图1为根据本公开的无人机姿态控制方法的一个实施例的流程示意图;1 is a flow chart showing an embodiment of a drone attitude control method according to the present disclosure;
图2为根据本公开的无人机姿态控制方法的一个实施例的控制逻辑示意图;2 is a control logic diagram of one embodiment of a drone attitude control method according to the present disclosure;
图3为根据本公开的无人机姿态控制装置的一个实施例的模块示意图;3 is a block diagram of an embodiment of a drone attitude control device in accordance with the present disclosure;
图4为根据本公开的无人机姿态控制装置的一个实施例中的控制参数设定模块的模块示意图;4 is a block diagram showing a control parameter setting module in one embodiment of a drone attitude control device according to the present disclosure;
图5为根据本公开的无人机姿态控制装置的一个实施例中的姿态角度控制模块的模块示意图;5 is a block diagram of a posture angle control module in one embodiment of a drone attitude control device according to the present disclosure;
图6为根据本公开的无人机姿态控制装置的另一个实施例的模块示意图。6 is a block diagram of another embodiment of a drone attitude control device in accordance with the present disclosure.
具体实施方式detailed description
下面将结合本公开实施例中的附图,对本公开实施例中的技术方案进行清楚、完 整地描述,显然,所描述的实施例仅仅是本公开一部分实施例,而不是全部的实施例。基于本公开中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本公开保护的范围。The technical solutions in the embodiments of the present disclosure will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present disclosure. It is apparent that the described embodiments are only a part of the embodiments of the present disclosure, and not all of the embodiments. All other embodiments obtained by a person of ordinary skill in the art based on the embodiments of the present disclosure without departing from the inventive scope are the scope of the disclosure.
下文中的“第一”、“第二”等仅用于描述上相区别,并没有其它特殊的含义。Hereinafter, "first", "second", and the like are merely used to describe the difference in the upper phase, and have no other special meaning.
图1为根据本公开的无人机姿态控制方法的一个实施例的流程示意图,如图1所示:1 is a schematic flow chart of an embodiment of a UAV attitude control method according to the present disclosure, as shown in FIG. 1:
步骤101,获取无人机需要调整的目标姿态角度,以及无人机当前的实际姿态角度。Step 101: Obtain a target attitude angle that the drone needs to adjust, and a current actual attitude angle of the drone.
目标姿态角度与实际姿态角度为三通道的姿态角,即俯仰角度、偏航角度、滚转角度中的一个或多个。无人机的实际姿态角度可以通过分析处理加速度计、陀螺仪以及磁罗盘等传感器采集的数据获得,无人机的位置、速度可以通过分析处理GP、超声波传感器、视觉传感器等传感器获得的数据获得。The target attitude angle and the actual attitude angle are three-channel attitude angles, that is, one or more of a pitch angle, a yaw angle, and a roll angle. The actual attitude angle of the drone can be obtained by analyzing and processing data collected by sensors such as accelerometers, gyroscopes, and magnetic compasses. The position and speed of the drone can be obtained by analyzing and processing data obtained by sensors such as GP, ultrasonic sensors, and vision sensors. .
步骤102,根据目标姿态角度与实际姿态角度确定需要调整的姿态角偏差。Step 102: Determine an attitude angle deviation that needs to be adjusted according to the target posture angle and the actual posture angle.
根据需要调整的目标姿态角度与通过航姿参考系统解算得到的当前姿态角计算姿态角偏差Atterror=Attdes-Attrel,例如,在航姿参考系统的坐标系中,可以获取无人机在X轴、Y轴与Z轴的俯仰角度、偏航角度、滚转角度的姿态角偏差。Attdes为需要调整的目标姿态角度,为根据遥控器操作杆的输入按比例得到的期望姿态角或由无人机的期望位置计算得到的目标姿态角度,Attrel为实际姿态角度。本公开不限制航姿参考系统的坐标系的设置方式。According to the target attitude angle adjusted and the current attitude angle calculated by the attitude reference system, the attitude angle deviation Att error =Att des -Att rel is calculated. For example, in the coordinate system of the attitude reference system, the drone can be acquired. The attitude angle deviation of the pitch angle, the yaw angle, and the roll angle of the X-axis, the Y-axis, and the Z-axis. Att des is the target attitude angle that needs to be adjusted. It is the desired attitude angle obtained according to the input of the remote control lever or the target attitude angle calculated by the desired position of the drone. Att rel is the actual attitude angle. The present disclosure does not limit the manner in which the coordinate system of the azimuth reference system is set.
步骤103,将姿态角偏差的调整区间划分为N个角速度控制区间,N大于等于2,并确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系。Step 103: The adjustment interval of the attitude angle deviation is divided into N angular velocity control intervals, N is greater than or equal to 2, and the correspondence relationship between the attitude adjustment angular velocity and the attitude angular deviation value in each angular velocity control interval is determined.
基于航姿参考系统的坐标系,姿态角偏差可以为正数或负数。姿态角偏差的调整区间为将无人机的姿态角度调整到目标姿态角度的过程中姿态角偏差的数值区间。例如,姿态角偏差为正20度,则[0,20]为姿态角偏差的调整区间。将姿态角偏差的调整区间[0,20]划分为3个角速度控制区间,分别为[0,5]、[0,10]、[10,20],确定在角速度控制区间[0,5]、[0,10]、[10,20]中的姿态调整角速率与姿态角偏差值的对应关系。对应关系可以为多种函数关系,例如比例函数关系、反抛物线函数关系等。Based on the coordinate system of the attitude reference system, the attitude angle deviation can be positive or negative. The adjustment interval of the attitude angle deviation is a numerical interval of the attitude angle deviation in the process of adjusting the attitude angle of the drone to the target posture angle. For example, if the attitude angle deviation is positive 20 degrees, [0, 20] is an adjustment interval of the attitude angle deviation. The adjustment interval [0, 20] of the attitude angle deviation is divided into three angular velocity control intervals, which are [0, 5], [0, 10], [10, 20], respectively, and the angular velocity control interval [0, 5] is determined. Correspondence between the attitude adjustment angular rate and the attitude angle deviation value in [0, 10], [10, 20]. Correspondence relationships can be a variety of functional relationships, such as proportional function relationships, inverse parabolic function relationships, and the like.
步骤104,在调整中根据与N个角速度控制区间相对应的对应关系对姿态调整角速率进行控制,将无人机的姿态角度调整到目标姿态角度。Step 104: In the adjustment, the attitude adjustment angular rate is controlled according to the correspondence relationship corresponding to the N angular velocity control sections, and the attitude angle of the drone is adjusted to the target posture angle.
在无人机的飞行过程中,通过控制无人机的油门舵量、副翼舵量、升降舵量与方向舵量等实现对无人机的姿态角度调整,通过调整俯仰角、偏航角和滚转角,将无人机的姿态角度调整到目标姿态角度,以使得无人机符合当前需要执行的飞行动作。 During the flight of the drone, the attitude angle adjustment of the drone is realized by controlling the throttle rudder amount, the aileron rudder amount, the rudder amount and the rudder amount of the drone, and the pitch angle, the yaw angle and the roll are adjusted. The corner adjusts the attitude angle of the drone to the target attitude angle so that the drone conforms to the current flight action that needs to be performed.
在一个实施例中,将姿态角偏差的数值区间划分为连续的第一角速度控制区间和第二角速度控制区间,第一角速度控制区间中的姿态角偏差值的绝对值小于第二角速度控制区间中的姿态角偏差值的绝对值。在第一角速度控制区间中,确定姿态调整角速率与姿态角偏差值为比例函数关系。例如,确定的比例函数关系为:In one embodiment, the numerical interval of the attitude angle deviation is divided into a continuous first angular velocity control interval and a second angular velocity control interval, and the absolute value of the attitude angular deviation value in the first angular velocity control interval is smaller than the second angular velocity control interval. The absolute value of the attitude angle deviation value. In the first angular velocity control interval, it is determined that the attitude adjustment angular rate and the attitude angle deviation value are proportional function relationships. For example, the determined proportional function relationship is:
Ratedes=kp·AtterrorRate des = k p · Att error ;
Ratedes为姿态调整角速率,kp为比例控制参数,kp>0,Atterror为姿态角偏差值。可以根据飞机动力系统、飞机起飞质量等选择kp的值,以六轴的无人机为例,飞机起飞重量32kg,单桨拉力5.4kg,则可取kp=4.0。Rate des is the attitude adjustment angular rate, k p is the proportional control parameter, k p >0, and Att error is the attitude angle deviation value. The value of kp can be selected according to the aircraft power system, the take-off quality of the aircraft, etc., taking a six-axis drone as an example, the aircraft take-off weight is 32 kg, and the single-propeller pull force is 5.4 kg, then kp=4.0.
在第二角速度控制区间中,确定姿态调整角速率与姿态角偏差值为反抛物线函数关系。例如,确定的反抛物线函数关系为:In the second angular velocity control interval, it is determined that the attitude adjustment angular rate and the attitude angle deviation value are inverse parabolic function relationships. For example, the determined inverse parabolic function relationship is:
Figure PCTCN2017106341-appb-000005
Figure PCTCN2017106341-appb-000005
a为旋转加速度的最大阈值,单位为m/s2,a>0,a与飞机的质量有关,例如,对于六轴无人机,可取a=1000deg/s2a is the maximum threshold of rotational acceleration, the unit is m/s 2 , a>0, a is related to the quality of the aircraft. For example, for a six-axis drone, a=1000deg/s 2 can be taken .
在第一角速度控制区间中,基于姿态角偏差值、并根据比例函数关系对姿态调整角速率进行控制。实时获取姿态角偏差值,当确定姿态角偏差值增大至第一角速度控制区间与第二角速度控制区间的区间界限值时,基于姿态角偏差值、并切换为反抛物线函数关系对姿态调整角速率进行控制。In the first angular velocity control section, the attitude adjustment angular rate is controlled based on the attitude angle deviation value and based on the proportional function relationship. The attitude angle deviation value is obtained in real time, and when the posture angle deviation value is determined to increase to the interval threshold value of the first angular velocity control interval and the second angular velocity control interval, the attitude adjustment angle is switched based on the attitude angle deviation value and switched to the inverse parabolic function relationship The rate is controlled.
可以分别获取俯仰角度、偏航角度、滚转角度需要调整的姿态角偏差,将3个姿态角偏差的调整区间分别划分出角速度控制区间,并确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系。在调整中分别根据与俯仰角度、偏航角度、滚转角度的角速度控制区间相对应的对应关系对俯仰角度、偏航角度、滚转角度的姿态调整角速率进行控制。The attitude angle deviations of the pitch angle, the yaw angle, and the roll angle need to be adjusted respectively, and the adjustment intervals of the three attitude angle deviations are respectively divided into the angular velocity control intervals, and the attitude adjustment angular rate in each angular velocity control interval is determined. Correspondence with the deviation value of the attitude angle. In the adjustment, the attitude adjustment angular rate of the pitch angle, the yaw angle, and the roll angle is controlled according to the corresponding relationship corresponding to the angular velocity control section of the pitch angle, the yaw angle, and the roll angle.
如图2所示,以对姿态角度中的俯仰角的调整为例,图中的横坐标Att_err为姿态角偏差,即俯仰角的偏差,俯仰角的偏差大于0,纵坐标Rate_des为姿态调整角速率,即俯仰角的姿态调整角速率。设置2个角速度控制区间,确定区间界限值为:As shown in FIG. 2, taking the adjustment of the pitch angle in the attitude angle as an example, the abscissa Att_err in the figure is the attitude angle deviation, that is, the deviation of the pitch angle, the deviation of the pitch angle is greater than 0, and the ordinate Rate_des is the attitude adjustment angle. The rate, the attitude of the pitch angle, adjusts the angular rate. Set two angular velocity control intervals to determine the interval limit value:
Figure PCTCN2017106341-appb-000006
Figure PCTCN2017106341-appb-000006
对无人机的俯仰角调整的角速度控制区间,以及姿态调整角速率与姿态角偏差值的对应关系为:The angular velocity control interval for the pitch angle adjustment of the drone, and the corresponding relationship between the attitude adjustment angular velocity and the attitude angle deviation value are:
Figure PCTCN2017106341-appb-000007
Figure PCTCN2017106341-appb-000007
由上可知,直线函数的斜率为kp,即为设计的比例控制参数,kp>0,kp越大,直线越抖,其物理意义为姿态调整角速率(纵坐标)的响应也越快,但过快了随之会带来较大的超调量。当达到与反抛物的交点时,切换至反抛物线控制方式,平缓地达到期望的姿态调整角速率,而不会有超调量。It can be seen from the above that the slope of the linear function is kp, which is the proportional control parameter of the design. kp>0, the larger the kp, the more the line flutters, and the physical meaning is that the response of the attitude adjustment angular rate (ordinate) is faster, but Too fast will lead to a large overshoot. When the intersection with the anti-parabola is reached, the mode is switched to the anti-parabolic control mode, and the desired attitude adjustment angular rate is smoothly achieved without overshoot.
上述实施例提供的无人机姿态控制方法,将姿态角偏差的调整区间划分为多个角速度控制区间,在调整中根据与角速度控制区间相对应的对应关系对姿态调整角速率进行控制,可以在姿态调整初期使用快速比例控制,使用较大的比例参数,加快响应速度,快速消除误差,在姿态调整后期采用反抛物线控制算法,能够限制调整中的角加速度,可以减小超调量,得到期望的姿态角速率。The UAV attitude control method provided by the above embodiment divides the adjustment interval of the attitude angle deviation into a plurality of angular velocity control intervals, and controls the attitude adjustment angular rate according to the correspondence relationship corresponding to the angular velocity control interval during the adjustment, which may be In the initial stage of attitude adjustment, fast proportional control is used, which uses large proportional parameters to speed up the response and quickly eliminate the error. In the later stage of attitude adjustment, the anti-parabolic control algorithm can be used to limit the angular acceleration during adjustment, which can reduce the overshoot and obtain the expectation. The angular rate of the gesture.
在一个实施例中,如图3所示,本公开提供一种无人机姿态控制装置30,包括:调整数据获取模块31、姿态数据获取模块32、控制参数设定模块33和姿态角度控制模块34等。调整数据获取模块31获取无人机需要调整的目标姿态角度。姿态数据获取模块32获取无人机当前的实际姿态角度。In one embodiment, as shown in FIG. 3, the present disclosure provides a UAV attitude control device 30, including: an adjustment data acquisition module 31, an attitude data acquisition module 32, a control parameter setting module 33, and a posture angle control module. 34 and so on. The adjustment data acquisition module 31 acquires a target attitude angle that the drone needs to adjust. The attitude data acquisition module 32 acquires the current actual attitude angle of the drone.
控制参数设定模块33根据目标姿态角度与实际姿态角度确定需要调整的姿态角偏差,将姿态角偏差的调整区间划分为N个角速度控制区间,并确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系,其中,N大于等于2。姿态角度控制模块34将无人机的姿态角度调整到目标姿态角度,其中,在调整中根据与N个角速度控制区间相对应的对应关系对姿态调整角速率进行控制。对应关系包括:比例函数关系、反抛物线函数关系等。目标姿态角度与实际姿态角度为俯仰角度、偏航角度、滚转角度中的一个或多个。The control parameter setting module 33 determines the attitude angle deviation that needs to be adjusted according to the target attitude angle and the actual posture angle, divides the adjustment interval of the attitude angle deviation into N angular velocity control intervals, and determines the posture adjustment angle in each angular velocity control interval. Correspondence between the rate and the attitude angle deviation value, where N is greater than or equal to 2. The attitude angle control module 34 adjusts the attitude angle of the drone to the target attitude angle, wherein the attitude adjustment angular rate is controlled according to the correspondence relationship corresponding to the N angular velocity control sections in the adjustment. Correspondence relationships include: proportional function relationships, inverse parabolic function relationships, and so on. The target attitude angle and the actual attitude angle are one or more of a pitch angle, a yaw angle, and a roll angle.
如图4所示,控制参数设定模块33包括:区间划分单元331和控制函数确定单元332。区间划分单元331将姿态角偏差的数值区间划分为连续的第一角速度控制区间和第二角速度控制区间,其中,第一角速度控制区间中的姿态角偏差值的绝对值小于第二角速度控制 区间中的姿态角偏差值的绝对值。控制函数确定单元332在第一角速度控制区间中,确定姿态调整角速率与姿态角偏差值为比例函数关系。在第二角速度控制区间中,确定姿态调整角速率与姿态角偏差值为反抛物线函数关系。As shown in FIG. 4, the control parameter setting module 33 includes an interval dividing unit 331 and a control function determining unit 332. The section dividing unit 331 divides the numerical interval of the attitude angle deviation into a continuous first angular velocity control interval and a second angular velocity control interval, wherein the absolute value of the posture angular deviation value in the first angular velocity control interval is smaller than the second angular velocity control The absolute value of the attitude angle deviation value in the interval. The control function determining unit 332 determines, in the first angular velocity control section, a proportional function relationship between the attitude adjustment angular rate and the attitude angle deviation value. In the second angular velocity control interval, it is determined that the attitude adjustment angular rate and the attitude angle deviation value are inverse parabolic function relationships.
控制函数确定单元332确定比例函数关系为:The control function determining unit 332 determines the proportional function relationship as:
Ratedes=kp·AtterrorRate des = k p · Att error ;
Ratedes为姿态调整角速率,kp为比例控制参数,kp>0,Atterror为姿态角偏差值。Rate des is the attitude adjustment angular rate, k p is the proportional control parameter, k p >0, and Att error is the attitude angle deviation value.
控制函数确定单元332确定反抛物线函数关系为:The control function determining unit 332 determines that the inverse parabolic function relationship is:
Figure PCTCN2017106341-appb-000008
Figure PCTCN2017106341-appb-000008
其中,a为旋转加速度的最大阈值。Where a is the maximum threshold of the rotational acceleration.
控制函数确定332单元确定区间界限值为:The control function determines 332 the unit to determine the interval limit value:
Figure PCTCN2017106341-appb-000009
Figure PCTCN2017106341-appb-000009
如图5所示,姿态角度控制模块34包括:第一调整单元341和第二调整单元342。第一调整单元341在第一角速度控制区间中,基于姿态角偏差值、并根据比例函数关系对姿态调整角速率进行控制。第二调整单元342通过姿态数据获取模块实时获取姿态角偏差值,当确定姿态角偏差值增大至第一角速度控制区间与第二角速度控制区间的区间界限值时,基于姿态角偏差值、并切换为反抛物线函数关系对姿态调整角速率进行控制。As shown in FIG. 5, the attitude angle control module 34 includes a first adjustment unit 341 and a second adjustment unit 342. The first adjustment unit 341 controls the attitude adjustment angular rate based on the attitude angle deviation value and based on the proportional function relationship in the first angular velocity control section. The second adjusting unit 342 acquires the attitude angle deviation value in real time through the attitude data acquiring module, and when determining that the posture angle deviation value is increased to the interval threshold value of the first angular velocity control interval and the second angular velocity control interval, based on the attitude angle deviation value, and Switching to an anti-parabolic function relationship controls the attitude adjustment angular rate.
在一个实施例中,本公开提供一种无人机,包括:如上的无人机姿态控制装置。In one embodiment, the present disclosure provides a drone comprising: the drone attitude control device as above.
图6为根据本公开的无人机姿态控制装置的另一个实施例的模块示意图。如图6所示,该装置可包括存储器61、处理器62、通信接口63以及总线64。存储器61用于存储指令,处理器62耦合到存储器61,处理器62被配置为基于存储器61存储的指令执行实现上述的无人机姿态控制方法。6 is a block diagram of another embodiment of a drone attitude control device in accordance with the present disclosure. As shown in FIG. 6, the apparatus can include a memory 61, a processor 62, a communication interface 63, and a bus 64. The memory 61 is for storing instructions, the processor 62 is coupled to the memory 61, and the processor 62 is configured to perform the above-described drone attitude control method based on the instructions stored by the memory 61.
存储器61可以为高速RAM存储器、非易失性存储器(non-volatile memory)等,存储器61也可以是存储器阵列。存储器61还可能被分块,并且块可按一定的规则组合成虚拟卷。处理器62可以为中央处理器CPU,或专用集成电路ASIC(Application Specific Integrated Circuit),或者是被配置成实施本公开的无人机姿态控制方法的一个或多个集成电路。 The memory 61 may be a high speed RAM memory, a non-volatile memory, or the like, and the memory 61 may be a memory array. The memory 61 may also be partitioned, and the blocks may be combined into a virtual volume according to certain rules. The processor 62 may be a central processing unit CPU, or an application specific integrated circuit (ASIC), or one or more integrated circuits configured to implement the drone attitude control method of the present disclosure.
在上面所描述的功能单元模块可以实现为用于执行本公开所描述功能的通用处理器、可编程逻辑控制器(Programmable Logic Controller,简称:PLC)、数字信号处理器(Digital Signal Processor,简称:DSP)、专用集成电路(Application Specific Integrated Circuit,简称:ASIC)、现场可编程门阵列(Field-Programmable Gate Array,简称:FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件或者其任意适当组合。The functional unit modules described above may be implemented as a general purpose processor, a Programmable Logic Controller (PLC), and a Digital Signal Processor (Digital Signal Processor) for performing the functions described in the present disclosure. DSP), Application Specific Integrated Circuit (ASIC), Field-Programmable Gate Array (FPGA) or other programmable logic device, discrete gate or transistor logic device, discrete hardware component Or any suitable combination thereof.
上述实施例提供的无人机姿态控制方法、装置及无人机,将姿态角偏差的调整区间划分为多个角速度控制区间,在调整中根据与角速度控制区间相对应的对应关系对姿态调整角速率进行控制,可以在姿态调整初期使用快速比例控制,使用较大的比例参数,加快响应速度,快速消除误差,在姿态调整后期采用反抛物线控制算法,能够限制调整中的角加速度,可以减小超调量,得到期望的姿态角速率,能够提高无人机姿态调整以及飞行的稳定性,提高飞行的安全系数,能够提高用户体验。The unmanned aerial vehicle attitude control method and device and the unmanned aerial vehicle provided by the above embodiments divide the adjustment interval of the attitude angle deviation into a plurality of angular velocity control intervals, and adjust the attitude according to the correspondence relationship corresponding to the angular velocity control interval during the adjustment. Rate control, which can use fast proportional control at the initial stage of attitude adjustment, use larger proportional parameters, speed up response, and quickly eliminate errors. In the later stage of attitude adjustment, the anti-parabolic control algorithm can limit the angular acceleration during adjustment and can reduce The overshoot amount and the desired attitude angular rate can improve the attitude adjustment of the drone and the stability of the flight, improve the flight safety factor, and improve the user experience.
在一个实施例中,本公开还提供一种计算机可读存储介质,其中计算机可读存储介质存储有计算机指令,指令被处理器执行时实现如上任一实施例涉及的无人机姿态控制方法。本领域内的技术人员应明白,本公开的实施例可提供为方法、装置、或计算机程序产品。因此,本公开可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本公开可采用在一个或多个其中包含有计算机可用程序代码的计算机可用非瞬时性存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。In one embodiment, the present disclosure further provides a computer readable storage medium, wherein the computer readable storage medium stores computer instructions that, when executed by the processor, implement the drone attitude control method of any of the above embodiments. Those skilled in the art will appreciate that embodiments of the present disclosure may be provided as a method, apparatus, or computer program product. Accordingly, the present disclosure may take the form of an entirely hardware embodiment, an entirely software embodiment, or a combination of software and hardware aspects. Moreover, the present disclosure may take the form of a computer program product embodied on one or more computer-usable non-transitory storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer usable program code. .
本公开是参照根据本公开实施例的方法、设备(系统)和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。The present disclosure is described with reference to flowchart illustrations and/or block diagrams of methods, apparatus, and computer program products according to embodiments of the present disclosure. It will be understood that each flow and/or block of the flowchart illustrations and/or FIG. These computer program instructions can be provided to a processor of a general purpose computer, special purpose computer, embedded processor, or other programmable data processing device to produce a machine for the execution of instructions for execution by a processor of a computer or other programmable data processing device. Means for implementing the functions specified in one or more of the flow or in a block or blocks of the flow chart.
至此,已经详细描述了本公开。为了避免遮蔽本公开的构思,没有描述本领域所公知的一些细节。本领域技术人员根据上面的描述,完全可以明白如何实施这里公开的技术方案。The present disclosure has been described in detail so far. In order to avoid obscuring the concepts of the present disclosure, some details known in the art are not described. Those skilled in the art can fully understand how to implement the technical solutions disclosed herein according to the above description.
可能以许多方式来实现本公开的方法和系统。例如,可通过软件、硬件、固件或 者软件、硬件、固件的任何组合来实现本公开的方法和系统。用于方法的步骤的上述顺序仅是为了进行说明,本公开的方法的步骤不限于以上具体描述的顺序,除非以其它方式特别说明。此外,在一些实施例中,还可将本公开实施为记录在记录介质中的程序,这些程序包括用于实现根据本公开的方法的机器可读指令。因而,本公开还覆盖存储用于执行根据本公开的方法的程序的记录介质。The methods and systems of the present disclosure may be implemented in a number of ways. For example, via software, hardware, firmware or Any combination of software, hardware, firmware, to implement the methods and systems of the present disclosure. The above-described sequence of steps for the method is for illustrative purposes only, and the steps of the method of the present disclosure are not limited to the order specifically described above unless otherwise specifically stated. Moreover, in some embodiments, the present disclosure may also be embodied as programs recorded in a recording medium, the programs including machine readable instructions for implementing a method in accordance with the present disclosure. Thus, the present disclosure also covers a recording medium storing a program for executing the method according to the present disclosure.
本公开的描述是为了示例和描述起见而给出的,而并不是无遗漏的或者将本公开限于所公开的形式。很多修改和变化对于本领域的普通技术人员而言是显然的。选择和描述实施例是为了更好说明本公开的原理和实际应用,并且使本领域的普通技术人员能够理解本公开从而设计适于特定用途的带有各种修改的各种实施例。 The description of the present disclosure has been presented for purposes of illustration and description. Many modifications and variations will be apparent to those skilled in the art. The embodiment was chosen and described in order to best explain the principles and embodiments of the embodiments of the invention

Claims (17)

  1. 一种无人机姿态控制方法,包括:A UAV attitude control method includes:
    根据无人机需要调整的目标姿态角度,以及无人机当前的实际姿态角度确定需要调整的姿态角偏差;Determining the attitude angle deviation that needs to be adjusted according to the target attitude angle that the drone needs to adjust, and the current actual attitude angle of the drone;
    将所述姿态角偏差的调整区间划分为N个角速度控制区间,并确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系;其中,所述N大于等于2;Dividing the adjustment interval of the attitude angle deviation into N angular velocity control intervals, and determining a correspondence relationship between the attitude adjustment angular rate and the attitude angle deviation value in each angular velocity control interval; wherein, the N is greater than or equal to 2;
    将无人机的姿态角度调整到所述目标姿态角度,其中,在调整中根据与所述N个角速度控制区间相对应的对应关系对所述姿态调整角速率进行控制。Adjusting the attitude angle of the drone to the target attitude angle, wherein the attitude adjustment angular rate is controlled according to a correspondence relationship corresponding to the N angular velocity control sections in the adjustment.
  2. 如权利要求1所述的方法,其中,The method of claim 1 wherein
    所述对应关系包括:比例函数关系、反抛物线函数关系。The corresponding relationship includes: a proportional function relationship and an inverse parabolic function relationship.
  3. 如权利要求2所述的方法,所述将所述姿态角偏差的调整区间划分为N个角速度控制区间包括:The method of claim 2, wherein the dividing the adjustment interval of the attitude angle deviation into N angular velocity control intervals comprises:
    将所述姿态角偏差的数值区间划分为连续的第一角速度控制区间和第二角速度控制区间,其中,所述第一角速度控制区间中的姿态角偏差值的绝对值小于所述第二角速度控制区间中的姿态角偏差值的绝对值;Dividing the numerical interval of the attitude angle deviation into a continuous first angular velocity control interval and a second angular velocity control interval, wherein an absolute value of the attitude angular deviation value in the first angular velocity control interval is smaller than the second angular velocity control The absolute value of the attitude angle deviation value in the interval;
    所述确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系包括:The determining the correspondence between the attitude adjustment angular rate and the attitude angle deviation value in each angular velocity control interval includes:
    在所述第一角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为比例函数关系;Determining, in the first angular velocity control interval, a proportional function relationship between the attitude adjustment angular rate and the attitude angle deviation value;
    在所述第二角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为反抛物线函数关系。In the second angular velocity control interval, it is determined that the attitude adjustment angular rate and the attitude angular deviation value are inverse parabolic function relationships.
  4. 如权利要求3所述的方法,所述在调整中根据与所述N个角速度控制区间相对应的对应关系对所述姿态调整角速率进行控制包括:The method of claim 3, wherein controlling the attitude adjustment angular rate according to a correspondence corresponding to the N angular velocity control intervals in the adjusting comprises:
    在所述第一角速度控制区间中,基于所述姿态角偏差值、并根据所述比例函数关系对所述姿态调整角速率进行控制;In the first angular velocity control interval, controlling the attitude adjustment angular rate based on the attitude angle deviation value and according to the proportional function relationship;
    实时获取所述姿态角偏差值,当确定所述姿态角偏差值增大至所述第一角速度控制区间与所述第二角速度控制区间的区间界限值时,基于所述姿态角偏差值、并切换为所述反抛物线函数关系对所述姿态调整角速率进行控制。Obtaining the attitude angle deviation value in real time, and when determining that the posture angle deviation value is increased to a section boundary value of the first angular velocity control interval and the second angular velocity control interval, based on the posture angle deviation value, and Switching to the inverse parabolic function relationship controls the attitude adjustment angular rate.
  5. 如权利要求3所述的方法,其中, The method of claim 3, wherein
    确定所述比例函数关系Determining the proportional function relationship
    Ratedes=kp·AtterrorRate des = k p · Att error ;
    其中,Ratedes为所述姿态调整角速率,kp为比例控制参数,kp>0,Atterror为所述姿态角偏差值;Where, Rate des is the angular rate of the attitude adjustment, k p is a proportional control parameter, k p >0, and Att error is the attitude angle deviation value;
    确定所述反抛物线函数关系Determining the inverse parabolic function relationship
    Figure PCTCN2017106341-appb-100001
    Figure PCTCN2017106341-appb-100001
    其中,a为旋转加速度的最大阈值。Where a is the maximum threshold of the rotational acceleration.
  6. 如权利要求5所述的方法,其中,The method of claim 5, wherein
    确定所述区间界限值Determining the interval threshold
    Figure PCTCN2017106341-appb-100002
    Figure PCTCN2017106341-appb-100002
  7. 如权利要求1所述的方法,其中,The method of claim 1 wherein
    所述目标姿态角度与所述实际姿态角度为俯仰角度、偏航角度、滚转角度中的一个或多个。The target attitude angle and the actual posture angle are one or more of a pitch angle, a yaw angle, and a roll angle.
  8. 一种无人机姿态控制装置,包括:A UAV attitude control device includes:
    调整数据获取模块,用于获取无人机需要调整的目标姿态角度;Adjusting a data acquisition module for acquiring a target attitude angle that the drone needs to adjust;
    姿态数据获取模块,用于获取无人机当前的实际姿态角度;An attitude data acquisition module, configured to acquire a current actual attitude angle of the drone;
    控制参数设定模块,用于根据所述目标姿态角度与所述实际姿态角度确定需要调整的姿态角偏差,将所述姿态角偏差的调整区间划分为N个角速度控制区间,并确定在每个角速度控制区间中的姿态调整角速率与姿态角偏差值的对应关系;其中,所述N大于等于2;a control parameter setting module, configured to determine an attitude angle deviation that needs to be adjusted according to the target attitude angle and the actual posture angle, and divide the adjustment interval of the attitude angle deviation into N angular speed control intervals, and determine each Corresponding relationship between the attitude adjustment angular rate and the attitude angle deviation value in the angular velocity control interval; wherein, the N is greater than or equal to 2;
    姿态角度控制模块,用于将无人机的姿态角度调整到所述目标姿态角度,其中,在调整中根据与所述N个角速度控制区间相对应的对应关系对所述姿态调整角速率进行控制。An attitude angle control module, configured to adjust an attitude angle of the drone to the target attitude angle, wherein the posture adjustment angular rate is controlled according to a correspondence relationship corresponding to the N angular velocity control intervals in the adjustment .
  9. 如权利要求8所述的装置,其中,The device of claim 8 wherein
    所述对应关系包括:比例函数关系、反抛物线函数关系。The corresponding relationship includes: a proportional function relationship and an inverse parabolic function relationship.
  10. 如权利要求9所述的装置,其中,所述控制参数设定模块,包括:The device of claim 9, wherein the control parameter setting module comprises:
    区间划分单元,用于将所述姿态角偏差的数值区间划分为连续的第一角速度控制区间和第二角速度控制区间,其中,所述第一角速度控制区间中的姿态角偏差值的绝对值小于 所述第二角速度控制区间中的姿态角偏差值的绝对值;a section dividing unit, configured to divide the numerical interval of the attitude angle deviation into a continuous first angular velocity control interval and a second angular velocity control interval, wherein an absolute value of the posture angular deviation value in the first angular velocity control interval is smaller than An absolute value of the attitude angle deviation value in the second angular velocity control interval;
    控制函数确定单元,用于在所述第一角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为比例函数关系;在所述第二角速度控制区间中,确定所述姿态调整角速率与所述姿态角偏差值为反抛物线函数关系。a control function determining unit, configured to determine, in the first angular velocity control interval, a proportional function relationship between the attitude adjustment angular rate and the attitude angle deviation value; and in the second angular velocity control interval, determining the posture The adjustment angular rate and the attitude angle deviation value are inverse parabolic function relationships.
  11. 如权利要求10所述的装置,其中,所述姿态角度控制模块,包括:The apparatus of claim 10, wherein the attitude angle control module comprises:
    第一调整单元,用于在所述第一角速度控制区间中,基于所述姿态角偏差值、并根据所述比例函数关系对所述姿态调整角速率进行控制;a first adjusting unit, configured to control, according to the attitude angle deviation value, the attitude adjustment angular rate according to the attitude function relationship in the first angular velocity control interval;
    第二调整单元,用于通过所述姿态数据获取模块实时获取所述姿态角偏差值,当确定所述姿态角偏差值增大至所述第一角速度控制区间与所述第二角速度控制区间的区间界限值时,基于所述姿态角偏差值、并切换为所述反抛物线函数关系对所述姿态调整角速率进行控制。a second adjusting unit, configured to acquire the attitude angle deviation value in real time by using the posture data acquiring module, and determine that the posture angle deviation value is increased to the first angular speed control interval and the second angular speed control interval In the interval limit value, the attitude adjustment angular rate is controlled based on the attitude angle deviation value and switching to the inverse parabolic function relationship.
  12. 如权利要求10所述的装置,其特征在于,The device of claim 10 wherein:
    所述控制函数确定单元确定所述比例函数关系The control function determining unit determines the proportional function relationship
    Ratedes=kp·AtterrorRate des = k p · Att error ;
    其中,Ratedes为所述姿态调整角速率,kp为比例控制参数,kp>0,Atterror为所述姿态角偏差值;Where, Rate des is the angular rate of the attitude adjustment, k p is a proportional control parameter, k p >0, and Att error is the attitude angle deviation value;
    所述控制函数确定单元确定所述反抛物线函数关系The control function determining unit determines the inverse parabolic function relationship
    Figure PCTCN2017106341-appb-100003
    Figure PCTCN2017106341-appb-100003
    其中,a为旋转加速度的最大阈值。Where a is the maximum threshold of the rotational acceleration.
  13. 如权利要求12所述的装置,其特征在于,The device of claim 12 wherein:
    所述控制函数确定单元确定所述区间界限值The control function determining unit determines the interval threshold value
    Figure PCTCN2017106341-appb-100004
    Figure PCTCN2017106341-appb-100004
  14. 如权利要求8至13任一项所述的装置,其特征在于,Apparatus according to any one of claims 8 to 13 wherein:
    所述目标姿态角度与所述实际姿态角度为俯仰角度、偏航角度、滚转角度中的一个或多个。The target attitude angle and the actual posture angle are one or more of a pitch angle, a yaw angle, and a roll angle.
  15. 一种无人机,其特征在于,包括: A drone, characterized in that it comprises:
    如权利要求8至14任一项所述的无人机姿态控制装置。The UAV attitude control device according to any one of claims 8 to 14.
  16. 一种无人机姿态控制装置,其特征在于,包括:A UAV attitude control device, comprising:
    存储器;以及耦接至所述存储器的处理器,所述处理器被配置为基于存储在所述存储器中的指令,执行如权利要求1至7中任一项所述的无人机姿态控制方法。a processor coupled to the memory, the processor configured to perform the drone attitude control method according to any one of claims 1 to 7 based on an instruction stored in the memory .
  17. 一种计算机可读存储介质,其上存储有计算机程序指令,该指令被一个或多个处理器执行时实现权利要求1至7任意一项所述的方法的步骤。 A computer readable storage medium having stored thereon computer program instructions which, when executed by one or more processors, implement the steps of the method of any one of claims 1 to 7.
PCT/CN2017/106341 2016-12-01 2017-10-16 Control method and device for attitude of unmanned aerial vehicle, and unmanned aerial vehicle WO2018099198A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201611088682.1A CN106843245B (en) 2016-12-01 2016-12-01 Unmanned aerial vehicle attitude control method and device and unmanned aerial vehicle
CN201611088682.1 2016-12-01

Publications (1)

Publication Number Publication Date
WO2018099198A1 true WO2018099198A1 (en) 2018-06-07

Family

ID=59145560

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2017/106341 WO2018099198A1 (en) 2016-12-01 2017-10-16 Control method and device for attitude of unmanned aerial vehicle, and unmanned aerial vehicle

Country Status (2)

Country Link
CN (1) CN106843245B (en)
WO (1) WO2018099198A1 (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111813140A (en) * 2020-07-31 2020-10-23 中国人民解放军空军工程大学 High-precision trajectory tracking control method for quad-rotor unmanned aerial vehicle
CN112034875A (en) * 2020-09-15 2020-12-04 西安爱生技术集团公司 Full-automatic liftoff take-off control method for general unmanned aerial vehicle with conventional layout
CN112306078A (en) * 2020-11-16 2021-02-02 广东电网有限责任公司肇庆供电局 Method and system for unmanned aerial vehicle to automatically avoid obstacle conducting wire
CN113110552A (en) * 2021-04-27 2021-07-13 北京三快在线科技有限公司 Attitude control method, device and equipment for aircraft and readable storage medium
CN114265422A (en) * 2021-12-17 2022-04-01 广州极飞科技股份有限公司 Radar detection angle control method and device, electronic equipment and readable storage medium
CN114610059A (en) * 2022-03-03 2022-06-10 广东汇天航空航天科技有限公司 Yaw control method and device, rotorcraft and storage medium
CN114740945A (en) * 2021-07-09 2022-07-12 百倍云(浙江)物联科技有限公司 Intelligent crop planting method
CN112034875B (en) * 2020-09-15 2024-04-19 西安爱生技术集团公司 Full-automatic ground-leaving take-off control method for general unmanned aerial vehicle with conventional layout

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106843245B (en) * 2016-12-01 2022-02-01 北京京东乾石科技有限公司 Unmanned aerial vehicle attitude control method and device and unmanned aerial vehicle
CN107894776A (en) * 2017-11-09 2018-04-10 酷黑科技(北京)有限公司 A kind of unmanned plane augmentation control method, apparatus and unmanned plane
CN108700887A (en) * 2017-11-15 2018-10-23 深圳市大疆创新科技有限公司 Data processing method and equipment
CN110531775A (en) * 2018-05-24 2019-12-03 深圳臻迪信息技术有限公司 A kind of unmanned apparatus control method, unmanned device navigation control method and its detection system
CN110727283A (en) * 2019-09-23 2020-01-24 浙江驭云航空科技有限公司 Combined type unmanned aerial vehicle flight attitude control device and control method thereof
CN110673619B (en) * 2019-10-21 2022-06-17 深圳市道通智能航空技术股份有限公司 Flight attitude control method and device, unmanned aerial vehicle and storage medium
CN111026147B (en) * 2019-12-25 2021-01-08 北京航空航天大学 Zero overshoot unmanned aerial vehicle position control method and device based on deep reinforcement learning
CN111650955B (en) * 2020-06-19 2023-07-25 深圳市人工智能与机器人研究院 Control method of climbing robot and climbing robot
CN112015195A (en) * 2020-09-07 2020-12-01 中国航空工业集团公司成都飞机设计研究所 Real-time continuous control method for preventing ground hand from separating from rod in flight attitude of unmanned aerial vehicle

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000122722A (en) * 1998-10-19 2000-04-28 Sumitomo Heavy Ind Ltd Steering angle controller for mobile object
CN101232979A (en) * 2005-08-01 2008-07-30 丰田自动车株式会社 Attitude angle detection device for motion object
CN102192741A (en) * 2010-01-29 2011-09-21 尤洛考普特公司 Stabilised estimation of the pitch angles of an aircraft
CN106843245A (en) * 2016-12-01 2017-06-13 北京京东尚科信息技术有限公司 A kind of UAV Attitude control method, device and unmanned plane

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE112010001794B4 (en) * 2009-04-28 2019-09-05 Mitsubishi Electric Corporation COMMAND GENERATOR
CN104062976B (en) * 2014-06-10 2016-08-24 北京控制工程研究所 A kind of is sinusoidal attitude of flight vehicle fast reserve method based on angular acceleration derivative
JP6026695B1 (en) * 2016-06-14 2016-11-16 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd Control device, moving body, control method, and program
CN106054908A (en) * 2016-06-17 2016-10-26 上海惠盛科技有限公司 Unmanned aerial vehicle (UAV) attitude adjusting device and method

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000122722A (en) * 1998-10-19 2000-04-28 Sumitomo Heavy Ind Ltd Steering angle controller for mobile object
CN101232979A (en) * 2005-08-01 2008-07-30 丰田自动车株式会社 Attitude angle detection device for motion object
CN102192741A (en) * 2010-01-29 2011-09-21 尤洛考普特公司 Stabilised estimation of the pitch angles of an aircraft
CN106843245A (en) * 2016-12-01 2017-06-13 北京京东尚科信息技术有限公司 A kind of UAV Attitude control method, device and unmanned plane

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111813140A (en) * 2020-07-31 2020-10-23 中国人民解放军空军工程大学 High-precision trajectory tracking control method for quad-rotor unmanned aerial vehicle
CN112034875A (en) * 2020-09-15 2020-12-04 西安爱生技术集团公司 Full-automatic liftoff take-off control method for general unmanned aerial vehicle with conventional layout
CN112034875B (en) * 2020-09-15 2024-04-19 西安爱生技术集团公司 Full-automatic ground-leaving take-off control method for general unmanned aerial vehicle with conventional layout
CN112306078A (en) * 2020-11-16 2021-02-02 广东电网有限责任公司肇庆供电局 Method and system for unmanned aerial vehicle to automatically avoid obstacle conducting wire
CN112306078B (en) * 2020-11-16 2024-01-23 广东电网有限责任公司肇庆供电局 Method and system for automatically avoiding obstacle wires of unmanned aerial vehicle
CN113110552B (en) * 2021-04-27 2023-01-06 北京三快在线科技有限公司 Attitude control method, device and equipment for aircraft and readable storage medium
CN113110552A (en) * 2021-04-27 2021-07-13 北京三快在线科技有限公司 Attitude control method, device and equipment for aircraft and readable storage medium
CN114740945A (en) * 2021-07-09 2022-07-12 百倍云(浙江)物联科技有限公司 Intelligent crop planting method
CN114740945B (en) * 2021-07-09 2023-03-10 百倍云(浙江)物联科技有限公司 Intelligent crop planting method
CN114265422B (en) * 2021-12-17 2024-04-12 广州极飞科技股份有限公司 Radar detection angle control method and device, electronic equipment and readable storage medium
CN114265422A (en) * 2021-12-17 2022-04-01 广州极飞科技股份有限公司 Radar detection angle control method and device, electronic equipment and readable storage medium
CN114610059B (en) * 2022-03-03 2023-06-02 广东汇天航空航天科技有限公司 Yaw control method and device, rotary wing aircraft and storage medium
CN114610059A (en) * 2022-03-03 2022-06-10 广东汇天航空航天科技有限公司 Yaw control method and device, rotorcraft and storage medium

Also Published As

Publication number Publication date
CN106843245B (en) 2022-02-01
CN106843245A (en) 2017-06-13

Similar Documents

Publication Publication Date Title
WO2018099198A1 (en) Control method and device for attitude of unmanned aerial vehicle, and unmanned aerial vehicle
CN108919835B (en) Control method and device for formation of unmanned aerial vehicles and controller
Herissé et al. Landing a VTOL unmanned aerial vehicle on a moving platform using optical flow
CN110001980B (en) Aircraft landing method and device
Leong et al. Low-cost microcontroller-based hover control design of a quadcopter
EP2960155A2 (en) A method for controlling a path of a rotary-wing drone, a corresponding system, a rotary-wing drone implementing this system and the related uses of such a drone
CN107065901A (en) A kind of rotor wing unmanned aerial vehicle attitude control method, device and unmanned plane
US20190031341A1 (en) UNIVERSAL CONTROLLER FOR ROBUST TRAJECTORY TRACKING IN MULTIROTOR UNMANNED AERIAL VEHICLES (UAVs)
WO2017181513A1 (en) Flight control method and device for unmanned aerial vehicle
CN106843275B (en) Fixed-point flying method, device and system for unmanned aerial vehicle
CN108829123A (en) A kind of quadrotor control method, system and device
CN113110563A (en) Redundancy arbitration switching method and system for unmanned aerial vehicle and computer equipment
CN110254696B (en) Unmanned aerial vehicle mode switching control method and device, storage medium and electronic equipment
CN108803648A (en) Unmanned vehicle robust attitude control method, device and electronic equipment
CN108089597B (en) Method and device for controlling unmanned aerial vehicle based on ground station
CN109062242B (en) Novel rotor unmanned aerial vehicle control method
CN110673619B (en) Flight attitude control method and device, unmanned aerial vehicle and storage medium
CN106647264A (en) Unmanned aerial vehicle control method based on control constraint extended robust H<infinite>
CN115562315A (en) Underwater robot self-adaptive control method and device based on double closed-loop control, computer equipment and storage medium
CN106292297B (en) Attitude control method based on PID controller and L1 adaptive controller
CN108107902B (en) Lateral heading attitude control method and related device
Meola et al. Flight control system for small-size unmanned aerial vehicles: Design and software-in-the-loop validation
WO2019210639A1 (en) Throttle control method and apparatus, and unmanned aerial vehicle
CN116301058B (en) Unmanned flight feedback nonlinear yaw control method, system and equipment
Benzaid et al. Robust trajectory tracking control of a quadrotor UAV

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17876942

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 12/09/2019)

122 Ep: pct application non-entry in european phase

Ref document number: 17876942

Country of ref document: EP

Kind code of ref document: A1