Constrained nonlinear control allocation with singularity avoidance using sequential quadratic programming

Control allocation problems can be formulated as optimization problems, where the objective is typically to minimize the use of control effort (or power) subject to actuator rate and position constraints, and other operational constraints. Here we consider the additional objective of singularity avoidance, which is essential to avoid loss of controllability in some applications, leading to a nonconvex nonlinear program. We suggest a sequential quadratic programming approach, solving at each sample a convex quadratic program approximating the nonlinear program. The method is illustrated by simulated maneuvers for a marine vessel equipped with azimuth thrusters. The example indicates reduced power consumption and increased maneuverability as a consequence of the singularity-avoidance.

[1]  Wayne C. Durham,et al.  Null-space augmented solutions to constrained control allocation problems , 1995 .

[2]  Yoram Koren,et al.  Real-time obstacle avoidance for fast mobile robots in cluttered environments , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[3]  W. B. Jackson,et al.  Constrained optimization based control of real time large-scale systems: airjet object movement system , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

[4]  Thor I. Fossen,et al.  Robust Control Allocation of Overactuated Ships; Experiments with a Model Ship , 1997 .

[5]  D K Smith,et al.  Numerical Optimization , 2001, J. Oper. Res. Soc..

[6]  Marc Bodson,et al.  Fast Implementation of Direct Allocation with Extension to Coplanar Controls , 2002 .

[7]  S. R. Vadali,et al.  Suboptimal command generation for control moment gyroscopes and feedback control of spacecraft , 1994 .

[8]  Thor I. Fossen,et al.  Marine Control Systems Guidance, Navigation, and Control of Ships, Rigs and Underwater Vehicles , 2002 .

[9]  Donald Goldfarb,et al.  A numerically stable dual method for solving strictly convex quadratic programs , 1983, Math. Program..

[10]  D. Cornick.  Singularity avoidance control laws for single gimbal control moment gyros , 1979 .

[11]  João Borges de Sousa,et al.  Optimum Allocation For Multiple Thrusters , 1999 .

[12]  Thor I. Fossen,et al.  Fuel-efficient rudder and propeller control allocation for marine craft: experiments with a model ship , 2003, IEEE Trans. Control. Syst. Technol..

[13]  Tor Arne Johansen,et al.  Optimal constrained control allocation in marine surface vessels with rudders , 2003 .

[14]  Asgeir J. Sørensen,et al.  High Performance Thrust Allocation Scheme in Positioning of Ships Based on Power and Torque Control , 1997 .

[15]  Yoram Koren,et al.  Real-time obstacle avoidance for fact mobile robots , 1989, IEEE Trans. Syst. Man Cybern..

[16]  K. Ford,et al.  Singular Direction Avoidance Steering for Control-Moment Gyros , 1998 .

[17]  Brian R. Hoelscher,et al.  Optimal open-loop and feedback control using single gimbal control moment gyroscopes , 1993 .

[18]  Wayne C. Durham.  Constrained Control Allocation , 1992 .

[19]  O. J. Sordalen,et al.  Optimal thrust allocation for marine vessels , 1997 .

[20]  Wayne C. Durham.  Efficient, Near-Optimal Control Allocation , 1999 .

[21]  Tor Arne Johansen,et al.  Reduced explicit constrained linear quadratic regulators , 2003, IEEE Trans. Autom. Control..

[22]  Marc Bodson,et al.  Evaluation of optimization methods for control allocation , 2001 .

[23]  O. Harkegard.  Efficient active set algorithms for solving constrained least squares problems in aircraft control allocation , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[24]  Wayne C. Durham.  Constrained control allocation - Three-moment problem , 1994 .

[25]  D. Enns.  CONTROL ALLOCATION APPROACHES , 1998 .

[26]  Yoshihiko Nakamura,et al.  Inverse kinematic solutions with singularity robustness for robot manipulator control , 1986 .