Very basic sleep, some code cleanup, using HSE instead of HSI now.