Single step optimization of feedback-decoupled collision avoidance manipulator maneuvers
Simultaneous robot path planning and path following is shown to be achievable in the presence of motor saturation and obstacle avoidance requirements. The discrete time algorithm derived performs one step ahead mean square optimization of commanded joint accelerations, subject to present actuator force or torque constraints and N step ahead prediction of configuration constraints.