Motion and Operation Planning of Robotic Systems