Fundamentals of Robot Mechanics