在Linux内核驱动中，构建一个队列，其中存放的是定义如下的结构体struct msg { u16 module_id; u16 cmd_id; u16 cmd_subid; u16 complete; u8 data[128]; };，请你给出操作这个队列的功能函数，分别为：初始化，入队、出队、注销等；再写两个函数，函数一构建msg，除msg中的data数组外，其他成员赋值为常数，并将两个unsigned int 类型的值使用移位的方式放入data数组中，并向队列中放置msg，使用usleep_range()函数等待函数二将msg的complete成员设置为1后，再退出函数；函数二将msg从队列中取出来，解析msg中的module_id，如果该值不为0x1，则报错，否则使用switch函数解析cmd_id，并根据不同的cmd_id再解析cmd_subid，将msg内data数组中放入的两个unsigned int值还原，并将其作为两个参数用在下列函数前两个参数中，static unsigned int phytuart_msg_cmd_set_txim(unsigned int im, unsigned int txim, struct pokemon_uart_port *pup) { if (txim == 0) { im &= ~REG_IMSC_TXIM; pokemon_uart_write(im, pup, REG_IMSC); } else{ im |= REG_IMSC_TXIM; pokemon_uart_write(im, pup, REG_IMSC); } return im; }并将msg中的complete成员设置为1，函数一和函数二需要使用队列的操作函数，注意函数一中将msg放进队列后，需要调用函数二解析，请给出详细代码

以下是操作队列的功能函数实现：

#include <linux/slab.h> // kmalloc, kfree
#include <linux/list.h> // list_head, list_add_tail
#include <linux/semaphore.h> // struct semaphore, down_interruptible, up

// 定义msg结构体
struct msg {
    u16 module_id;
    u16 cmd_id;
    u16 cmd_subid;
    u16 complete;
    u8 data[128];
};

// 定义队列结构体
struct msg_queue {
    struct semaphore sem;
    struct list_head list;
};

// 初始化队列
void init_msg_queue(struct msg_queue *q) {
    sema_init(&q->sem, 1);
    INIT_LIST_HEAD(&q->list);
}

// 入队
void enqueue_msg(struct msg_queue *q, struct msg *m) {
    down_interruptible(&q->sem);
    list_add_tail(&m->list, &q->list);
    up(&q->sem);
}

// 出队
struct msg *dequeue_msg(struct msg_queue *q) {
    struct msg *m = NULL;
    down_interruptible(&q->sem);
    if (!list_empty(&q->list)) {
        m = list_first_entry(&q->list, struct msg, list);
        list_del(&m->list);
    }
    up(&q->sem);
    return m;
}

// 注销队列
void destroy_msg_queue(struct msg_queue *q) {
    struct msg *m, *n;
    list_for_each_entry_safe(m, n, &q->list, list) {
        list_del(&m->list);
        kfree(m);
    }
}

以下是函数一和函数二的实现：

// 函数一：构建msg，放入队列，等待函数二将complete成员设置为1后退出
void func1(struct msg_queue *q) {
    struct msg *m = kmalloc(sizeof(struct msg), GFP_KERNEL);
    memset(m, 0, sizeof(struct msg));
    m->module_id = 0x1234;
    m->cmd_id = 0x5678;
    m->cmd_subid = 0x9abc;
    m->complete = 0;
    // 将两个unsigned int类型的值放入data数组中
    *(unsigned int*)(m->data) = 0x11111111;
    *(unsigned int*)(m->data + sizeof(unsigned int)) = 0x22222222;
    enqueue_msg(q, m);
    while (m->complete == 0) {
        usleep_range(1000, 2000); // 等待函数二将complete成员设置为1
    }
    kfree(m);
}

// 函数二：从队列中取出msg，解析msg中的module_id、cmd_id和cmd_subid，还原data数组中的两个unsigned int值，并调用phutuart_msg_cmd_set_txim函数
void func2(struct msg_queue *q) {
    struct msg *m = dequeue_msg(q);
    if (m == NULL) {
        return;
    }
    if (m->module_id != 0x1) {
        printk(KERN_ERR "Invalid module ID!\n");
        kfree(m);
        return;
    }
    switch (m->cmd_id) {
        case 0x1111:
            switch (m->cmd_subid) {
                case 0x2222:
                    // 还原data数组中的两个unsigned int值
                    unsigned int im = *(unsigned int*)(m->data);
                    unsigned int txim = *(unsigned int*)(m->data + sizeof(unsigned int));
                    // 调用phutuart_msg_cmd_set_txim函数
                    phytuart_msg_cmd_set_txim(im, txim, NULL);
                    break;
                default:
                    printk(KERN_ERR "Invalid cmd sub ID!\n");
                    break;
            }
            break;
        default:
            printk(KERN_ERR "Invalid cmd ID!\n");
            break;
    }
    m->complete = 1;
}