Maxim Integrated / MAX30001EVSYSKIT

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.

HSP/RpcServer/RpcFifo.cpp@1:957e5bad16c2, 2018-06-27 (annotated)

Committer:
Emre.Eken
Date:
Wed Jun 27 14:17:34 2018 +0300
Revision:
1:957e5bad16c2
first rev

Who changed what in which revision?

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