Improved no lock handling (altitude is now zero'ed too)
Extended watchdog timeout interval to 4 seconds
Set interrupt priorities: 1st SysTick, 2nd Everything Else, 3rd Power Mon