Darien Figueroa / Mbed 2 deprecated repo3

repo time

Dependencies:   mbed MAX14720 MAX30205 USBDevice

e4a10ed6eb92/HSP/RpcServer/RpcFifo.cpp@20:6d2af70c92ab, 2021-04-06 (annotated)

Committer:
darienf
Date:
Tue Apr 06 06:41:40 2021 +0000
Revision:
20:6d2af70c92ab
another repo

Who changed what in which revision?

UserRevisionLine numberNew contents of line
darienf 20:6d2af70c92ab 1 /*******************************************************************************
darienf 20:6d2af70c92ab 2 * Copyright (C) 2016 Maxim Integrated Products, Inc., All Rights Reserved.
darienf 20:6d2af70c92ab 3 *
darienf 20:6d2af70c92ab 4 * Permission is hereby granted, free of charge, to any person obtaining a
darienf 20:6d2af70c92ab 5 * copy of this software and associated documentation files (the "Software"),
darienf 20:6d2af70c92ab 6 * to deal in the Software without restriction, including without limitation
darienf 20:6d2af70c92ab 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
darienf 20:6d2af70c92ab 8 * and/or sell copies of the Software, and to permit persons to whom the
darienf 20:6d2af70c92ab 9 * Software is furnished to do so, subject to the following conditions:
darienf 20:6d2af70c92ab 10 *
darienf 20:6d2af70c92ab 11 * The above copyright notice and this permission notice shall be included
darienf 20:6d2af70c92ab 12 * in all copies or substantial portions of the Software.
darienf 20:6d2af70c92ab 13 *
darienf 20:6d2af70c92ab 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
darienf 20:6d2af70c92ab 15 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
darienf 20:6d2af70c92ab 16 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
darienf 20:6d2af70c92ab 17 * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
darienf 20:6d2af70c92ab 18 * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
darienf 20:6d2af70c92ab 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
darienf 20:6d2af70c92ab 20 * OTHER DEALINGS IN THE SOFTWARE.
darienf 20:6d2af70c92ab 21 *
darienf 20:6d2af70c92ab 22 * Except as contained in this notice, the name of Maxim Integrated
darienf 20:6d2af70c92ab 23 * Products, Inc. shall not be used except as stated in the Maxim Integrated
darienf 20:6d2af70c92ab 24 * Products, Inc. Branding Policy.
darienf 20:6d2af70c92ab 25 *
darienf 20:6d2af70c92ab 26 * The mere transfer of this software does not imply any licenses
darienf 20:6d2af70c92ab 27 * of trade secrets, proprietary technology, copyrights, patents,
darienf 20:6d2af70c92ab 28 * trademarks, maskwork rights, or any other form of intellectual
darienf 20:6d2af70c92ab 29 * property whatsoever. Maxim Integrated Products, Inc. retains all
darienf 20:6d2af70c92ab 30 * ownership rights.
darienf 20:6d2af70c92ab 31 *******************************************************************************
darienf 20:6d2af70c92ab 32 */
darienf 20:6d2af70c92ab 33 #include "mbed.h"
darienf 20:6d2af70c92ab 34 #include "RpcFifo.h"
darienf 20:6d2af70c92ab 35
darienf 20:6d2af70c92ab 36 /****************************************************************************/
darienf 20:6d2af70c92ab 37 void fifo_init(fifo_t *fifo, void *mem, unsigned int length) {
darienf 20:6d2af70c92ab 38 // atomic FIFO access
darienf 20:6d2af70c92ab 39 __disable_irq();
darienf 20:6d2af70c92ab 40
darienf 20:6d2af70c92ab 41 fifo->rindex = 0;
darienf 20:6d2af70c92ab 42 fifo->windex = 0;
darienf 20:6d2af70c92ab 43 fifo->data = mem;
darienf 20:6d2af70c92ab 44 fifo->length = length;
darienf 20:6d2af70c92ab 45
darienf 20:6d2af70c92ab 46 __enable_irq();
darienf 20:6d2af70c92ab 47 }
darienf 20:6d2af70c92ab 48
darienf 20:6d2af70c92ab 49 /****************************************************************************/
darienf 20:6d2af70c92ab 50 int fifo_put8(fifo_t *fifo, uint8_t element) {
darienf 20:6d2af70c92ab 51 // Check if FIFO is full
darienf 20:6d2af70c92ab 52 if ((fifo->windex == (fifo->rindex - 1)) ||
darienf 20:6d2af70c92ab 53 ((fifo->rindex == 0) && (fifo->windex == (fifo->length - 1)))) {
darienf 20:6d2af70c92ab 54 return -1;
darienf 20:6d2af70c92ab 55 }
darienf 20:6d2af70c92ab 56
darienf 20:6d2af70c92ab 57 // atomic FIFO access
darienf 20:6d2af70c92ab 58 __disable_irq();
darienf 20:6d2af70c92ab 59
darienf 20:6d2af70c92ab 60 // Put data into FIFO
darienf 20:6d2af70c92ab 61 ((uint8_t *)(fifo->data))[fifo->windex] = element;
darienf 20:6d2af70c92ab 62
darienf 20:6d2af70c92ab 63 // Increment pointer
darienf 20:6d2af70c92ab 64 fifo->windex++;
darienf 20:6d2af70c92ab 65 if (fifo->windex == fifo->length) {
darienf 20:6d2af70c92ab 66 fifo->windex = 0;
darienf 20:6d2af70c92ab 67 }
darienf 20:6d2af70c92ab 68
darienf 20:6d2af70c92ab 69 __enable_irq();
darienf 20:6d2af70c92ab 70
darienf 20:6d2af70c92ab 71 return 0;
darienf 20:6d2af70c92ab 72 }
darienf 20:6d2af70c92ab 73
darienf 20:6d2af70c92ab 74 /****************************************************************************/
darienf 20:6d2af70c92ab 75 int fifo_get8(fifo_t *fifo, uint8_t *element) {
darienf 20:6d2af70c92ab 76 // Check if FIFO is empty
darienf 20:6d2af70c92ab 77 if (fifo->rindex == fifo->windex)
darienf 20:6d2af70c92ab 78 return -1;
darienf 20:6d2af70c92ab 79
darienf 20:6d2af70c92ab 80 // atomic FIFO access
darienf 20:6d2af70c92ab 81 __disable_irq();
darienf 20:6d2af70c92ab 82
darienf 20:6d2af70c92ab 83 // Get data from FIFO
darienf 20:6d2af70c92ab 84 *element = ((uint8_t *)(fifo->data))[fifo->rindex];
darienf 20:6d2af70c92ab 85
darienf 20:6d2af70c92ab 86 // Increment pointer
darienf 20:6d2af70c92ab 87 fifo->rindex++;
darienf 20:6d2af70c92ab 88 if (fifo->rindex == fifo->length) {
darienf 20:6d2af70c92ab 89 fifo->rindex = 0;
darienf 20:6d2af70c92ab 90 }
darienf 20:6d2af70c92ab 91
darienf 20:6d2af70c92ab 92 __enable_irq();
darienf 20:6d2af70c92ab 93
darienf 20:6d2af70c92ab 94 return 0;
darienf 20:6d2af70c92ab 95 }
darienf 20:6d2af70c92ab 96
darienf 20:6d2af70c92ab 97 /****************************************************************************/
darienf 20:6d2af70c92ab 98 int fifo_put16(fifo_t *fifo, uint16_t element) {
darienf 20:6d2af70c92ab 99 // Check if FIFO is full
darienf 20:6d2af70c92ab 100 if ((fifo->windex == (fifo->rindex - 1)) ||
darienf 20:6d2af70c92ab 101 ((fifo->rindex == 0) && (fifo->windex == (fifo->length - 1)))) {
darienf 20:6d2af70c92ab 102 return -1;
darienf 20:6d2af70c92ab 103 }
darienf 20:6d2af70c92ab 104
darienf 20:6d2af70c92ab 105 // atomic FIFO access
darienf 20:6d2af70c92ab 106 __disable_irq();
darienf 20:6d2af70c92ab 107
darienf 20:6d2af70c92ab 108 // Put data into FIFO
darienf 20:6d2af70c92ab 109 ((uint16_t *)(fifo->data))[fifo->windex] = element;
darienf 20:6d2af70c92ab 110
darienf 20:6d2af70c92ab 111 // Increment pointer
darienf 20:6d2af70c92ab 112 fifo->windex++;
darienf 20:6d2af70c92ab 113 if (fifo->windex == fifo->length) {
darienf 20:6d2af70c92ab 114 fifo->windex = 0;
darienf 20:6d2af70c92ab 115 }
darienf 20:6d2af70c92ab 116
darienf 20:6d2af70c92ab 117 __enable_irq();
darienf 20:6d2af70c92ab 118
darienf 20:6d2af70c92ab 119 return 0;
darienf 20:6d2af70c92ab 120 }
darienf 20:6d2af70c92ab 121
darienf 20:6d2af70c92ab 122 /****************************************************************************/
darienf 20:6d2af70c92ab 123 int fifo_get16(fifo_t *fifo, uint16_t *element) {
darienf 20:6d2af70c92ab 124 // Check if FIFO is empty
darienf 20:6d2af70c92ab 125 if (fifo->rindex == fifo->windex)
darienf 20:6d2af70c92ab 126 return -1;
darienf 20:6d2af70c92ab 127
darienf 20:6d2af70c92ab 128 // atomic FIFO access
darienf 20:6d2af70c92ab 129 __disable_irq();
darienf 20:6d2af70c92ab 130
darienf 20:6d2af70c92ab 131 // Get data from FIFO
darienf 20:6d2af70c92ab 132 *element = ((uint16_t *)(fifo->data))[fifo->rindex];
darienf 20:6d2af70c92ab 133
darienf 20:6d2af70c92ab 134 // Increment pointer
darienf 20:6d2af70c92ab 135 fifo->rindex++;
darienf 20:6d2af70c92ab 136 if (fifo->rindex == fifo->length) {
darienf 20:6d2af70c92ab 137 fifo->rindex = 0;
darienf 20:6d2af70c92ab 138 }
darienf 20:6d2af70c92ab 139
darienf 20:6d2af70c92ab 140 __enable_irq();
darienf 20:6d2af70c92ab 141
darienf 20:6d2af70c92ab 142 return 0;
darienf 20:6d2af70c92ab 143 }
darienf 20:6d2af70c92ab 144
darienf 20:6d2af70c92ab 145 /****************************************************************************/
darienf 20:6d2af70c92ab 146 int fifo_put32(fifo_t *fifo, uint32_t element) {
darienf 20:6d2af70c92ab 147 // Check if FIFO is full
darienf 20:6d2af70c92ab 148 if ((fifo->windex == (fifo->rindex - 1)) ||
darienf 20:6d2af70c92ab 149 ((fifo->rindex == 0) && (fifo->windex == (fifo->length - 1)))) {
darienf 20:6d2af70c92ab 150 return -1;
darienf 20:6d2af70c92ab 151 }
darienf 20:6d2af70c92ab 152
darienf 20:6d2af70c92ab 153 // atomic FIFO access
darienf 20:6d2af70c92ab 154 __disable_irq();
darienf 20:6d2af70c92ab 155
darienf 20:6d2af70c92ab 156 // Put data into FIFO
darienf 20:6d2af70c92ab 157 ((uint32_t *)(fifo->data))[fifo->windex] = element;
darienf 20:6d2af70c92ab 158
darienf 20:6d2af70c92ab 159 // Increment pointer
darienf 20:6d2af70c92ab 160 fifo->windex++;
darienf 20:6d2af70c92ab 161 if (fifo->windex == fifo->length) {
darienf 20:6d2af70c92ab 162 fifo->windex = 0;
darienf 20:6d2af70c92ab 163 }
darienf 20:6d2af70c92ab 164
darienf 20:6d2af70c92ab 165 __enable_irq();
darienf 20:6d2af70c92ab 166
darienf 20:6d2af70c92ab 167 return 0;
darienf 20:6d2af70c92ab 168 }
darienf 20:6d2af70c92ab 169
darienf 20:6d2af70c92ab 170 /****************************************************************************/
darienf 20:6d2af70c92ab 171 int fifo_get32(fifo_t *fifo, uint32_t *element) {
darienf 20:6d2af70c92ab 172 // Check if FIFO is empty
darienf 20:6d2af70c92ab 173 if (fifo->rindex == fifo->windex)
darienf 20:6d2af70c92ab 174 return -1;
darienf 20:6d2af70c92ab 175
darienf 20:6d2af70c92ab 176 // atomic FIFO access
darienf 20:6d2af70c92ab 177 __disable_irq();
darienf 20:6d2af70c92ab 178
darienf 20:6d2af70c92ab 179 // Get data from FIFO
darienf 20:6d2af70c92ab 180 *element = ((uint32_t *)(fifo->data))[fifo->rindex];
darienf 20:6d2af70c92ab 181
darienf 20:6d2af70c92ab 182 // Increment pointer
darienf 20:6d2af70c92ab 183 fifo->rindex++;
darienf 20:6d2af70c92ab 184 if (fifo->rindex == fifo->length) {
darienf 20:6d2af70c92ab 185 fifo->rindex = 0;
darienf 20:6d2af70c92ab 186 }
darienf 20:6d2af70c92ab 187
darienf 20:6d2af70c92ab 188 __enable_irq();
darienf 20:6d2af70c92ab 189
darienf 20:6d2af70c92ab 190 return 0;
darienf 20:6d2af70c92ab 191 }
darienf 20:6d2af70c92ab 192 /****************************************************************************/
darienf 20:6d2af70c92ab 193 void fifo_clear(fifo_t *fifo) {
darienf 20:6d2af70c92ab 194 // atomic FIFO access
darienf 20:6d2af70c92ab 195 __disable_irq();
darienf 20:6d2af70c92ab 196
darienf 20:6d2af70c92ab 197 fifo->rindex = 0;
darienf 20:6d2af70c92ab 198 fifo->windex = 0;
darienf 20:6d2af70c92ab 199
darienf 20:6d2af70c92ab 200 __enable_irq();
darienf 20:6d2af70c92ab 201 }
darienf 20:6d2af70c92ab 202
darienf 20:6d2af70c92ab 203 /****************************************************************************/
darienf 20:6d2af70c92ab 204 int fifo_empty(fifo_t *fifo) { return (fifo->rindex == fifo->windex); }
darienf 20:6d2af70c92ab 205
darienf 20:6d2af70c92ab 206 /****************************************************************************/
darienf 20:6d2af70c92ab 207 int fifo_full(fifo_t *fifo) {
darienf 20:6d2af70c92ab 208 int retval;
darienf 20:6d2af70c92ab 209
darienf 20:6d2af70c92ab 210 // atomic FIFO access
darienf 20:6d2af70c92ab 211 __disable_irq();
darienf 20:6d2af70c92ab 212 retval = ((fifo->windex == (fifo->rindex - 1)) ||
darienf 20:6d2af70c92ab 213 ((fifo->rindex == 0) && (fifo->windex == (fifo->length - 1))));
darienf 20:6d2af70c92ab 214 __enable_irq();
darienf 20:6d2af70c92ab 215
darienf 20:6d2af70c92ab 216 return retval;
darienf 20:6d2af70c92ab 217 }
darienf 20:6d2af70c92ab 218
darienf 20:6d2af70c92ab 219 /****************************************************************************/
darienf 20:6d2af70c92ab 220 unsigned int fifo_level(fifo_t *fifo) {
darienf 20:6d2af70c92ab 221 uint16_t value;
darienf 20:6d2af70c92ab 222
darienf 20:6d2af70c92ab 223 // atomic FIFO access
darienf 20:6d2af70c92ab 224 __disable_irq();
darienf 20:6d2af70c92ab 225
darienf 20:6d2af70c92ab 226 if (fifo->windex >= fifo->rindex) {
darienf 20:6d2af70c92ab 227 value = fifo->windex - fifo->rindex;
darienf 20:6d2af70c92ab 228 } else {
darienf 20:6d2af70c92ab 229 value = fifo->length - fifo->rindex + fifo->windex;
darienf 20:6d2af70c92ab 230 }
darienf 20:6d2af70c92ab 231
darienf 20:6d2af70c92ab 232 __enable_irq();
darienf 20:6d2af70c92ab 233
darienf 20:6d2af70c92ab 234 return value;
darienf 20:6d2af70c92ab 235 }
darienf 20:6d2af70c92ab 236
darienf 20:6d2af70c92ab 237 /****************************************************************************/
darienf 20:6d2af70c92ab 238 unsigned int fifo_remaining(fifo_t *fifo) {
darienf 20:6d2af70c92ab 239 uint16_t value;
darienf 20:6d2af70c92ab 240
darienf 20:6d2af70c92ab 241 // atomic FIFO access
darienf 20:6d2af70c92ab 242 __disable_irq();
darienf 20:6d2af70c92ab 243
darienf 20:6d2af70c92ab 244 if (fifo->rindex > fifo->windex) {
darienf 20:6d2af70c92ab 245 value = fifo->rindex - fifo->windex - 1;
darienf 20:6d2af70c92ab 246 } else {
darienf 20:6d2af70c92ab 247 value = fifo->length - fifo->windex + fifo->rindex - 1;
darienf 20:6d2af70c92ab 248 }
darienf 20:6d2af70c92ab 249
darienf 20:6d2af70c92ab 250 __enable_irq();
darienf 20:6d2af70c92ab 251
darienf 20:6d2af70c92ab 252 return value;
darienf 20:6d2af70c92ab 253 }