Created Waypoints test

Some methods not implemented yet. Wanted to check this was correct.