set-timer-lat: Cleanup code and improve failure output

Rework the code to improve failure output, including cleaning up
some of the core logic.

Signed-off-by: John Stultz <john.stultz@linaro.org>