Fixed the neck kinematics, cause they were wrong before.
Merge branch 'feature/neck_kin' into feature/trajectory_playback