Modified state AdvanceWayPoint and added needed files to run it.
Forgot to add a few comments. My bad.
Merge pull request #6 from Kasio1691/master

Adding advance way point state.