Properly implemented registerInternalFailure(); some logging in STM32 test app