Trajectory tracking---ship track control matlab program