Trajectory Planning and Control for Nonholonomic Robot Among Onstacles