Fixed the order of sensormeasurements
Changed minor thing for testing the mapping