[Drivers] Cleaned up interrupt routine