Fix waypoint coordinates

  * Avoid agent disparition around robot on the left side