Minor improvements. Prepared for fiq handler at the end vector table