Nonlinear attitude and position control of quad-rotor based on inverse dynamic and and state dependent nonlinear optimal control methods
Nonlinear attitude and position control of quad-rotor based on inverse dynamic and and state dependent nonlinear optimal control methods
mahdi mortazavi1 shahab ghorbani2 amir poorhaji3
1) Iran, Tehran, Amirkabir university of technology,
2) Iran, Tehran, Amirkabir university of technology,
3) Iran, Tehran, sharif university of technology,
IOI Code
:
XYCZ-AAKAE
Publication :
International Conference on Engineering and Applied Science(iceasconf.com)
Abstract :
Quad-rotor is a well-known nonlinear system that among VTOL aerial vehicles attract a large number of researchers in the last decade. Vertical takeoff and landing characteristics and high maneuverability of this vehicle is the reasons that they have attracted the attention of researchers. A quad-rotor has a non-linear multi-input multi-output dynamic and it is inherently unstable; therefore, nonlinear controllers are required to control it. In this paper, after designing the six-degree of freedom nonlinear modeling, the overall structure of Auto-pilot software is designed. Double loop autopilot software is designed for quad-rotor where the inner loop controls the attitude of quad-rotor and the outer loop controls its position and velocity. Designed attitude control loop has two loops: the outer loop outputs the desired angular velocity by getting feedback from the quad-rotor attitude and comparing it with the desirable value. The Output of this loop is the input of the inner control loop. Controlling terms of the attitude are calculated by comparing this input with quad-rotor angular velocity. Inner and outer loops of attitude control are based on inverse dynamic and nonlinear optimal control method respectively. In the presence of parametric uncertainties and environmental disturbances, this structure enhances system stability and its resistance.
Speed and position control of the quad-rotor is also by using inverse dynamics method. It produces desired quaternion components based on a given path for attitude control loop and required thrust to maintain desired altitude.
Simulations in different scenarios and flight environments illustrate effectiveness of the designed algorithms.
Keywords : nonlinear six degree of freedom modeling of quad rotor attitude and position control of quad rotor inverse dynamic control state dependent nonlinear optimal control