Simple linear kinematics implementation and tests