Structure-Preserving Constrained Optimal Trajectory Planning of a Wheeled Inverted Pendulum
Preprint
Abstract
The Wheeled Inverted Pendulum (WIP) is an underactuated, nonholonomic mechatronic system, and has been popularized commercially as the Segway. Designing a control law for motion planning, that incorporates the state and control constraints, while respecting the configuration manifold, is a challenging problem. In this article we derive a discrete-time model of the WIP system using discrete mechanics and generate optimal trajectories for the WIP system by solving a discrete-time constrained optimal control problem. Further, we describe a nonlinear continuous-time model with parameters for designing a closed loop LQ-controller. A dual control architecture is implemented in which the designed optimal trajectory is then provided as a reference to the robot with the optimal control trajectory as a feedforward control action, and an LQ-controller in the feedback mode is employed to mitigate noise and disturbances for ensuing stable motion of the WIP system. While performing experiments on the WIP system involving aggressive maneuvers with fairly sharp turns, we found a high degree of congruence in the designed optimal trajectories and the path traced by the robot while tracking these trajectories. This corroborates the validity of the nonlinear model and the control scheme. Finally, these experiments demonstrate the highly nonlinear nature of the WIP system and robustness of the control scheme.Keywords
All Related Versions
This publication has 22 references indexed in Scilit:
- Symmetries in the wheeled inverted pendulum mechanismNonlinear Dynamics, 2017
- Energy shaping for position and speed control of a wheeled inverted pendulum in reduced spaceAutomatica, 2016
- Robust motion control of a two-wheeled inverted pendulum with an input delay based on optimal integral sliding mode manifoldNonlinear Dynamics, 2016
- Dynamic modeling of a two-wheeled inverted pendulum balancing mobile robotInternational Journal of Control, Automation, and Systems, 2015
- Review of modelling and control of two-wheeled robotsAnnual Reviews in Control, 2013
- Advanced Control of Wheeled Inverted Pendulum Systems2013
- Optimal Control and Applications to Aerospace: Some Results and ChallengesJournal of Optimization Theory and Applications, 2012
- Dynamic Analysis of a Nonholonomic Two-Wheeled Inverted Pendulum RobotJournal of Intelligent & Robotic Systems, 2005
- On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programmingMathematical Programming, 2005
- Nonholonomic mechanical systems with symmetryArchive for Rational Mechanics and Analysis, 1996