Zaslat SMS: Robot dynamics and control