Added basic interrupt handler code for main firmware