Bundle adjustment demo using Ceres Solver, with customized cost function and local parameterization on SE(3)