Commiting almost final version of forward kinematics