The elevation angle term of eq. 5 in the paper "A Portable 3D LIDAR-based System for Long-term and Wide-area People Behavior Measurement" is wrong.
You should be able to verify my claim from both code implementation in G2O plane3d.h & eq. 19 in CPA-SLAM. G2O's implementation is consistent with equation in CPA-SLAM.
The elevation angle term of eq. 5 in the paper "A Portable 3D LIDAR-based System for Long-term and Wide-area People Behavior Measurement" is wrong.
You should be able to verify my claim from both code implementation in G2O
plane3d.h
& eq. 19 in CPA-SLAM. G2O's implementation is consistent with equation in CPA-SLAM.