commit
f62a1b0b81
|
@ -79,9 +79,8 @@ class BearingRangeFactor
|
||||||
{
|
{
|
||||||
std::vector<Matrix> Hs(2);
|
std::vector<Matrix> Hs(2);
|
||||||
const auto &keys = Factor::keys();
|
const auto &keys = Factor::keys();
|
||||||
const Vector error = unwhitenedError(
|
const Vector error = this->unwhitenedError(
|
||||||
{{keys[0], genericValue(a1)}, {keys[1], genericValue(a2)}},
|
{{keys[0], genericValue(a1)}, {keys[1], genericValue(a2)}}, Hs);
|
||||||
Hs);
|
|
||||||
if (H1) *H1 = Hs[0];
|
if (H1) *H1 = Hs[0];
|
||||||
if (H2) *H2 = Hs[1];
|
if (H2) *H2 = Hs[1];
|
||||||
return error;
|
return error;
|
||||||
|
|
Loading…
Reference in New Issue