bug:factorGraph object function nodeState return always ZERO state after addFactor non-zero values?
5 views (last 30 days)
Show older comments
cui on 5 Jan 2023
Commented: cui on 6 Jan 2023
It's strange that when i add some non-zero factor state into factorGraph object, before optimizition, use nodeState function to get look state values,but them always return [0,0,0, 1,0,0,0] state, this behavior is very different from poseGraph nodeState.
f = factorTwoPoseSE3([1 2],Measurement=[10,20,30,1,0,0,0]);
g = factorGraph();
% use nodeState to get state value
state1 = g.nodeState(1)
state2 = g.nodeState(2)
you see, state2 is not i expected, it would be reasonable to be [10,20,30,1,0,0].
Zheng Dong on 5 Jan 2023
Sorry for the confusion. This behavior is expected. The node state will only be updated after you optimize the factorGraph. It is different from poseGraph.
Find more on Localization Algorithms in Help Center and File Exchange
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!Start Hunting!