yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-21 01:12:11 +00:00
Code Issues Packages Projects Releases Wiki Activity

GPS_DUMP_COMM: dump all gps instances

Browse Source
This commit is contained in:
Roman Dvořák
2020-12-08 11:45:24 +01:00
committed by GitHub
parent fd261b590c
commit bc1c8fb73a
2 changed files with 5 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
msg/gps_dump.msg
View File

@@ -3,8 +3,10 @@
uint64 timestamp # time since system start (microseconds) 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, uint8 len # length of data, MSB bit set = message to the gps device,
# clear = message from the device # clear = message from the device
uint8[79] data # data to write to the log uint8[79] data # data to write to the log
uint8 ORB_QUEUE_LENGTH = 8 uint8 ORB_QUEUE_LENGTH = 8

7
src/drivers/gps/gps.cpp
View File

@@ -579,10 +579,6 @@ void GPS::initializeCommunicationDump()
return; //dumping disabled return; //dumping disabled
} }
if (_instance != Instance::Main) {
return;
}
_dump_from_device = new gps_dump_s(); _dump_from_device = new gps_dump_s();
_dump_to_device = new gps_dump_s(); _dump_to_device = new gps_dump_s();
@@ -607,7 +603,8 @@ void GPS::dumpGpsData(uint8_t *data, size_t len, bool msg_to_gps_device)
return; return;
} }
gps_dump_s *dump_data = msg_to_gps_device ? _dump_to_device : _dump_from_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) { while (len > 0) {
size_t write_len = len; size_t write_len = len;