Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Terrain: prevent disk blocks getting stuck 

we need to match first on the expected state to ensure we don't get an
invalid block
This commit is contained in:
Andrew Tridgell 2014-07-22 19:38:20 +10:00
parent 28d6e39c4c
commit 2f0279659a
2 changed files with 13 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
libraries/AP_Terrain/AP_Terrain.cpp
View File

@ -482,8 +482,17 @@ void AP_Terrain::handle_terrain_data(mavlink_message_t *msg)
/*
find cache index of disk_block
*/
int16_t AP_Terrain::find_io_idx(void)
int16_t AP_Terrain::find_io_idx(enum GridCacheState state)
{
// try first with given state
for (uint16_t i=0; i<TERRAIN_GRID_BLOCK_CACHE_SIZE; i++) {
if (disk_block.block.lat == cache[i].grid.lat &&
disk_block.block.lon == cache[i].grid.lon &&
cache[i].state == state) {
return i;
}
}
// then any state
for (uint16_t i=0; i<TERRAIN_GRID_BLOCK_CACHE_SIZE; i++) {
if (disk_block.block.lat == cache[i].grid.lat &&
disk_block.block.lon == cache[i].grid.lon) {
@ -548,7 +557,7 @@ void AP_Terrain::update(void)
case DiskIoDoneRead: {
// a read has completed
int16_t cache_idx = find_io_idx();
int16_t cache_idx = find_io_idx(GRID_CACHE_DISKWAIT);
if (cache_idx != -1) {
if (disk_block.block.bitmap != 0) {
// when bitmap is zero we read an empty block
@ -563,7 +572,7 @@ void AP_Terrain::update(void)
case DiskIoDoneWrite: {
// a write has completed
int16_t cache_idx = find_io_idx();
int16_t cache_idx = find_io_idx(GRID_CACHE_DIRTY);
if (cache_idx != -1) {
if (cache[cache_idx].grid.bitmap == disk_block.block.bitmap) {
// only mark valid if more grids haven't been added

2
libraries/AP_Terrain/AP_Terrain.h
View File

@ -221,7 +221,7 @@ private:
/*
disk IO functions
*/
int16_t find_io_idx(void);
int16_t find_io_idx(enum GridCacheState state);
uint16_t get_block_crc(struct grid_block &block);
void check_disk_read(void);
void check_disk_write(void);