Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_AccelCal: stop using mavlink_snoop for target traffic

This commit is contained in:
Peter Barker 2018-03-17 17:56:57 +11:00 committed by Randy Mackay
parent beb5dc2fd6
commit 9ad058783a
2 changed files with 9 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
libraries/AP_AccelCal/AP_AccelCal.cpp
View File

@ -21,7 +21,6 @@
const extern AP_HAL::HAL& hal;
static bool _start_collect_sample;
static void _snoop(const mavlink_message_t* msg);
uint8_t AP_AccelCal::_num_clients = 0;
AP_AccelCal_Client* AP_AccelCal::_clients[AP_ACCELCAL_MAX_NUM_CLIENTS] {};
@ -97,8 +96,7 @@ void AP_AccelCal::update()
return;
}
_printf("Place vehicle %s and press any key.", msg);
// setup snooping of packets so we can see the COMMAND_ACK
_gcs->set_snoop(_snoop);
_waiting_for_mavlink_ack = true;
}
}
@ -277,8 +275,6 @@ void AP_AccelCal::collect_sample()
for(uint8_t i=0 ; (cal = get_calibrator(i)) ; i++) {
cal->collect_sample();
}
// setup snooping of packets so we can see the COMMAND_ACK
_gcs->set_snoop(nullptr);
_start_collect_sample = false;
update_status();
}
@ -357,8 +353,12 @@ bool AP_AccelCal::client_active(uint8_t client_num)
return (bool)_clients[client_num]->_acal_get_calibrator(0);
}
static void _snoop(const mavlink_message_t* msg)
void AP_AccelCal::handleMessage(const mavlink_message_t* msg)
{
if (!_waiting_for_mavlink_ack) {
return;
}
_waiting_for_mavlink_ack = false;
if (msg->msgid == MAVLINK_MSG_ID_COMMAND_ACK) {
_start_collect_sample = true;
}

3
libraries/AP_AccelCal/AP_AccelCal.h
View File

@ -33,9 +33,12 @@ public:
// interface to the clients for registration
static void register_client(AP_AccelCal_Client* client);
void handleMessage(const mavlink_message_t * msg);
private:
GCS_MAVLINK *_gcs;
bool _use_gcs_snoop;
bool _waiting_for_mavlink_ack = false;
uint32_t _last_position_request_ms;
uint8_t _step;
accel_cal_status_t _status;