mirror of https://github.com/ArduPilot/ardupilot
92 lines
2.3 KiB
C++
92 lines
2.3 KiB
C++
/*
|
|
This program is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <AP_HAL/AP_HAL.h>
|
|
#include "AP_Filesystem.h"
|
|
|
|
extern const AP_HAL::HAL& hal;
|
|
|
|
/*
|
|
load a full file. Use delete to free the data
|
|
*/
|
|
FileData *AP_Filesystem_Backend::load_file(const char *filename)
|
|
{
|
|
struct stat st;
|
|
if (stat(filename, &st) != 0) {
|
|
return nullptr;
|
|
}
|
|
FileData *fd = new FileData(this);
|
|
if (fd == nullptr) {
|
|
return nullptr;
|
|
}
|
|
void *data = malloc(st.st_size);
|
|
if (data == nullptr) {
|
|
delete fd;
|
|
return nullptr;
|
|
}
|
|
int d = open(filename, O_RDONLY);
|
|
if (d == -1) {
|
|
free(data);
|
|
delete fd;
|
|
return nullptr;
|
|
}
|
|
if (read(d, data, st.st_size) != st.st_size) {
|
|
close(d);
|
|
free(data);
|
|
delete fd;
|
|
return nullptr;
|
|
}
|
|
close(d);
|
|
fd->length = st.st_size;
|
|
fd->data = (const uint8_t *)data;
|
|
return fd;
|
|
}
|
|
|
|
/*
|
|
unload a FileData object
|
|
*/
|
|
void AP_Filesystem_Backend::unload_file(FileData *fd)
|
|
{
|
|
if (fd->data != nullptr) {
|
|
free(const_cast<uint8_t *>(fd->data));
|
|
fd->data = nullptr;
|
|
}
|
|
}
|
|
|
|
// return true if file operations are allowed
|
|
bool AP_Filesystem_Backend::file_op_allowed(void) const
|
|
{
|
|
if (!hal.util->get_soft_armed() || !hal.scheduler->in_main_thread()) {
|
|
return true;
|
|
}
|
|
if (AP_HAL::millis() - hal.util->get_last_armed_change() < 3000) {
|
|
// allow file operations from main thread in first 3s after
|
|
// arming to allow for log file creation
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
/*
|
|
destructor for FileData
|
|
*/
|
|
FileData::~FileData()
|
|
{
|
|
if (backend != nullptr) {
|
|
((AP_Filesystem_Backend *)backend)->unload_file(this);
|
|
}
|
|
}
|
|
|