bundle adjustment

[liutianxin0722]

感谢分享。在BA优化时，为什么用get_3dpos_v1 而不是get_3dpos 函数？我发现用get_3dpos生成的点云效果不太好。