Today,I came out with the flow of the Obstacles Avoidance.
First, Detect obstacles within a certain distance.
First, Detect obstacles within a certain distance.
Second, check the coordinate of the obstacles. 
Third, use a set motion to make the robot move out of the obstacle.
