Fix user abort behave in test

Now the pwm output returns to its before test value (useful when testing ESCs). Works well on FMU, needs test on IO.