Finally fixed bug in kinematic