Copter: remove debug comments

This commit is contained in:
Randy Mackay 2015-11-27 16:16:11 +09:00
parent 3199829d45
commit 19f5c8f209

View File

@ -1867,36 +1867,25 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
//send a rally point to the GCS //send a rally point to the GCS
case MAVLINK_MSG_ID_RALLY_FETCH_POINT: { case MAVLINK_MSG_ID_RALLY_FETCH_POINT: {
//send_text(MAV_SEVERITY_INFO, "## getting rally point in GCS_Mavlink.cpp 1"); // #### TEMP
mavlink_rally_fetch_point_t packet; mavlink_rally_fetch_point_t packet;
mavlink_msg_rally_fetch_point_decode(msg, &packet); mavlink_msg_rally_fetch_point_decode(msg, &packet);
//send_text(MAV_SEVERITY_INFO, "## getting rally point in GCS_Mavlink.cpp 2"); // #### TEMP
if (packet.idx > copter.rally.get_rally_total()) { if (packet.idx > copter.rally.get_rally_total()) {
send_text(MAV_SEVERITY_NOTICE, "Bad rally point index"); send_text(MAV_SEVERITY_NOTICE, "Bad rally point index");
break; break;
} }
//send_text(MAV_SEVERITY_INFO, "## getting rally point in GCS_Mavlink.cpp 3"); // #### TEMP
RallyLocation rally_point; RallyLocation rally_point;
if (!copter.rally.get_rally_point_with_index(packet.idx, rally_point)) { if (!copter.rally.get_rally_point_with_index(packet.idx, rally_point)) {
send_text(MAV_SEVERITY_NOTICE, "Failed to set rally point"); send_text(MAV_SEVERITY_NOTICE, "Failed to set rally point");
break; break;
} }
//send_text(MAV_SEVERITY_INFO, "## getting rally point in GCS_Mavlink.cpp 4"); // #### TEMP
mavlink_msg_rally_point_send_buf(msg, mavlink_msg_rally_point_send_buf(msg,
chan, msg->sysid, msg->compid, packet.idx, chan, msg->sysid, msg->compid, packet.idx,
copter.rally.get_rally_total(), rally_point.lat, rally_point.lng, copter.rally.get_rally_total(), rally_point.lat, rally_point.lng,
rally_point.alt, rally_point.break_alt, rally_point.land_dir, rally_point.alt, rally_point.break_alt, rally_point.land_dir,
rally_point.flags); rally_point.flags);
//send_text(MAV_SEVERITY_INFO, "## getting rally point in GCS_Mavlink.cpp 5"); // #### TEMP
break; break;
} }
#endif // AC_RALLY == ENABLED #endif // AC_RALLY == ENABLED