Add missing getter for waypoints and unit test for equality

Change-Id: If6ca25bd4459c32e30467991039bbbe36f2256f2
2 files changed