Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-01 19:07:45 +08:00
Code Issues Actions 5 Packages Projects Releases Wiki Activity

Tweak the MAVlink parameter load/save path to deal with NXFFS.

Browse Source
This commit is contained in:
px4dev
2012-08-20 09:55:53 -07:00
parent d17bbc7a0b
commit 4ddf93bd06
1 changed files with 22 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/mavlink/mavlink_parameters.c
+22 -11
View File
@@ -43,6 +43,7 @@
#include <assert.h> #include <assert.h>
#include <stdio.h> #include <stdio.h>
#include <fcntl.h> #include <fcntl.h>
#include <unistd.h>
#include <stdbool.h> #include <stdbool.h>
#include <string.h> #include <string.h>
#include <systemlib/param/param.h> #include <systemlib/param/param.h>
@@ -145,20 +146,27 @@ int mavlink_pm_send_param(param_t param)
return mavlink_missionlib_send_message(&tx_msg); return mavlink_missionlib_send_message(&tx_msg);
} }
static const char *mavlink_parameter_file = "/eeprom/parameters";
static int static int
mavlink_pm_save_eeprom() mavlink_pm_save_eeprom()
{ {
const char* name = "/eeprom"; unlink(mavlink_parameter_file);
int fd = open("/eeprom", O_WRONLY | O_CREAT | O_EXCL);
if (fd < 0) int fd = open(mavlink_parameter_file, O_WRONLY | O_CREAT | O_EXCL);
warn(1, "opening '%s' failed", name);
if (fd < 0) {
warn(1, "opening '%s' failed", mavlink_parameter_file);
return -1;
}
int result = param_export(fd, false); int result = param_export(fd, false);
close(fd); close(fd);
if (result < 0) { if (result < 0) {
warn(1, "error exporting to '%s'", name); unlink(mavlink_parameter_file);
warn(1, "error exporting to '%s'", mavlink_parameter_file);
return -1;
} }
return 0; return 0;
@@ -167,17 +175,20 @@ mavlink_pm_save_eeprom()
static int static int
mavlink_pm_load_eeprom() mavlink_pm_load_eeprom()
{ {
const char* name = "/eeprom"; int fd = open(mavlink_parameter_file, O_RDONLY);
int fd = open(name, O_RDONLY);
if (fd < 0) if (fd < 0) {
warn(1, "open '%s' failed", name); warn(1, "open '%s' failed", mavlink_parameter_file);
return -1;
}
int result = param_import(fd); int result = param_import(fd);
close(fd); close(fd);
if (result < 0) if (result < 0) {
warn(1, "error importing from '%s'", name); warn(1, "error importing from '%s'", mavlink_parameter_file);
return -1;
}
return 0; return 0;
} }