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

AP_Declination: Changed PROGMEM read function to pgm_read_word_far to support the int16_t datatype.

Browse Source
This commit is contained in:
Adam M Rivera 2012-03-11 12:22:37 -05:00 committed by Andrew Tridgell
parent d883bdf75e
commit 9888a4730f
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_Declination/AP_Declination.cpp
View File

@ -76,10 +76,10 @@ AP_Declination::get_declination(float lat, float lon)
latmin_index= (90+latmin)/5;
lonmin_index= (180+lonmin)/5;
decSW = (int16_t)pgm_read_byte_far(&dec_tbl[latmin_index][lonmin_index]);
decSE = (int16_t)pgm_read_byte_far(&dec_tbl[latmin_index][lonmin_index+1]);
decNE = (int16_t)pgm_read_byte_far(&dec_tbl[latmin_index+1][lonmin_index+1]);
decNW = (int16_t)pgm_read_byte_far(&dec_tbl[latmin_index+1][lonmin_index]);
decSW = (int16_t)pgm_read_word_far(&dec_tbl[latmin_index][lonmin_index]);
decSE = (int16_t)pgm_read_word_far(&dec_tbl[latmin_index][lonmin_index+1]);
decNE = (int16_t)pgm_read_word_far(&dec_tbl[latmin_index+1][lonmin_index+1]);
decNW = (int16_t)pgm_read_word_far(&dec_tbl[latmin_index+1][lonmin_index]);
/* approximate declination within the grid using bilinear interpolation */
decmin = (lon - lonmin) / 5 * (decSE - decSW) + decSW;