A near nonlinear optimal controller for the nonlinear inverted pendulum
applied optimal control : optimization , estimation , and control .