put back an if statment in IRQ_Handler