Added debug msg when waypoint/command type is not supported