Fixed sign (might need to be rethought?)
parent
7f27a594d2
commit
014159de44
|
|
@ -68,7 +68,7 @@ public:
|
||||||
KeyMatrix(key, Q.block(0, ZDim * j++, m2, ZDim) * FBlocks[k]));
|
KeyMatrix(key, Q.block(0, ZDim * j++, m2, ZDim) * FBlocks[k]));
|
||||||
}
|
}
|
||||||
// Which is then passed to the normal JacobianFactor constructor
|
// Which is then passed to the normal JacobianFactor constructor
|
||||||
JacobianFactor::fillTerms(QF, Q * b, model);
|
JacobianFactor::fillTerms(QF, - Q * b, model);
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
// end class JacobianFactorQ
|
// end class JacobianFactorQ
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue