aurelio carella / Mbed OS mbed-os-example-ble-GattServer_ECG

20200716 read Status Register each second

Dependencies:   SDFileSystem mbed-os-example-ble-GattServer max32630fthr

HSP/RpcServer/Streaming.cpp@21:51e162c130a9, 2020-07-16 (annotated)

Committer:
aureliocarella
Date:
Thu Jul 16 14:59:04 2020 +0000
Revision:
21:51e162c130a9
20200716

Who changed what in which revision?

UserRevisionLine numberNew contents of line
aureliocarella 21:51e162c130a9 1 /*******************************************************************************
aureliocarella 21:51e162c130a9 2 * Copyright (C) 2016 Maxim Integrated Products, Inc., All Rights Reserved.
aureliocarella 21:51e162c130a9 3 *
aureliocarella 21:51e162c130a9 4 * Permission is hereby granted, free of charge, to any person obtaining a
aureliocarella 21:51e162c130a9 5 * copy of this software and associated documentation files (the "Software"),
aureliocarella 21:51e162c130a9 6 * to deal in the Software without restriction, including without limitation
aureliocarella 21:51e162c130a9 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
aureliocarella 21:51e162c130a9 8 * and/or sell copies of the Software, and to permit persons to whom the
aureliocarella 21:51e162c130a9 9 * Software is furnished to do so, subject to the following conditions:
aureliocarella 21:51e162c130a9 10 *
aureliocarella 21:51e162c130a9 11 * The above copyright notice and this permission notice shall be included
aureliocarella 21:51e162c130a9 12 * in all copies or substantial portions of the Software.
aureliocarella 21:51e162c130a9 13 *
aureliocarella 21:51e162c130a9 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
aureliocarella 21:51e162c130a9 15 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
aureliocarella 21:51e162c130a9 16 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
aureliocarella 21:51e162c130a9 17 * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
aureliocarella 21:51e162c130a9 18 * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
aureliocarella 21:51e162c130a9 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
aureliocarella 21:51e162c130a9 20 * OTHER DEALINGS IN THE SOFTWARE.
aureliocarella 21:51e162c130a9 21 *
aureliocarella 21:51e162c130a9 22 * Except as contained in this notice, the name of Maxim Integrated
aureliocarella 21:51e162c130a9 23 * Products, Inc. shall not be used except as stated in the Maxim Integrated
aureliocarella 21:51e162c130a9 24 * Products, Inc. Branding Policy.
aureliocarella 21:51e162c130a9 25 *
aureliocarella 21:51e162c130a9 26 * The mere transfer of this software does not imply any licenses
aureliocarella 21:51e162c130a9 27 * of trade secrets, proprietary technology, copyrights, patents,
aureliocarella 21:51e162c130a9 28 * trademarks, maskwork rights, or any other form of intellectual
aureliocarella 21:51e162c130a9 29 * property whatsoever. Maxim Integrated Products, Inc. retains all
aureliocarella 21:51e162c130a9 30 * ownership rights.
aureliocarella 21:51e162c130a9 31 *******************************************************************************
aureliocarella 21:51e162c130a9 32 */
aureliocarella 21:51e162c130a9 33 #include "RpcServer.h"
aureliocarella 21:51e162c130a9 34 #include "RpcFifo.h"
aureliocarella 21:51e162c130a9 35 #include "Streaming.h"
aureliocarella 21:51e162c130a9 36 #include "Peripherals.h"
aureliocarella 21:51e162c130a9 37 #include "MAX30001.h"
aureliocarella 21:51e162c130a9 38 #include "Test_MAX30001.h"
aureliocarella 21:51e162c130a9 39 #include "Peripherals.h"
aureliocarella 21:51e162c130a9 40
aureliocarella 21:51e162c130a9 41 bool streaming = FALSE;
aureliocarella 21:51e162c130a9 42 bool dataLogging = FALSE;
aureliocarella 21:51e162c130a9 43
aureliocarella 21:51e162c130a9 44 /**
aureliocarella 21:51e162c130a9 45 * @brief Encodes a 0x55 0xAA signature and a simple checksum to the id byte in
aureliocarella 21:51e162c130a9 46 * the 32 bit field
aureliocarella 21:51e162c130a9 47 * @param id Streaming ID
aureliocarella 21:51e162c130a9 48 */
aureliocarella 21:51e162c130a9 49 uint32_t StreamIdChecksumCalculate(uint32_t id) {
aureliocarella 21:51e162c130a9 50 uint32_t sum;
aureliocarella 21:51e162c130a9 51 uint32_t calculated;
aureliocarella 21:51e162c130a9 52 sum = 0x55;
aureliocarella 21:51e162c130a9 53 sum += 0xAA;
aureliocarella 21:51e162c130a9 54 sum += id;
aureliocarella 21:51e162c130a9 55 sum &= 0xFF;
aureliocarella 21:51e162c130a9 56 sum = sum << 8;
aureliocarella 21:51e162c130a9 57 calculated = 0x55AA0000 + sum + id;
aureliocarella 21:51e162c130a9 58 return calculated;
aureliocarella 21:51e162c130a9 59 }
aureliocarella 21:51e162c130a9 60
aureliocarella 21:51e162c130a9 61 /**
aureliocarella 21:51e162c130a9 62 * @brief Creates a packet that will be streamed via USB or saved into flash
aureliocarella 21:51e162c130a9 63 * datalog memory
aureliocarella 21:51e162c130a9 64 * @brief the packet created will be inserted into a fifo to be streamed at a
aureliocarella 21:51e162c130a9 65 * later time
aureliocarella 21:51e162c130a9 66 * @param id Streaming ID
aureliocarella 21:51e162c130a9 67 * @param buffer Pointer to a uint32 array that contains the data to include in
aureliocarella 21:51e162c130a9 68 * the packet
aureliocarella 21:51e162c130a9 69 * @param number Number of elements in the buffer
aureliocarella 21:51e162c130a9 70 */
aureliocarella 21:51e162c130a9 71 void StreamPacketUint32(uint32_t id, uint32_t *buffer, uint32_t number) {
aureliocarella 21:51e162c130a9 72 uint32_t checksumId;
aureliocarella 21:51e162c130a9 73 if (streaming == TRUE || dataLogging == TRUE) {
aureliocarella 21:51e162c130a9 74 checksumId = StreamIdChecksumCalculate(id);
aureliocarella 21:51e162c130a9 75 StreamFifoId(checksumId);
aureliocarella 21:51e162c130a9 76 StreamFifoTimeStamp();
aureliocarella 21:51e162c130a9 77 StreamFifoLength(number);
aureliocarella 21:51e162c130a9 78 StreamFifoUint32Array(buffer, number);
aureliocarella 21:51e162c130a9 79 }
aureliocarella 21:51e162c130a9 80 if (testing_max30001 == 1) {
aureliocarella 21:51e162c130a9 81 if (id == MAX30001_DATA_ECG)
aureliocarella 21:51e162c130a9 82 testing_ecg_flags[TESTING_ECG_FLAG] = 1;
aureliocarella 21:51e162c130a9 83 if (id == MAX30001_DATA_BIOZ)
aureliocarella 21:51e162c130a9 84 testing_ecg_flags[TESTING_BIOZ_FLAG] = 1;
aureliocarella 21:51e162c130a9 85 if (id == MAX30001_DATA_PACE)
aureliocarella 21:51e162c130a9 86 testing_ecg_flags[TESTING_PACE_FLAG] = 1;
aureliocarella 21:51e162c130a9 87 if (id == MAX30001_DATA_RTOR)
aureliocarella 21:51e162c130a9 88 testing_ecg_flags[TESTING_RTOR_FLAG] = 1;
aureliocarella 21:51e162c130a9 89 }
aureliocarella 21:51e162c130a9 90 }
aureliocarella 21:51e162c130a9 91
aureliocarella 21:51e162c130a9 92 /**
aureliocarella 21:51e162c130a9 93 * @brief Insert a buffer into the out going fifo
aureliocarella 21:51e162c130a9 94 * @param buffer Array of uint32 to send to the fifo
aureliocarella 21:51e162c130a9 95 * @param len Length of the array
aureliocarella 21:51e162c130a9 96 */
aureliocarella 21:51e162c130a9 97 int StreamFifoUint32Array(uint32_t buffer[], uint32_t len) {
aureliocarella 21:51e162c130a9 98 int status;
aureliocarella 21:51e162c130a9 99 uint32_t i;
aureliocarella 21:51e162c130a9 100 for (i = 0; i < len; i++) {
aureliocarella 21:51e162c130a9 101 status = fifo_put32(GetStreamOutFifo(), buffer[i]);
aureliocarella 21:51e162c130a9 102 if (status == -1) {
aureliocarella 21:51e162c130a9 103 printf("FIFO_OF!");
aureliocarella 21:51e162c130a9 104 fflush(stdout);
aureliocarella 21:51e162c130a9 105 while (1)
aureliocarella 21:51e162c130a9 106 ;
aureliocarella 21:51e162c130a9 107 }
aureliocarella 21:51e162c130a9 108 }
aureliocarella 21:51e162c130a9 109 return 0;
aureliocarella 21:51e162c130a9 110 }
aureliocarella 21:51e162c130a9 111
aureliocarella 21:51e162c130a9 112 /**
aureliocarella 21:51e162c130a9 113 * @brief Insert a timestamp into the out going fifo
aureliocarella 21:51e162c130a9 114 */
aureliocarella 21:51e162c130a9 115 int StreamFifoTimeStamp(void) {
aureliocarella 21:51e162c130a9 116 int status;
aureliocarella 21:51e162c130a9 117 // uint32_t timer = timestamp_GetCurrent(); //RTC_GetVal();
aureliocarella 21:51e162c130a9 118 uint32_t timer = (uint32_t)Peripherals::timestampTimer()->read_us();
aureliocarella 21:51e162c130a9 119 status = fifo_put32(GetStreamOutFifo(), timer);
aureliocarella 21:51e162c130a9 120 if (status == -1) {
aureliocarella 21:51e162c130a9 121 printf("FIFO_OF!");
aureliocarella 21:51e162c130a9 122 fflush(stdout);
aureliocarella 21:51e162c130a9 123 while (1)
aureliocarella 21:51e162c130a9 124 ;
aureliocarella 21:51e162c130a9 125 }
aureliocarella 21:51e162c130a9 126 return 0;
aureliocarella 21:51e162c130a9 127 }
aureliocarella 21:51e162c130a9 128
aureliocarella 21:51e162c130a9 129 /**
aureliocarella 21:51e162c130a9 130 * @brief Insert a packet id into the out going fifo
aureliocarella 21:51e162c130a9 131 * @param id The uint32 packet id
aureliocarella 21:51e162c130a9 132 */
aureliocarella 21:51e162c130a9 133 int StreamFifoId(uint32_t id) {
aureliocarella 21:51e162c130a9 134 int status;
aureliocarella 21:51e162c130a9 135 status = fifo_put32(GetStreamOutFifo(), id);
aureliocarella 21:51e162c130a9 136 if (status == -1) {
aureliocarella 21:51e162c130a9 137 printf("FIFO_OF!");
aureliocarella 21:51e162c130a9 138 fflush(stdout);
aureliocarella 21:51e162c130a9 139 while (1)
aureliocarella 21:51e162c130a9 140 ;
aureliocarella 21:51e162c130a9 141 }
aureliocarella 21:51e162c130a9 142 return 0;
aureliocarella 21:51e162c130a9 143 }
aureliocarella 21:51e162c130a9 144
aureliocarella 21:51e162c130a9 145 /**
aureliocarella 21:51e162c130a9 146 * @brief Insert a length value into the out going fifo
aureliocarella 21:51e162c130a9 147 * @param length A uint32 number representing a length
aureliocarella 21:51e162c130a9 148 */
aureliocarella 21:51e162c130a9 149 int StreamFifoLength(uint32_t length) {
aureliocarella 21:51e162c130a9 150 int status;
aureliocarella 21:51e162c130a9 151 status = fifo_put32(GetStreamOutFifo(), length);
aureliocarella 21:51e162c130a9 152 if (status == -1) {
aureliocarella 21:51e162c130a9 153 printf("FIFO_OF!");
aureliocarella 21:51e162c130a9 154 fflush(stdout);
aureliocarella 21:51e162c130a9 155 while (1)
aureliocarella 21:51e162c130a9 156 ;
aureliocarella 21:51e162c130a9 157 }
aureliocarella 21:51e162c130a9 158 return 0;
aureliocarella 21:51e162c130a9 159 }
aureliocarella 21:51e162c130a9 160
aureliocarella 21:51e162c130a9 161 /**
aureliocarella 21:51e162c130a9 162 * @brief Return a value that indicates if the system is streaming data
aureliocarella 21:51e162c130a9 163 * @returns Returns a one or zero value
aureliocarella 21:51e162c130a9 164 */
aureliocarella 21:51e162c130a9 165 uint8_t IsStreaming(void) { return streaming; }
aureliocarella 21:51e162c130a9 166
aureliocarella 21:51e162c130a9 167 /**
aureliocarella 21:51e162c130a9 168 * @brief Set a flag to indicate if streaming is enabled
aureliocarella 21:51e162c130a9 169 * @param state A one or zero value
aureliocarella 21:51e162c130a9 170 */
aureliocarella 21:51e162c130a9 171 void SetStreaming(uint8_t state) { streaming = state; }
aureliocarella 21:51e162c130a9 172
aureliocarella 21:51e162c130a9 173 /**
aureliocarella 21:51e162c130a9 174 * @brief Set a flag to indicate if datalogging is enabled
aureliocarella 21:51e162c130a9 175 * @param state A one or zero value
aureliocarella 21:51e162c130a9 176 */
aureliocarella 21:51e162c130a9 177 void SetDataLoggingStream(uint8_t state) { dataLogging = state; }
aureliocarella 21:51e162c130a9 178