Add observed_yaw to data_structures
Adapt calibration test script to new structure
Implement test for offset calibration
Reduce max iteration to 100 and set initial x offset to to 0.21m