Forward and inverse kinematics ready :)