123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226 |
- /*----------------------------------------------------------------------------
- * Copyright (c) <2018>, <Huawei Technologies Co., Ltd>
- * All rights reserved.
- * Redistribution and use in source and binary forms, with or without modification,
- * are permitted provided that the following conditions are met:
- * 1. Redistributions of source code must retain the above copyright notice, this list of
- * conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright notice, this list
- * of conditions and the following disclaimer in the documentation and/or other materials
- * provided with the distribution.
- * 3. Neither the name of the copyright holder nor the names of its contributors may be used
- * to endorse or promote products derived from this software without specific prior written
- * permission.
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
- * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
- * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
- * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
- * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
- * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
- * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
- * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
- * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
- * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *---------------------------------------------------------------------------*/
- /*----------------------------------------------------------------------------
- * Notice of Export Control Law
- * ===============================================
- * Huawei LiteOS may be subject to applicable export control laws and regulations, which might
- * include those applicable to Huawei LiteOS of U.S. and the country in which you are located.
- * Import, export and usage of Huawei LiteOS in any manner by you shall be in compliance with such
- * applicable export control laws and regulations.
- *---------------------------------------------------------------------------*/
- /**
- * DATE AUTHOR INSTRUCTION
- * 2019-09-16 18:27 zhangqianfu The first version
- *
- */
- #include <stdlib.h>
- #include <stdio.h>
- #include <string.h>
- #include "cmsis_os2.h"
- #include "queue.h"
- queue_t* queue_create(const char *name,int len,int syncmode)
- {
- queue_t *ret;
- ret = malloc(sizeof(queue_t) + len*sizeof(void *));
- if(NULL == ret)
- {
- goto EXIT_MEM;
- }
- (void) memset(ret,0,sizeof(queue_t));
- ret->name = name;
- ret->msg_buflen = len;
- ret->msg_buf = (void **)(uintptr_t)((uint8_t *)ret + sizeof(queue_t));
- ret->sync_mode = syncmode;
- if(0 == syncmode)
- {
- goto EXIT_OK;
- }
- ret->sync_read = osSemaphoreNew(len, 0, NULL);
- if(ret->sync_read == NULL)
- {
- goto EXIT_SYNCREAD;
- }
- ret->sync_write = osSemaphoreNew(len, len, NULL);
- if(ret->sync_write == NULL)
- {
- goto EXIT_SYNCWRITE;
- }
- ret->lock = osMutexNew(NULL);
- if(ret->lock == NULL)
- {
- goto EXIT_LOCK;
- }
- EXIT_OK:
- return ret;
- EXIT_LOCK:
- (void) osSemaphoreDelete(ret->sync_write);
- EXIT_SYNCWRITE:
- (void) osSemaphoreDelete(ret->sync_read);
- EXIT_SYNCREAD:
- free(ret);
- ret = NULL;
- EXIT_MEM:
- ret = NULL;
- return ret;
- }
- static int raw_queue_pushdata(queue_t *queue,void *data)
- {
- int ret = -1;
- if(queue->msg_num < queue->msg_buflen)
- {
- queue->msg_buf[queue->cur_write] = data;
- queue->cur_write = (queue->cur_write + 1)%queue->msg_buflen;
- queue->msg_num ++;
- ret = 0;
- }
- return ret;
- }
- ///< push a data to the queue, 0 success while -1 failed
- int queue_push(queue_t *queue,void *data,int timeout)
- {
- int ret = -1;
- if((NULL == queue) || (NULL == data))
- {
- return ret;
- }
- if(queue->sync_mode)
- {
- ret = osSemaphoreAcquire(queue->sync_write,timeout);
- if(ret == osOK)
- {
- ret =osMutexAcquire(queue->lock,osWaitForever);
- if(ret == osOK)
- {
- ret = raw_queue_pushdata(queue,data);
- (void) osMutexRelease(queue->lock);
- }
- if(0 == ret)
- {
- (void) osSemaphoreRelease(queue->sync_read);
- }
- }
- }
- else
- {
- ret = raw_queue_pushdata(queue,data);
- }
- return ret;
- }
- ///< pop a data from the queue
- static int raw_queue_pop(queue_t *queue,void **buf)
- {
- int ret = -1;
- if(queue->msg_num > 0)
- {
- *buf = queue->msg_buf[queue->cur_read];
- queue->cur_read = (queue->cur_read +1)%queue->msg_buflen;
- queue->msg_num--;
- ret = 0;
- }
- return ret;
- }
- int queue_pop(queue_t *queue,void **buf, int timeout)
- {
- int ret = -1;
- if((NULL == queue) || (NULL == buf))
- {
- return ret;
- }
- if(queue->sync_mode)
- {
- ret = osSemaphoreAcquire(queue->sync_read,timeout);
- if(ret == osOK)
- {
- ret = osMutexAcquire(queue->lock,osWaitForever);
- if(ret == osOK)
- {
- ret = raw_queue_pop(queue,buf);
- (void) osMutexRelease(queue->lock);
- }
- if(0 == ret)
- {
- (void) osSemaphoreRelease(queue->sync_write);
- }
- }
- }
- else
- {
- ret = raw_queue_pop(queue,buf);
- }
- return ret;
- }
- ///< delete the queue,if any data in the queue, which means could not kill it
- int queue_delete(queue_t *queue)
- {
- int ret = -1;
- if((NULL == queue))
- {
- return ret;
- }
- if(queue->sync_mode)
- {
- (void) osSemaphoreDelete(queue->sync_read);
- (void) osSemaphoreDelete(queue->sync_write);
- (void) osMutexDelete(queue->lock);
- }
- free(queue);
- ret = 0;
- return ret;
- }
|