SLAM系列--Camera Pose的求解(Direct Method)