Modified state AdvanceWayPoint and added needed files to run it.