Added waypoint [de]serialization tests
Removed unnecessary header file