Forward Kinematics

robotics:forward_kinematics

Forward kinematics mapping joint space to task space.