光心坐标   3d候选点

1.完成根据相机内外参计算光心位置的函数
2.形成3d候选点