Matlab simulation on kinematic control