Hello everyone,
Currently, I want to
optimize the sensor poses using pose graph optimization (based on GICP scan matching for all frame pairs). When I asked the author regarding the paper I referenced, he replied as follows:
" Yes, the approach you described is correct. Specifically, you need to implement a GICP factor class derived from gtsam::NonlinearFactor that linearizes the GICP error function and returns the linearized function as a gtsam::HessianFactor. The following document would be a help to see how to implement a custom factor for GTSAM.Creating new factor and variable types: https://gtsam.org/doxygen/ "
However, I don't quite understand. Could anyone help me how to customize to GTSAM? Thank you very much
Best regards,
Duy Nhat