Fix bugs
Bugs in fifo, NVIC and MSR instruction