Robotics: Modelling, Planning and Control (Advanced