Position estimation around corners should work better.
Merge branch 'master' of https://github.com/hansfilipelo/MapMaster2001
Removed shitty merge
Merge branch 'master' of https://github.com/hansfilipelo/MapMaster2001