cleaner specific factor linearization
parent
48e087e083
commit
43e6bc6462
|
|
@ -236,7 +236,7 @@ class HybridNonlinearFactor : public HybridFactor {
|
||||||
GaussianFactor::shared_ptr linearize(
|
GaussianFactor::shared_ptr linearize(
|
||||||
const Values& continuousValues,
|
const Values& continuousValues,
|
||||||
const DiscreteValues& discreteValues) const {
|
const DiscreteValues& discreteValues) const {
|
||||||
auto [factor, val] = factors_(discreteValues);
|
auto factor = factors_(discreteValues).first;
|
||||||
return factor->linearize(continuousValues);
|
return factor->linearize(continuousValues);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue