alientek/hal/queue.c111

// #include "queue.h"

// ///   front   ...         rear      数据方向 ->
// /* 队列的顺序存储结构(循环队列) */

// can_queue_tag can_tx_queue;
// can_queue_tag can_rx_queue;

// /****************************************************
//  *  函 数 名：init_queue
//  *  函数功能：初始化队列
//  *  入口参数：无
//  *  说    明：
//  ****************************************************/
// void queue_init(p_can_queue_tag p_queue)
// {                                      /* 构造一个空队列Q */
//     p_queue->head = p_queue->tail = 0; /*空队列*/
//     p_queue->count                = 0;
// }

// /****************************************************
//  *  函 数 名：is_queue_empty
//  *  函数功能：查询队列是否为空
//  *  入口参数：Q 队列
//  *  说    明：空队列，返回SUCCESS；否则返回ERROR
//  ****************************************************/
// uint8_t queue_empty(p_can_queue_tag p_queue)
// { /* 若*/
//     return p_queue->count == 0;
// }

// uint8_t queue_full(p_can_queue_tag p_queue)
// { /* 若*/
//     return p_queue->count == MAX_QSIZE;
// }

// /****************************************************
//  *  函 数 名：queue_length
//  *  函数功能：初始化长度
//  *  入口参数：Q 队列
//  *  说    明：
//  ****************************************************/
// uint16_t queue_length(can_queue_tag p_queue)
// { /* 返回Q的元素个数，即队列的长度 */
//     return (p_queue.tail - p_queue.head + MAX_QSIZE) % MAX_QSIZE;
// }

// /****************************************************
//  *  函 数 名：get_head
//  *  函数功能：获取对头数据
//  *  入口参数：Q 队列
//  *  说    明：
//  ****************************************************/
// uint8_t get_head(
//     can_queue_tag *p_queue,
//     pdu_tag       *e)
// {                                       /* 若队列不空，则用e返回Q的队头元素，并返回OK；否则返回ERROR*/
//     if (p_queue->head == p_queue->tail) /* 队列空 */
//         return Q_ERR;
//     *e = p_queue->can_message[p_queue->head];

//     p_queue->head = (p_queue->head + 1) % MAX_QSIZE;
//     return Q_OK;
// }

// /****************************************************
//  *  函 数 名：insert_queue
//  *  函数功能：队列插入数据
//  *  入口参数：Q 待插入队列    e 待插入数据
//  *  说    明：
//  ****************************************************/
// QUEUE_STATUS en_queue(p_can_queue_tag p_queue,
//                       pdu_tag         data)
// {
//     if (queue_full(p_queue))
//         return Q_FULL;
//     p_queue->count++;
//     p_queue->can_message[p_queue->head] = data;
//     p_queue->head                       = (p_queue->head + 1) % MAX_QSIZE;
//     return Q_OK;
//     /* 插入元素e为Q的新的队尾元素 */
//     // if ((p_queue->tail + 1) % MAX_QSIZE == p_queue->head) /* 队列满 */
//     //     return ERROR;
//     // p_queue->can_message[p_queue->tail] = e;
//     // p_queue->tail                       = (p_queue->tail + 1) % MAX_QSIZE;
//     // return SUCCESS;
// }

// QUEUE_STATUS de_queue(p_can_queue_tag p_queue,
//                       pdu_tag         data)
// { /* 插入元素e为Q的新的队尾元素 */
//     // if ((p_queue->tail + 1) % MAX_QSIZE == p_queue->head) /* 队列满 */
//     //     return ERROR;
//     // p_queue->can_message[p_queue->tail] = e;
//     // p_queue->tail                       = (p_queue->tail + 1) % MAX_QSIZE;
//     // return SUCCESS;
//     if (queue_empty(p_queue))
//         return Q_EMPTY;
//     data          = p_queue->can_message[p_queue->tail];
//     p_queue->tail = (p_queue->tail + 1) % MAX_QSIZE;
//     p_queue->count--;

//     return Q_OK;
// }