利用MSR与MRS指令，写出使能IRQ的子程序。并思考使能FIQ的子程序

在ARM架构中，中断请求（IRQ）和快速中断请求（FIQ）通常通过特定的控制寄存器（如IRQ寄存器或FIQ寄存器）来管理。为了使能IRQ，可以编写这样的子程序：

void enable_IRQ() {
    // 获取当前CPU状态，保存标志
    uint32_t cpsr = read_cpsr();

    // 将当前模式设置为处理器模式（IMP），以便修改中断控制寄存器
    cpsr &= ~ CPSR_M; // clear the M (Mode) bit
    write_cpsr(cpsr);

    // 使能IRQ中断
    ICR |= (1 << IRQ_BIT); // where IRQ_BIT is the specific IRQ interrupt number

    // 恢复之前的模式
    if (cpsr & IPSR_FIQ) { // 如果之前在FIQ模式下，需要先返回FIQ模式
        set_mode(cpsr);
    } else {
        set_mode(cpsr | M_BIT); // 否则，恢复到用户模式或系统模式
    }
}

同样，使能FIQ的子程序可能会类似：

void enable_FIQ() {
    uint32_t cpsr = read_cpsr();
    
    // 确保处于处理器模式
    cpsr &= ~ CPSR_M;
    write_cpsr(cpsr);

    // 使能FIQ中断
    FCR |= (1 << FIQ_BIT); // where FIQ_BIT is the specific FIQ interrupt number

    // 返回到先前的状态
    if (cpsr & IPSR_IRQ) { // 如果之前在IRQ模式，先回IRQ模式
        set_mode(cpsr & ~IPSR_FIQ);
    } else {
        set_mode(cpsr); // 否则保持原有模式
    }
}

// 其中set_mode函数用于设置处理器工作模式