waypoint mobile robotics algorithm

1- Turn on the waypoints of the robot Visualizer block to create 3 points as P1 = (0,0), P2 = (2,3) and P3 = (4,1). 2- Starting from the starting point of the robot P1 before the point of P3 then move to an point P3 to create an algorithm.   The PathFollowing block will not be used. Example: You can use MATLAB-Function or Stateflow blocks.