Added current kinematics code