IRQ handler rewrite by Gabor Juhos, uses C no longer assembly