Pratyush Mallick / Mbed OS testing

this is testing

app/noos_mbed/util/fifo.c@0:3afcd581558d, 2021-01-14 (annotated)

Committer:
pmallick
Date:
Thu Jan 14 18:54:16 2021 +0530
Revision:
0:3afcd581558d
this is testing

Who changed what in which revision?

UserRevisionLine numberNew contents of line
pmallick 0:3afcd581558d 1 /***************************************************************************//**
pmallick 0:3afcd581558d 2 * @file fifo.c
pmallick 0:3afcd581558d 3 * @brief Implementation of fifo.
pmallick 0:3afcd581558d 4 * @author Cristian Pop (cristian.pop@analog.com)
pmallick 0:3afcd581558d 5 ********************************************************************************
pmallick 0:3afcd581558d 6 * Copyright 2019(c) Analog Devices, Inc.
pmallick 0:3afcd581558d 7 *
pmallick 0:3afcd581558d 8 * All rights reserved.
pmallick 0:3afcd581558d 9 *
pmallick 0:3afcd581558d 10 * Redistribution and use in source and binary forms, with or without
pmallick 0:3afcd581558d 11 * modification, are permitted provided that the following conditions are met:
pmallick 0:3afcd581558d 12 * - Redistributions of source code must retain the above copyright
pmallick 0:3afcd581558d 13 * notice, this list of conditions and the following disclaimer.
pmallick 0:3afcd581558d 14 * - Redistributions in binary form must reproduce the above copyright
pmallick 0:3afcd581558d 15 * notice, this list of conditions and the following disclaimer in
pmallick 0:3afcd581558d 16 * the documentation and/or other materials provided with the
pmallick 0:3afcd581558d 17 * distribution.
pmallick 0:3afcd581558d 18 * - Neither the name of Analog Devices, Inc. nor the names of its
pmallick 0:3afcd581558d 19 * contributors may be used to endorse or promote products derived
pmallick 0:3afcd581558d 20 * from this software without specific prior written permission.
pmallick 0:3afcd581558d 21 * - The use of this software may or may not infringe the patent rights
pmallick 0:3afcd581558d 22 * of one or more patent holders. This license does not release you
pmallick 0:3afcd581558d 23 * from the requirement that you obtain separate licenses from these
pmallick 0:3afcd581558d 24 * patent holders to use this software.
pmallick 0:3afcd581558d 25 * - Use of the software either in source or binary form, must be run
pmallick 0:3afcd581558d 26 * on or directly connected to an Analog Devices Inc. component.
pmallick 0:3afcd581558d 27 *
pmallick 0:3afcd581558d 28 * THIS SOFTWARE IS PROVIDED BY ANALOG DEVICES "AS IS" AND ANY EXPRESS OR
pmallick 0:3afcd581558d 29 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, NON-INFRINGEMENT,
pmallick 0:3afcd581558d 30 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
pmallick 0:3afcd581558d 31 * IN NO EVENT SHALL ANALOG DEVICES BE LIABLE FOR ANY DIRECT, INDIRECT,
pmallick 0:3afcd581558d 32 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
pmallick 0:3afcd581558d 33 * LIMITED TO, INTELLECTUAL PROPERTY RIGHTS, PROCUREMENT OF SUBSTITUTE GOODS OR
pmallick 0:3afcd581558d 34 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
pmallick 0:3afcd581558d 35 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
pmallick 0:3afcd581558d 36 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
pmallick 0:3afcd581558d 37 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
pmallick 0:3afcd581558d 38 *******************************************************************************/
pmallick 0:3afcd581558d 39
pmallick 0:3afcd581558d 40 /******************************************************************************/
pmallick 0:3afcd581558d 41 /***************************** Include Files **********************************/
pmallick 0:3afcd581558d 42 /******************************************************************************/
pmallick 0:3afcd581558d 43
pmallick 0:3afcd581558d 44 #include <string.h>
pmallick 0:3afcd581558d 45 #include <stdlib.h>
pmallick 0:3afcd581558d 46 #include "fifo.h"
pmallick 0:3afcd581558d 47 #include "error.h"
pmallick 0:3afcd581558d 48
pmallick 0:3afcd581558d 49 /******************************************************************************/
pmallick 0:3afcd581558d 50 /************************ Functions Definitions *******************************/
pmallick 0:3afcd581558d 51 /******************************************************************************/
pmallick 0:3afcd581558d 52
pmallick 0:3afcd581558d 53 /**
pmallick 0:3afcd581558d 54 * @brief Create new fifo element
pmallick 0:3afcd581558d 55 * @param buff - Data to be saved in fifo.
pmallick 0:3afcd581558d 56 * @param len - Length of the data.
pmallick 0:3afcd581558d 57 * @return fifo element in case of success, NULL otherwise
pmallick 0:3afcd581558d 58 */
pmallick 0:3afcd581558d 59 static struct fifo_element * fifo_new_element(char *buff, uint32_t len)
pmallick 0:3afcd581558d 60 {
pmallick 0:3afcd581558d 61 struct fifo_element *q = calloc(1, sizeof(struct fifo_element));
pmallick 0:3afcd581558d 62 if (!q)
pmallick 0:3afcd581558d 63 return NULL;
pmallick 0:3afcd581558d 64
pmallick 0:3afcd581558d 65 q->len = len;
pmallick 0:3afcd581558d 66 q->data = calloc(1, len);
pmallick 0:3afcd581558d 67 if (!(q->data)) {
pmallick 0:3afcd581558d 68 free(q);
pmallick 0:3afcd581558d 69 return NULL;
pmallick 0:3afcd581558d 70 }
pmallick 0:3afcd581558d 71 memcpy(q->data, buff, len);
pmallick 0:3afcd581558d 72
pmallick 0:3afcd581558d 73 return q;
pmallick 0:3afcd581558d 74 }
pmallick 0:3afcd581558d 75
pmallick 0:3afcd581558d 76 /**
pmallick 0:3afcd581558d 77 * @brief Get last element in fifo
pmallick 0:3afcd581558d 78 * @param p_fifo - pointer to fifo
pmallick 0:3afcd581558d 79 * @return fifo last element if exists, NULL otherwise
pmallick 0:3afcd581558d 80 */
pmallick 0:3afcd581558d 81 static struct fifo_element *fifo_get_last(struct fifo_element *p_fifo)
pmallick 0:3afcd581558d 82 {
pmallick 0:3afcd581558d 83 if(p_fifo == NULL)
pmallick 0:3afcd581558d 84 return NULL;
pmallick 0:3afcd581558d 85 while (p_fifo->next) {
pmallick 0:3afcd581558d 86 p_fifo = p_fifo->next;
pmallick 0:3afcd581558d 87 }
pmallick 0:3afcd581558d 88
pmallick 0:3afcd581558d 89 return p_fifo;
pmallick 0:3afcd581558d 90 }
pmallick 0:3afcd581558d 91
pmallick 0:3afcd581558d 92 /**
pmallick 0:3afcd581558d 93 * @brief Insert element to fifo, in the last position.
pmallick 0:3afcd581558d 94 * @param p_fifo - Pointer to fifo.
pmallick 0:3afcd581558d 95 * @param buff - Data to be saved in fifo.
pmallick 0:3afcd581558d 96 * @param len - Length of the data.
pmallick 0:3afcd581558d 97 * @return SUCCESS in case of success, FAILURE otherwise
pmallick 0:3afcd581558d 98 */
pmallick 0:3afcd581558d 99 int32_t fifo_insert(struct fifo_element **p_fifo, char *buff, uint32_t len)
pmallick 0:3afcd581558d 100 {
pmallick 0:3afcd581558d 101 struct fifo_element *p, *q;
pmallick 0:3afcd581558d 102
pmallick 0:3afcd581558d 103 if (len <= 0)
pmallick 0:3afcd581558d 104 return FAILURE;
pmallick 0:3afcd581558d 105
pmallick 0:3afcd581558d 106 q = fifo_new_element(buff, len);
pmallick 0:3afcd581558d 107 if (!q)
pmallick 0:3afcd581558d 108 return FAILURE;
pmallick 0:3afcd581558d 109
pmallick 0:3afcd581558d 110 if (!(*p_fifo)) {
pmallick 0:3afcd581558d 111 *p_fifo = q;
pmallick 0:3afcd581558d 112 } else {
pmallick 0:3afcd581558d 113 p = fifo_get_last(*p_fifo);
pmallick 0:3afcd581558d 114 p->next = q;
pmallick 0:3afcd581558d 115 }
pmallick 0:3afcd581558d 116
pmallick 0:3afcd581558d 117 return SUCCESS;
pmallick 0:3afcd581558d 118 }
pmallick 0:3afcd581558d 119
pmallick 0:3afcd581558d 120 /**
pmallick 0:3afcd581558d 121 * @brief Remove fifo head
pmallick 0:3afcd581558d 122 * @param p_fifo - Pointer to fifo.
pmallick 0:3afcd581558d 123 * @return next element in fifo if exists, NULL otherwise.
pmallick 0:3afcd581558d 124 */
pmallick 0:3afcd581558d 125 struct fifo_element * fifo_remove(struct fifo_element *p_fifo)
pmallick 0:3afcd581558d 126 {
pmallick 0:3afcd581558d 127 struct fifo_element *p = p_fifo;
pmallick 0:3afcd581558d 128
pmallick 0:3afcd581558d 129 if (p_fifo != NULL) {
pmallick 0:3afcd581558d 130 p_fifo = p_fifo->next;
pmallick 0:3afcd581558d 131 free(p->data);
pmallick 0:3afcd581558d 132 free(p);
pmallick 0:3afcd581558d 133 }
pmallick 0:3afcd581558d 134
pmallick 0:3afcd581558d 135 return p_fifo;
pmallick 0:3afcd581558d 136 }