Browse Source

GPS_DUMP_COMM: dump all gps instances

release/1.12
Roman Dvořák 4 years ago committed by GitHub
parent
commit
bc1c8fb73a
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
  1. 2
      msg/gps_dump.msg
  2. 5
      src/drivers/gps/gps.cpp

2
msg/gps_dump.msg

@ -3,6 +3,8 @@ @@ -3,6 +3,8 @@
uint64 timestamp # time since system start (microseconds)
uint8 instance # Instance of GNSS reciever
uint8 len # length of data, MSB bit set = message to the gps device,
# clear = message from the device
uint8[79] data # data to write to the log

5
src/drivers/gps/gps.cpp

@ -579,10 +579,6 @@ void GPS::initializeCommunicationDump() @@ -579,10 +579,6 @@ void GPS::initializeCommunicationDump()
return; //dumping disabled
}
if (_instance != Instance::Main) {
return;
}
_dump_from_device = new gps_dump_s();
_dump_to_device = new gps_dump_s();
@ -608,6 +604,7 @@ void GPS::dumpGpsData(uint8_t *data, size_t len, bool msg_to_gps_device) @@ -608,6 +604,7 @@ void GPS::dumpGpsData(uint8_t *data, size_t len, bool msg_to_gps_device)
}
gps_dump_s *dump_data = msg_to_gps_device ? _dump_to_device : _dump_from_device;
dump_data->instance = (uint8_t) _instance;
while (len > 0) {
size_t write_len = len;

Loading…
Cancel
Save