Darien Figueroa / Mbed OS Final_Program

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   USBDevice

MAXREFDES100FW300/e4a10ed6eb92/HSP/RpcServer/RpcFifo.cpp@3:36de8b9e4b1a, 2021-04-10 (annotated)

Committer:
darienf
Date:
Sat Apr 10 03:05:42 2021 +0000
Revision:
3:36de8b9e4b1a
Parent:
HSP/RpcServer/RpcFifo.cpp@0:832122ce6748 
ayoooo

Who changed what in which revision?

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