Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-06-07 00:53:41 +08:00
Code Issues Actions 25 Packages Projects Releases Wiki Activity

[math] buf fix on geodetic function

Browse Source
This commit is contained in:
Gautier Hattenberger
2013-07-02 15:53:08 +02:00
parent 1fb3fbb097
commit ffecd0c157
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/math/pprz_geodetic_int.c
+3 -3
View File
@@ -145,9 +145,9 @@ void ned_of_ecef_vect_i(struct NedCoor_i* ned, struct LtpDef_i* def, struct Ecef
void ecef_of_enu_vect_i(struct EcefCoor_i* ecef, struct LtpDef_i* def, struct EnuCoor_i* enu) {
const int64_t tmpx = (int64_t)def->ltp_of_ecef.m[0] * enu-> +
(int64_t)def->ltp_of_ecef.m[3] * enu-> +
(int64_t)def->ltp_of_ecef.m[6] * enu->;
const int64_t tmpx = (int64_t)def->ltp_of_ecef.m[0] * enu->x +
(int64_t)def->ltp_of_ecef.m[3] * enu->y +
(int64_t)def->ltp_of_ecef.m[6] * enu->z;
ecef->x = (int32_t)(tmpx>>HIGH_RES_TRIG_FRAC);
const int64_t tmpy = (int64_t)def->ltp_of_ecef.m[1] * enu->x +