fix of the century
This commit is contained in:
parent
9a8c059e05
commit
2364f7d5d9
@ -342,7 +342,7 @@ ReturnValue_t MultiplicativeKalmanFilter::kfGain(
|
|||||||
double *measSensMatrix, double *measCovMatrix, double *kalmanGain,
|
double *measSensMatrix, double *measCovMatrix, double *kalmanGain,
|
||||||
acsctrl::AttitudeEstimationData *attitudeEstimationData) {
|
acsctrl::AttitudeEstimationData *attitudeEstimationData) {
|
||||||
// Kalman Gain: K = P * H' / (H * P * H' + R)
|
// Kalman Gain: K = P * H' / (H * P * H' + R)
|
||||||
double kalmanGainDen[6][matrixDimensionFactor] = {{0}},
|
double kalmanGainDen[matrixDimensionFactor][matrixDimensionFactor] = {{0}},
|
||||||
invKalmanGainDen[matrixDimensionFactor][matrixDimensionFactor] = {{0}},
|
invKalmanGainDen[matrixDimensionFactor][matrixDimensionFactor] = {{0}},
|
||||||
residualCov[6][matrixDimensionFactor] = {{0}},
|
residualCov[6][matrixDimensionFactor] = {{0}},
|
||||||
measSensMatrixTransposed[6][matrixDimensionFactor] = {{0}};
|
measSensMatrixTransposed[6][matrixDimensionFactor] = {{0}};
|
||||||
|
Loading…
x
Reference in New Issue
Block a user