https://5dok.org/document/qmjvpn74-map-aided-localization-autonomous-driving-using-particle-filter.html