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]));
|
||||
}
|
||||
// Which is then passed to the normal JacobianFactor constructor
|
||||
JacobianFactor::fillTerms(QF, Q * b, model);
|
||||
JacobianFactor::fillTerms(QF, - Q * b, model);
|
||||
}
|
||||
};
|
||||
// end class JacobianFactorQ
|
||||
|
|
|
|||
Loading…
Reference in New Issue