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

AP_Compass: fix wrong memset in compass calibrator

Browse Source
This commit is contained in:
Siddharth Bharat Purohit 2016-11-18 17:37:03 +05:30 committed by Lucas De Marchi
parent 451c2f146d
commit b36ee10e7c
1 changed files with 6 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
libraries/AP_Compass/CompassCalibrator.cpp
View File

@ -508,9 +508,9 @@ void CompassCalibrator::run_sphere_fit()
float JTJ2[COMPASS_CAL_NUM_SPHERE_PARAMS*COMPASS_CAL_NUM_SPHERE_PARAMS]; float JTJ2[COMPASS_CAL_NUM_SPHERE_PARAMS*COMPASS_CAL_NUM_SPHERE_PARAMS];
float JTFI[COMPASS_CAL_NUM_SPHERE_PARAMS]; float JTFI[COMPASS_CAL_NUM_SPHERE_PARAMS];
memset(&JTJ,0,sizeof(JTJ)); memset(JTJ,0,sizeof(JTJ));
memset(&JTJ2,0,sizeof(JTJ2)); memset(JTJ2,0,sizeof(JTJ2));
memset(&JTFI,0,sizeof(JTFI)); memset(JTFI,0,sizeof(JTFI));
// Gauss Newton Part common for all kind of extensions including LM // Gauss Newton Part common for all kind of extensions including LM
for(uint16_t k = 0; k<_samples_collected; k++) { for(uint16_t k = 0; k<_samples_collected; k++) {
Vector3f sample = _sample_buffer[k].get(); Vector3f sample = _sample_buffer[k].get();
@ -624,9 +624,9 @@ void CompassCalibrator::run_ellipsoid_fit()
float JTJ2[COMPASS_CAL_NUM_ELLIPSOID_PARAMS*COMPASS_CAL_NUM_ELLIPSOID_PARAMS]; float JTJ2[COMPASS_CAL_NUM_ELLIPSOID_PARAMS*COMPASS_CAL_NUM_ELLIPSOID_PARAMS];
float JTFI[COMPASS_CAL_NUM_ELLIPSOID_PARAMS]; float JTFI[COMPASS_CAL_NUM_ELLIPSOID_PARAMS];
memset(&JTJ,0,sizeof(JTJ)); memset(JTJ,0,sizeof(JTJ));
memset(&JTJ2,0,sizeof(JTJ2)); memset(JTJ2,0,sizeof(JTJ2));
memset(&JTFI,0,sizeof(JTFI)); memset(JTFI,0,sizeof(JTFI));
// Gauss Newton Part common for all kind of extensions including LM // Gauss Newton Part common for all kind of extensions including LM
for(uint16_t k = 0; k<_samples_collected; k++) { for(uint16_t k = 0; k<_samples_collected; k++) {
Vector3f sample = _sample_buffer[k].get(); Vector3f sample = _sample_buffer[k].get();