Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Filesystem: publish can info over FS Sys iface

Browse Source
This commit is contained in:
Siddharth Purohit 2020-05-31 17:35:49 +05:30 committed by Andrew Tridgell
parent e9430d7f80
commit 20edecc340
1 changed files with 24 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
libraries/AP_Filesystem/AP_Filesystem_Sys.cpp
View File

@ -20,6 +20,7 @@
#include "AP_Filesystem.h" #include "AP_Filesystem.h"
#include "AP_Filesystem_Sys.h" #include "AP_Filesystem_Sys.h"
#include <AP_Math/AP_Math.h> #include <AP_Math/AP_Math.h>
#include <AP_CANManager/AP_CANManager.h>
extern const AP_HAL::HAL& hal; extern const AP_HAL::HAL& hal;
@ -52,6 +53,29 @@ int AP_Filesystem_Sys::open(const char *fname, int flags)
r.data->length = hal.util->thread_info(r.data->data, max_size); r.data->length = hal.util->thread_info(r.data->data, max_size);
} }
} }
#if HAL_MAX_CAN_PROTOCOL_DRIVERS
int8_t can_stats_num = -1;
if (strcmp(fname, "can_log.txt") == 0) {
const uint32_t max_size = 1024;
r.data->data = (char *)malloc(max_size);
if (r.data->data) {
r.data->length = AP::can().log_retrieve(r.data->data, max_size);
}
} else if (strcmp(fname, "can0_stats.txt") == 0) {
can_stats_num = 0;
} else if (strcmp(fname, "can1_stats.txt") == 0) {
can_stats_num = 1;
}
if (can_stats_num != -1 && can_stats_num < HAL_NUM_CAN_IFACES) {
if (hal.can[can_stats_num] != nullptr) {
const uint32_t max_size = 1024;
r.data->data = (char *)malloc(max_size);
if (r.data->data) {
r.data->length = hal.can[can_stats_num]->get_stats(r.data->data, max_size);
}
}
}
#endif
if (r.data->data == nullptr) { if (r.data->data == nullptr) {
delete r.data; delete r.data;
errno = ENOENT; errno = ENOENT;