Semi-Autonomous Robot Teleoperation with Obstacle Avoidance Via Model Predictive Control