Major Fix: Only one set of calls per interrupt. Assuming HSI system clock.