add tool to evaluate kinematics speed and correctness