fix docstring

release/4.3a0
Varun Agrawal 2024-10-01 12:15:04 -04:00
parent bb22831662
commit f42a297a40
1 changed files with 1 additions and 1 deletions

View File

@ -158,7 +158,7 @@ struct Switching {
nonlinearFactorGraph.emplace_shared<PriorFactor<double>>( nonlinearFactorGraph.emplace_shared<PriorFactor<double>>(
X(0), measurements.at(0), Isotropic::Sigma(1, prior_sigma)); X(0), measurements.at(0), Isotropic::Sigma(1, prior_sigma));
// Add "motion models" ϕ(X(k),X(k+1)). // Add "motion models" ϕ(X(k),X(k+1),M(k)).
for (size_t k = 0; k < K - 1; k++) { for (size_t k = 0; k < K - 1; k++) {
auto motion_models = motionModels(k, between_sigma); auto motion_models = motionModels(k, between_sigma);
nonlinearFactorGraph.emplace_shared<HybridNonlinearFactor>(modes[k], nonlinearFactorGraph.emplace_shared<HybridNonlinearFactor>(modes[k],