EkfSlam

Additional data fixes

Extracted additional data

Better visualisation

Extracted types to dedicated structs instead of tuples

Changed association result to use set instead of vector