Properly set the mode for software interrupt and undefined
Properly implement the undefined instruction

And disable set the disable IRQ flag in the interrupts
Implement thumb move shifted register