Fixed a bit more with the SysTick Handler. Still lots of broken.