https://5dok.net/document/1y94p0vq-using-extended-information-filter-localization-humanoid-robots-soccer.html