Fixed unused param warnings
Fix warning in waypoint class