Robotics : Modelling, planning and control (Springer, 2009)