Kinematics and Dynamics for Robotics