frozen轨迹的子图和节点不参与优化问题中的优化，也就是5个残差的计算。但是参与inter global约束的计算，也就是纯定位。