Robot dynamics and control - Spong lhMark W