Kinematics Edits
Fixed Kinematics code