A Path Generation Algorithm of Autonomous Robot Vehicle By the Sensor Platform and Optimal Controller Based On the Kinematic Model