Nonlinear Model Predictive Control for Pose Regulation Robot and Obstacle Avoidance