Tested TransferWaypoint

- added tests for transferWaypoint
- comment unnecessary methods