Update WaypointCommands.java