bug:factorGraph object function nodeState return always ZERO state after addFactor non-zero values?
1 次查看(过去 30 天)
显示 更早的评论
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.
for example:
f = factorTwoPoseSE3([1 2],Measurement=[10,20,30,1,0,0,0]);
g = factorGraph();
addFactor(g,f);
% 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].
0 个评论
回答(1 个)
Zheng Dong
2023-1-5
Hi Cui,
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.
Thanks,
Zheng
另请参阅
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!