https://www.guyuehome.com/42802
https://mp.weixin.qq.com/s/uLPgAKa8KjMbuG1VycatuQ
https://github.com/MarvinChung/Orbeez-SLAM/blob/main/scripts/evaluate_ate.py
