Go-To-goal-Code3 this code enable robot to navigate from start point to goal (x_goal,y_goal)(go to goal behavior)