void mavlink_start_feeds (void) { mavlink_message_t msg; mavlink_timeout = 0; SDL_Log("mavlink: starting feeds!\n"); mavlink_msg_param_request_list_pack(127, 0, &msg, ModelData.sysid, ModelData.compid); mavlink_send_message(&msg); SDL_Delay(10); mavlink_msg_request_data_stream_pack(127, 0, &msg, ModelData.sysid, ModelData.compid, MAV_DATA_STREAM_RAW_SENSORS, MAV_DATA_STREAM_RAW_SENSORS_RATE, MAV_DATA_STREAM_RAW_SENSORS_ACTIVE); mavlink_send_message(&msg); SDL_Delay(10); if (ModelData.teletype == TELETYPE_MEGAPIRATE_NG || ModelData.teletype == TELETYPE_ARDUPILOT || ModelData.teletype == TELETYPE_HARAKIRIML) { mavlink_msg_request_data_stream_pack(127, 0, &msg, ModelData.sysid, ModelData.compid, MAV_DATA_STREAM_EXTENDED_STATUS, MAV_DATA_STREAM_EXTENDED_STATUS_RATE, MAV_DATA_STREAM_EXTENDED_STATUS_ACTIVE); mavlink_send_message(&msg); SDL_Delay(10); mavlink_msg_request_data_stream_pack(127, 0, &msg, ModelData.sysid, ModelData.compid, MAV_DATA_STREAM_RAW_CONTROLLER, MAV_DATA_STREAM_RAW_CONTROLLER_RATE, MAV_DATA_STREAM_RAW_CONTROLLER_ACTIVE); mavlink_send_message(&msg); SDL_Delay(10); mavlink_msg_request_data_stream_pack(127, 0, &msg, ModelData.sysid, ModelData.compid, MAV_DATA_STREAM_POSITION, MAV_DATA_STREAM_POSITION_RATE, MAV_DATA_STREAM_POSITION_ACTIVE); mavlink_send_message(&msg); SDL_Delay(10); mavlink_msg_request_data_stream_pack(127, 0, &msg, ModelData.sysid, ModelData.compid, MAV_DATA_STREAM_EXTRA1, MAV_DATA_STREAM_EXTRA1_RATE, MAV_DATA_STREAM_EXTRA1_ACTIVE); mavlink_send_message(&msg); SDL_Delay(10); mavlink_msg_request_data_stream_pack(127, 0, &msg, ModelData.sysid, ModelData.compid, MAV_DATA_STREAM_EXTRA2, MAV_DATA_STREAM_EXTRA2_RATE, MAV_DATA_STREAM_EXTRA2_ACTIVE); mavlink_send_message(&msg); SDL_Delay(10); } }
void ParamManager::request_param_list() { mavlink_message_t param_list_msg; mavlink_msg_param_request_list_pack(1, 50, ¶m_list_msg, 1, MAV_COMP_ID_ALL); serial_->send_message(param_list_msg); }