Debugged FlightSim and sensor_measurement