Moved reset logic into separate method.
Merge branch 'sensor_hil_fixedwing' into hil_attack
Simulation running with attack and timeout.