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

AP_Terrain: fixed terrain path handling

Browse Source
This commit is contained in:
Andrew Tridgell 2015-06-30 14:35:52 +10:00
parent a3c7297d8e
commit 1296da56bb
2 changed files with 33 additions and 39 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Terrain/AP_Terrain.h
View File

@ -402,6 +402,8 @@ private:
// grid spacing during rally check
uint16_t last_rally_spacing;
char *file_path = NULL;
};
#endif // AP_TERRAIN_AVAILABLE
#endif // __AP_TERRAIN_H__

70
libraries/AP_Terrain/TerrainIO.cpp
View File

@ -150,56 +150,48 @@ void AP_Terrain::open_file(void)
// already open on right file
return;
}
char *path;
const char* custom_dir = hal.util->get_custom_terrain_directory();
if (custom_dir != NULL){
// build the pathname from the args provided
path = (char*) malloc(strlen(custom_dir)+strlen("/NxxExxx.DAT")+1);
if (!path) {
printf("Terrain degree file, malloc() failed: insufficient memory!\n");
exit(1);
if (file_path == NULL) {
const char* terrain_dir = hal.util->get_custom_terrain_directory();
if (terrain_dir == NULL) {
terrain_dir = HAL_BOARD_TERRAIN_DIRECTORY;
}
strcpy(path, custom_dir);
strcat(path, "/NxxExxx.DAT");
char *p = &path[strlen(HAL_BOARD_TERRAIN_DIRECTORY)+1];
snprintf(p, 12, "%c%02u%c%03u.DAT",
block.lat_degrees<0?'S':'N',
abs(block.lat_degrees),
block.lon_degrees<0?'W':'E',
abs(block.lon_degrees));
// create directory if need be
if (!directory_created) {
mkdir(custom_dir, 0755);
directory_created = true;
if (asprintf(&file_path, "%s/NxxExxx.DAT", terrain_dir) <= 0) {
io_failure = true;
file_path = NULL;
return;
}
} else {
// build the pathname to the degree file
char path_default[] = HAL_BOARD_TERRAIN_DIRECTORY "/NxxExxx.DAT";
char *p = &path_default[strlen(HAL_BOARD_TERRAIN_DIRECTORY)+1];
snprintf(p, 12, "%c%02u%c%03u.DAT",
block.lat_degrees<0?'S':'N',
abs(block.lat_degrees),
block.lon_degrees<0?'W':'E',
abs(block.lon_degrees));
}
if (file_path == NULL) {
io_failure = true;
return;
}
char *p = &file_path[strlen(file_path)-12];
if (*p != '/') {
io_failure = true;
return;
}
snprintf(p, 13, "/%c%02u%c%03u.DAT",
block.lat_degrees<0?'S':'N',
abs(block.lat_degrees),
block.lon_degrees<0?'W':'E',
abs(block.lon_degrees));
path = path_default;
// create directory if need be
if (!directory_created) {
mkdir(HAL_BOARD_TERRAIN_DIRECTORY, 0755);
directory_created = true;
}
// create directory if need be
if (!directory_created) {
*p = 0;
mkdir(file_path, 0755);
directory_created = true;
*p = '/';
}
if (fd != -1) {
::close(fd);
}
fd = ::open(path, O_RDWR|O_CREAT, 0644);
fd = ::open(file_path, O_RDWR|O_CREAT, 0644);
if (fd == -1) {
#if TERRAIN_DEBUG
hal.console->printf("Open %s failed - %s\n",
path, strerror(errno));
file_path, strerror(errno));
#endif
io_failure = true;
return;