sweep2wake: add more debugging and re-organized reset code when lock up

Signed-off-by: faux123 <reioux@gmail.com>