https://5dok.net/document/wq2x92jz-particle-filter-based-map-state-estimation-a-comparison.html