fix conversion
parent
f3bfe7e1a1
commit
245f3e042e
|
|
@ -35,8 +35,8 @@ HybridGaussianFactor::FactorValuePairs GetFactorValuePairs(
|
||||||
double value = 0.0;
|
double value = 0.0;
|
||||||
// Check if conditional is pruned
|
// Check if conditional is pruned
|
||||||
if (conditional) {
|
if (conditional) {
|
||||||
// Assign log(|2πΣ|) = -2*log(1 / sqrt(|2πΣ|))
|
// Assign log(\sqrt(|2πΣ|)) = -log(1 / sqrt(|2πΣ|))
|
||||||
value = -2.0 * conditional->logNormalizationConstant();
|
value = -conditional->logNormalizationConstant();
|
||||||
}
|
}
|
||||||
return {std::dynamic_pointer_cast<GaussianFactor>(conditional), value};
|
return {std::dynamic_pointer_cast<GaussianFactor>(conditional), value};
|
||||||
};
|
};
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue