Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Experiment with factor gradients in solve #1825

Draft
wants to merge 1 commit into
base: develop
Choose a base branch
from

Conversation

Affie
Copy link
Member

@Affie Affie commented May 6, 2024

Draft PR not to lose possible value

meas = cfm.meas
points = map(idx->p[idx], cfm.varOrderIdxs)
return cfm.sqrt_iΣ * cfm(meas, points...)
end

function (cfm::CalcFactorResidual)(p::ArrayPartition)
points = map(idx->p.x[idx], cfm.varOrderIdxs)
return cfm.sqrt_iΣ * cfm(cfm.meas, points...)
Copy link
Member

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Post AMP 41, we should look at consolidating this with the kernel evaluations done in AMP. Specifically this Malahanobis distance part. The reasoning is that we need to build belief trees on each clique and then be able to evaluation, which is exactly the same requirement as what this code here is doing.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants