Tests: Add further instrumentation
Tests: Add further instrumentation

acfloria/Firmware,PX4/Firmware,krbeverx/Firmware,krbeverx/Firmware,PX4/Firmware,acfloria/Firmware,acfloria/Firmware,PX4/Firmware,krbeverx/Firmware,krbeverx/Firmware,krbeverx/Firmware,acfloria/Firmware,acfloria/Firmware,krbeverx/Firmware,acfloria/Firmware,PX4/Firmware,PX4/Firmware,PX4/Firmware,PX4/Firmware,krbeverx/Firmware,acfloria/Firmware