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

HSP/LoggingService/DataLoggingService.cpp@2:86d928355813, 2021-04-10 (annotated)

Committer:
darienf
Date:
Sat Apr 10 02:05:01 2021 +0000
Revision:
2:86d928355813
Parent:
0:832122ce6748 
before we screw up;

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 "USBSerial.h"
darienf 0:832122ce6748 35 #include "Logging.h"
darienf 0:832122ce6748 36 #include "Streaming.h"
darienf 0:832122ce6748 37 #include "RpcServer.h"
darienf 0:832122ce6748 38 #include "S25FS512.h"
darienf 0:832122ce6748 39 #include "BMP280.h"
darienf 0:832122ce6748 40 #include "PacketFifo.h"
darienf 0:832122ce6748 41 #include "DataLoggingService.h"
darienf 0:832122ce6748 42 #include "ServiceNonInterrupt.h"
darienf 0:832122ce6748 43 #include "HspLed.h"
darienf 0:832122ce6748 44 #include "MAX30001_helper.h"
darienf 0:832122ce6748 45 #include "MAX30101_helper.h"
darienf 0:832122ce6748 46 #include "StringInOut.h"
darienf 0:832122ce6748 47 #include "StringHelper.h"
darienf 0:832122ce6748 48 #include "Peripherals.h"
darienf 0:832122ce6748 49 #include "Device_Logging.h"
darienf 0:832122ce6748 50
darienf 0:832122ce6748 51 /// BMP280 logging object reference
darienf 0:832122ce6748 52 extern Device_Logging *bmp280_Logging;
darienf 0:832122ce6748 53 /// MAX14720 instance 0 logging object reference
darienf 0:832122ce6748 54 extern Device_Logging *MAX30205_0_Logging;
darienf 0:832122ce6748 55 /// MAX14720 instance 1 logging object reference
darienf 0:832122ce6748 56 extern Device_Logging *MAX30205_1_Logging;
darienf 0:832122ce6748 57
darienf 0:832122ce6748 58 #define PING_PONG_BUFFER_SIZE 512
darienf 0:832122ce6748 59 #define HALF_OF_PING_PONG_BUFFER_SIZE PING_PONG_BUFFER_SIZE / 2
darienf 0:832122ce6748 60 #define MISSION_DEFINITION_SIZE 4096
darienf 0:832122ce6748 61
darienf 0:832122ce6748 62 eLoggingTrigger loggingTrigger;
darienf 0:832122ce6748 63
darienf 0:832122ce6748 64 /// buffer where mission strings are stored
darienf 0:832122ce6748 65 char loggingMissionCmds[MISSION_DEFINITION_SIZE];
darienf 0:832122ce6748 66 /// This houses two 256 byte ram concatenated to act as a ping-pong
darienf 0:832122ce6748 67 uint8_t PingPong_SRAM[PING_PONG_BUFFER_SIZE];
darienf 0:832122ce6748 68 uint32_t buttonTrigger = 0;
darienf 0:832122ce6748 69
darienf 0:832122ce6748 70 eLoggingOutput loggingOutput;
darienf 0:832122ce6748 71 // extern int bleStartCommand;
darienf 0:832122ce6748 72 bool volatile globalFlag;
darienf 0:832122ce6748 73 extern int highDataRate;
darienf 0:832122ce6748 74 static uint32_t currentPage;
darienf 0:832122ce6748 75 static uint32_t sramIndex;
darienf 0:832122ce6748 76 /// flag to indicate that sram buffer 0 is dirty and will need to be flushed
darienf 0:832122ce6748 77 static uint32_t sram_buffer_0_dirty;
darienf 0:832122ce6748 78 /// flag to indicate that sram buffer 1 is dirty and will need to be flushed
darienf 0:832122ce6748 79 static uint32_t sram_buffer_1_dirty;
darienf 0:832122ce6748 80 /// usb byte buffer for sending out a bulk transfer
darienf 0:832122ce6748 81 static uint8_t usb_block[64];
darienf 0:832122ce6748 82 /// running index used to accumulate bytes to send as a block via bulk transfer
darienf 0:832122ce6748 83 static uint16_t usb_block_index = 0;
darienf 0:832122ce6748 84
darienf 0:832122ce6748 85 typedef enum {
darienf 0:832122ce6748 86 eStartEvent_NULL,
darienf 0:832122ce6748 87 eStartEvent_BLE,
darienf 0:832122ce6748 88 eStartEvent_BUTTON,
darienf 0:832122ce6748 89 eStartEvent_RPC_TO_USB,
darienf 0:832122ce6748 90 eStartEvent_RPC_TO_FLASH
darienf 0:832122ce6748 91 } eStartEvent;
darienf 0:832122ce6748 92 static eStartEvent startEvent;
darienf 0:832122ce6748 93
darienf 0:832122ce6748 94 extern USBSerial *usbSerialPtr;
darienf 0:832122ce6748 95
darienf 0:832122ce6748 96 /**
darienf 0:832122ce6748 97 * @brief Sets a flag to start USB logging (streaming)
darienf 0:832122ce6748 98 */
darienf 0:832122ce6748 99 void LoggingService_StartLoggingUsb(void) {
darienf 0:832122ce6748 100 loggingTrigger = eTriggerLog_RPC_USB;
darienf 0:832122ce6748 101 }
darienf 0:832122ce6748 102
darienf 0:832122ce6748 103 /**
darienf 0:832122ce6748 104 * @brief Sets a flag to start flash logging
darienf 0:832122ce6748 105 */
darienf 0:832122ce6748 106 void LoggingService_StartLoggingFlash(void) {
darienf 0:832122ce6748 107 loggingTrigger = eTriggerLog_RPC_FLASH;
darienf 0:832122ce6748 108 }
darienf 0:832122ce6748 109
darienf 0:832122ce6748 110 /**
darienf 0:832122ce6748 111 * @brief Checks the various logging start condition
darienf 0:832122ce6748 112 * @return 1 if a start condition is true, 0 if there is no start condition
darienf 0:832122ce6748 113 */
darienf 0:832122ce6748 114 static bool _LoggingService_CheckStartCondition(void) {
darienf 0:832122ce6748 115 bool buttonPressed;
darienf 0:832122ce6748 116 buttonPressed = Peripherals::pushButton()->GetButtonFallState();
darienf 0:832122ce6748 117
darienf 0:832122ce6748 118 // default not logging USB or flash
darienf 0:832122ce6748 119 loggingOutput = eLogToNothing;
darienf 0:832122ce6748 120 startEvent = eStartEvent_NULL;
darienf 0:832122ce6748 121 if (buttonPressed) {
darienf 0:832122ce6748 122 Peripherals::pushButton()->clearButtonFallState();
darienf 0:832122ce6748 123 // a falling state has been detected... wait for a fraction of a second and
darienf 0:832122ce6748 124 // re-read the pin
darienf 0:832122ce6748 125 // only start datalogging if the pin was released within this wait time
darienf 0:832122ce6748 126 wait(0.75f);
darienf 0:832122ce6748 127 int buttonRead = Peripherals::pushButton()->Read();
darienf 0:832122ce6748 128 // if after a period of time the button is still pressed then get out
darienf 0:832122ce6748 129 if (buttonRead == 0)
darienf 0:832122ce6748 130 return 0;
darienf 0:832122ce6748 131 buttonTrigger = 0;
darienf 0:832122ce6748 132
darienf 0:832122ce6748 133 loggingTrigger = eTriggerLog_BUTTON;
darienf 0:832122ce6748 134 loggingOutput = eLogToFlash;
darienf 0:832122ce6748 135 startEvent = eStartEvent_BUTTON;
darienf 0:832122ce6748 136 return true;
darienf 0:832122ce6748 137 }
darienf 0:832122ce6748 138 if (loggingTrigger == eTriggerLog_RPC_FLASH) {
darienf 0:832122ce6748 139 loggingOutput = eLogToFlash;
darienf 0:832122ce6748 140 startEvent = eStartEvent_RPC_TO_FLASH;
darienf 0:832122ce6748 141 return true;
darienf 0:832122ce6748 142 }
darienf 0:832122ce6748 143 if (Peripherals::hspBLE()->getStartDataLogging()) {
darienf 0:832122ce6748 144 loggingTrigger = eTriggerLog_BLE;
darienf 0:832122ce6748 145 loggingOutput = eLogToFlash;
darienf 0:832122ce6748 146 startEvent = eStartEvent_BLE;
darienf 0:832122ce6748 147 return true;
darienf 0:832122ce6748 148 }
darienf 0:832122ce6748 149 // check if start is from RPC call for USB streaming
darienf 0:832122ce6748 150 if (loggingTrigger == eTriggerLog_RPC_USB) {
darienf 0:832122ce6748 151 loggingOutput = eLogtoUsb;
darienf 0:832122ce6748 152 startEvent = eStartEvent_RPC_TO_USB;
darienf 0:832122ce6748 153 return true;
darienf 0:832122ce6748 154 }
darienf 0:832122ce6748 155 return false;
darienf 0:832122ce6748 156 }
darienf 0:832122ce6748 157
darienf 0:832122ce6748 158 /**
darienf 0:832122ce6748 159 * @brief Read the mission string from flash into a buffer
darienf 0:832122ce6748 160 * @return false if a mission was not defined, true if mission was read and
darienf 0:832122ce6748 161 * buffered
darienf 0:832122ce6748 162 */
darienf 0:832122ce6748 163 static bool _LoggingService_ReadMissionFromFlash(void) {
darienf 0:832122ce6748 164 // get mission from flash
darienf 0:832122ce6748 165 Logging_ReadMissionFromFlash((uint8_t *)loggingMissionCmds);
darienf 0:832122ce6748 166 if (Logging_IsMissionDefined((uint8_t *)loggingMissionCmds) == 0) {
darienf 0:832122ce6748 167 return false;
darienf 0:832122ce6748 168 }
darienf 0:832122ce6748 169 printf(loggingMissionCmds);
darienf 0:832122ce6748 170 fflush(stdout);
darienf 0:832122ce6748 171 RPC_ProcessCmds(loggingMissionCmds);
darienf 0:832122ce6748 172 return true;
darienf 0:832122ce6748 173 }
darienf 0:832122ce6748 174
darienf 0:832122ce6748 175 /**
darienf 0:832122ce6748 176 * @brief Process a RPC command that is pointed to.
darienf 0:832122ce6748 177 * @param cmd RPC string to process
darienf 0:832122ce6748 178 */
darienf 0:832122ce6748 179 void ProcessCmd(const char *cmd) {
darienf 0:832122ce6748 180 char cmd_[256];
darienf 0:832122ce6748 181 char reply[512];
darienf 0:832122ce6748 182 strcpy(cmd_, cmd);
darienf 0:832122ce6748 183 RPC_call(cmd_, reply);
darienf 0:832122ce6748 184 }
darienf 0:832122ce6748 185
darienf 0:832122ce6748 186 /**
darienf 0:832122ce6748 187 * @brief Buffer sensor fifo data in ram buffers, when a ram buffer is full (a
darienf 0:832122ce6748 188 * flash page worth of data is accumulated) then flash that buffer.
darienf 0:832122ce6748 189 * A buffer ping pong method is used so that one buffer can be flashing as
darienf 0:832122ce6748 190 * the other buffer fills with sensor fifo data.
darienf 0:832122ce6748 191 * @param fifoData Sensor data taken from the fifo to be stored into flash
darienf 0:832122ce6748 192 */
darienf 0:832122ce6748 193 static void _LoggingServer_OutputToFlash(uint32_t fifoData) {
darienf 0:832122ce6748 194 uint32_t index;
darienf 0:832122ce6748 195 char str[128];
darienf 0:832122ce6748 196 uint8_t *ptr;
darienf 0:832122ce6748 197 //
darienf 0:832122ce6748 198 // Log To Flash
darienf 0:832122ce6748 199 //
darienf 0:832122ce6748 200 // i.e. there is data, read one 32-bit size data at a time.
darienf 0:832122ce6748 201 // put the fifo data into the ping-pong SRAM
darienf 0:832122ce6748 202 PingPong_SRAM[sramIndex++] = fifoData & 0xFF; // LSByte goes into index N
darienf 0:832122ce6748 203 PingPong_SRAM[sramIndex++] = (fifoData >> 8) & 0xFF;
darienf 0:832122ce6748 204 PingPong_SRAM[sramIndex++] = (fifoData >> 16) & 0xFF;
darienf 0:832122ce6748 205 PingPong_SRAM[sramIndex++] = (fifoData >> 24) & 0xFF; // MSByte goes into index N+3
darienf 0:832122ce6748 206
darienf 0:832122ce6748 207 // flag this buffer as dirty
darienf 0:832122ce6748 208 if (sramIndex <= 256)
darienf 0:832122ce6748 209 sram_buffer_0_dirty = 1;
darienf 0:832122ce6748 210 else
darienf 0:832122ce6748 211 sram_buffer_1_dirty = 1;
darienf 0:832122ce6748 212
darienf 0:832122ce6748 213 if (sramIndex == 256 ||
darienf 0:832122ce6748 214 sramIndex == 512) // Either Ping SRAM or Pong SRAM location is full
darienf 0:832122ce6748 215 { // therefore write to Flash
darienf 0:832122ce6748 216
darienf 0:832122ce6748 217 index = sramIndex - 256;
darienf 0:832122ce6748 218 ptr = &PingPong_SRAM[index];
darienf 0:832122ce6748 219 sprintf(str, "currentPage=%lu", currentPage);
darienf 0:832122ce6748 220 Peripherals::s25FS512()->writePage_Helper(currentPage, ptr, 0);
darienf 0:832122ce6748 221
darienf 0:832122ce6748 222 // this page is no longer dirty
darienf 0:832122ce6748 223 if (index == 0)
darienf 0:832122ce6748 224 sram_buffer_0_dirty = 0;
darienf 0:832122ce6748 225 if (index == 256)
darienf 0:832122ce6748 226 sram_buffer_1_dirty = 0;
darienf 0:832122ce6748 227
darienf 0:832122ce6748 228 currentPage++;
darienf 0:832122ce6748 229 }
darienf 0:832122ce6748 230 sramIndex = sramIndex % 512; // Wrap around the index
darienf 0:832122ce6748 231 }
darienf 0:832122ce6748 232
darienf 0:832122ce6748 233 /**
darienf 0:832122ce6748 234 * @brief If flash ram buffers are flagged as dirty, flush to flash
darienf 0:832122ce6748 235 */
darienf 0:832122ce6748 236 static void _LoggingServer_WriteDirtySramBufferToFlash(void) {
darienf 0:832122ce6748 237 uint8_t *ptr = PingPong_SRAM;
darienf 0:832122ce6748 238 if (sram_buffer_0_dirty == 0 && sram_buffer_1_dirty == 0)
darienf 0:832122ce6748 239 return;
darienf 0:832122ce6748 240 if (sram_buffer_0_dirty == 1) {
darienf 0:832122ce6748 241 ptr += 0;
darienf 0:832122ce6748 242 }
darienf 0:832122ce6748 243 if (sram_buffer_1_dirty == 1) {
darienf 0:832122ce6748 244 ptr += 256;
darienf 0:832122ce6748 245 }
darienf 0:832122ce6748 246 printf("_LoggingServer_WriteDirtySramBufferToFlash:%lu,%lu\n",
darienf 0:832122ce6748 247 sram_buffer_0_dirty, sram_buffer_1_dirty);
darienf 0:832122ce6748 248 fflush(stdout);
darienf 0:832122ce6748 249 // s25fs512_WritePage_Helper(currentPage, ptr, 0);
darienf 0:832122ce6748 250 Peripherals::s25FS512()->writePage_Helper(currentPage, ptr, 0);
darienf 0:832122ce6748 251 }
darienf 0:832122ce6748 252
darienf 0:832122ce6748 253 /**
darienf 0:832122ce6748 254 * @brief Initialize the USB block running index
darienf 0:832122ce6748 255 * @param fifoData Sensor data taken from the fifo to be sent out USB
darienf 0:832122ce6748 256 */
darienf 0:832122ce6748 257 static void _LoggingServer_OutputToCdcAcm(uint32_t fifoData) {
darienf 0:832122ce6748 258 uint8_t *ptr;
darienf 0:832122ce6748 259 uint8_t str[16];
darienf 0:832122ce6748 260 sprintf((char *)str, "%X ", (unsigned int)fifoData);
darienf 0:832122ce6748 261 ptr = str;
darienf 0:832122ce6748 262 usb_block_index = 0;
darienf 0:832122ce6748 263 while (*ptr != 0) {
darienf 0:832122ce6748 264 usb_block[usb_block_index] = *ptr;
darienf 0:832122ce6748 265 ptr++;
darienf 0:832122ce6748 266 usb_block_index++;
darienf 0:832122ce6748 267 }
darienf 0:832122ce6748 268 usbSerialPtr->writeBlock(usb_block, usb_block_index);
darienf 0:832122ce6748 269 }
darienf 0:832122ce6748 270
darienf 0:832122ce6748 271 /**
darienf 0:832122ce6748 272 * @brief Initialize the USB block running index
darienf 0:832122ce6748 273 */
darienf 0:832122ce6748 274 static void _LoggingServer_OutputToCdcAcm_Start(void) { usb_block_index = 0; }
darienf 0:832122ce6748 275
darienf 0:832122ce6748 276 /**
darienf 0:832122ce6748 277 * @brief Buffer up fifoData from sensors, do a USB block transfer if buffer is
darienf 0:832122ce6748 278 * full
darienf 0:832122ce6748 279 * @param fifoData Sensor data taken from the fifo to be send out USB within a
darienf 0:832122ce6748 280 * bulk block transfer
darienf 0:832122ce6748 281 * @return Return the success status of the writeblock operation
darienf 0:832122ce6748 282 */
darienf 0:832122ce6748 283 static bool _LoggingServer_OutputToCdcAcm_Block(uint32_t fifoData) {
darienf 0:832122ce6748 284 uint8_t str[64];
darienf 0:832122ce6748 285 uint8_t *ptr;
darienf 0:832122ce6748 286 bool result;
darienf 0:832122ce6748 287 //
darienf 0:832122ce6748 288 // Log to CDCACM
darienf 0:832122ce6748 289 //
darienf 0:832122ce6748 290 result = true;
darienf 0:832122ce6748 291 sprintf((char *)str, "%X ", (unsigned int)fifoData);
darienf 0:832122ce6748 292 ptr = str;
darienf 0:832122ce6748 293 while (*ptr != 0) {
darienf 0:832122ce6748 294 usb_block[usb_block_index] = *ptr;
darienf 0:832122ce6748 295 ptr++;
darienf 0:832122ce6748 296 usb_block_index++;
darienf 0:832122ce6748 297 if (usb_block_index >= 64) {
darienf 0:832122ce6748 298 result = usbSerialPtr->writeBlock(usb_block, 64);
darienf 0:832122ce6748 299 usb_block_index = 0;
darienf 0:832122ce6748 300 }
darienf 0:832122ce6748 301 }
darienf 0:832122ce6748 302 return result;
darienf 0:832122ce6748 303 }
darienf 0:832122ce6748 304
darienf 0:832122ce6748 305 /**
darienf 0:832122ce6748 306 * @brief Output a full USB block via bulk transfer
darienf 0:832122ce6748 307 */
darienf 0:832122ce6748 308 static void _LoggingServer_OutputToCdcAcm_End(void) {
darienf 0:832122ce6748 309 if (usb_block_index == 0)
darienf 0:832122ce6748 310 return;
darienf 0:832122ce6748 311 usbSerialPtr->writeBlock(usb_block, usb_block_index - 1);
darienf 0:832122ce6748 312 }
darienf 0:832122ce6748 313
darienf 0:832122ce6748 314 /**
darienf 0:832122ce6748 315 * @brief Blink LED pattern that indicates that the flash end boundary has been
darienf 0:832122ce6748 316 * reached
darienf 0:832122ce6748 317 */
darienf 0:832122ce6748 318 static void BlinkEndOfDatalogging(void) {
darienf 0:832122ce6748 319 // blink to signal end of logging
darienf 0:832122ce6748 320 Peripherals::hspLed()->pattern(0x55555555, 20);
darienf 0:832122ce6748 321 wait(2);
darienf 0:832122ce6748 322 }
darienf 0:832122ce6748 323
darienf 0:832122ce6748 324 /**
darienf 0:832122ce6748 325 * @brief Reads the first data page of flash, if all FF's then the page is empty
darienf 0:832122ce6748 326 * @return 1 if the flash is empty as indicated by the first data page of the
darienf 0:832122ce6748 327 * flash, 0 if not
darienf 0:832122ce6748 328 */
darienf 0:832122ce6748 329 int isFlashEmpty(void) {
darienf 0:832122ce6748 330 int i;
darienf 0:832122ce6748 331 uint8_t data[256];
darienf 0:832122ce6748 332 int firstDataPage = Logging_GetLoggingStartPage();
darienf 0:832122ce6748 333 Peripherals::s25FS512()->readPages_Helper(firstDataPage, firstDataPage, data, 0);
darienf 0:832122ce6748 334 for (i = 0; i < 256; i++) {
darienf 0:832122ce6748 335 if (data[i] != 0xFF)
darienf 0:832122ce6748 336 return 0;
darienf 0:832122ce6748 337 }
darienf 0:832122ce6748 338 return 1;
darienf 0:832122ce6748 339 }
darienf 0:832122ce6748 340
darienf 0:832122ce6748 341 /**
darienf 0:832122ce6748 342 * @brief Blink LED pattern that indicates that the flash is not empty and a new
darienf 0:832122ce6748 343 * flash logging session can not occur
darienf 0:832122ce6748 344 */
darienf 0:832122ce6748 345 void BlinkFlashNotEmpty(void) {
darienf 0:832122ce6748 346 Peripherals::hspLed()->pattern(0x55555555, 20);
darienf 0:832122ce6748 347 wait(1);
darienf 0:832122ce6748 348 }
darienf 0:832122ce6748 349
darienf 0:832122ce6748 350 void ExecuteDefaultMission(void) {
darienf 0:832122ce6748 351 ProcessCmd("/MAX30001/CAL_InitStart 01 01 01 03 7FF 00");
darienf 0:832122ce6748 352 ProcessCmd("/MAX30001/ECG_InitStart 01 01 01 00 02 03 1F 0 00 00 01");
darienf 0:832122ce6748 353 ProcessCmd("/MAX30001/RtoR_InitStart 01 03 0F 00 03 01 00 00 01");
darienf 0:832122ce6748 354 ProcessCmd("/MAX30001/Rbias_FMSTR_Init 01 02 01 01 00");
darienf 0:832122ce6748 355 ProcessCmd("/LIS2DH/InitStart 02 01");
darienf 0:832122ce6748 356 }
darienf 0:832122ce6748 357
darienf 0:832122ce6748 358 void LoggingService_Init(void) { loggingTrigger = eTriggerLog_NULL; }
darienf 0:832122ce6748 359
darienf 0:832122ce6748 360 /**
darienf 0:832122ce6748 361 * @brief This routine checks to see if a USB or flash logging action needs to be taken
darienf 0:832122ce6748 362 * The routine checks for a start condition via button press, USB command, or BLE command
darienf 0:832122ce6748 363 * Once one of these start conditions is present, the logging begins until stopped or memory is full
darienf 0:832122ce6748 364 * @return 1 if successful, 0 if error or logging was aborted and no logging occurred
darienf 0:832122ce6748 365 */
darienf 0:832122ce6748 366 uint8_t LoggingService_ServiceRoutine(void) {
darienf 0:832122ce6748 367 uint32_t fifoData;
darienf 0:832122ce6748 368 uint32_t endPage;
darienf 0:832122ce6748 369 //USBSerial *usbSerial = Peripherals::usbSerial();
darienf 0:832122ce6748 370 // BMP280 *bmp280 = Peripherals::bmp280();
darienf 0:832122ce6748 371 bool buttonPressed;
darienf 0:832122ce6748 372 int packetBurstCount = 0;
darienf 0:832122ce6748 373 HspLed *hspLed = Peripherals::hspLed();
darienf 0:832122ce6748 374
darienf 0:832122ce6748 375 sramIndex = 0;
darienf 0:832122ce6748 376 // only start logging if conditions exist
darienf 0:832122ce6748 377
darienf 0:832122ce6748 378 if (_LoggingService_CheckStartCondition() == false) return 0;
darienf 0:832122ce6748 379 printf("Begin Logging...");
darienf 0:832122ce6748 380 if (startEvent == eStartEvent_NULL) printf("eStartEvent_NULL...");
darienf 0:832122ce6748 381 if (startEvent == eStartEvent_BLE) printf("eStartEvent_BLE...");
darienf 0:832122ce6748 382 if (startEvent == eStartEvent_BUTTON) printf("eStartEvent_BUTTON...");
darienf 0:832122ce6748 383 if (startEvent == eStartEvent_RPC_TO_USB) printf("eStartEvent_RPC_TO_USB...");
darienf 0:832122ce6748 384 if (startEvent == eStartEvent_RPC_TO_FLASH) printf("eStartEvent_RPC_TO_FLASH...");
darienf 0:832122ce6748 385 fflush(stdout);
darienf 0:832122ce6748 386
darienf 0:832122ce6748 387 // start logging stuttered blink pattern
darienf 0:832122ce6748 388 hspLed->pattern(0xA0F3813, 20);
darienf 0:832122ce6748 389
darienf 0:832122ce6748 390 if (startEvent == eStartEvent_RPC_TO_FLASH ||
darienf 0:832122ce6748 391 startEvent == eStartEvent_BUTTON) {
darienf 0:832122ce6748 392 // check to see if datalog already in flash... abort and force user to erase
darienf 0:832122ce6748 393 // flash if needed
darienf 0:832122ce6748 394 if (loggingOutput == eLogToFlash) {
darienf 0:832122ce6748 395 if (isFlashEmpty() == 0) {
darienf 0:832122ce6748 396 Logging_SetStart(false);
darienf 0:832122ce6748 397 // bleStartCommand = 0x00;
darienf 0:832122ce6748 398 BlinkFlashNotEmpty();
darienf 0:832122ce6748 399 hspLed->blink(1000);
darienf 0:832122ce6748 400 printf("Abort Logging, flash log exists. ");
darienf 0:832122ce6748 401 fflush(stdout);
darienf 0:832122ce6748 402 return 0;
darienf 0:832122ce6748 403 }
darienf 0:832122ce6748 404 }
darienf 0:832122ce6748 405 }
darienf 0:832122ce6748 406
darienf 0:832122ce6748 407 if (startEvent == eStartEvent_BLE) {
darienf 0:832122ce6748 408 // check for mission in flash
darienf 0:832122ce6748 409 if (_LoggingService_ReadMissionFromFlash() == false) {
darienf 0:832122ce6748 410 // if there is no mission in flash then do a default mission for the sake
darienf 0:832122ce6748 411 // of ble Android app working "out-of-the-box" and stream RtoR and Accel
darienf 0:832122ce6748 412 printf("No Mission in Flash...ExecuteDefaultMission...");
darienf 0:832122ce6748 413 fflush(stdout);
darienf 0:832122ce6748 414 ExecuteDefaultMission();
darienf 0:832122ce6748 415 // do not log this data
darienf 0:832122ce6748 416 loggingOutput = eLogToNothing;
darienf 0:832122ce6748 417 } else {
darienf 0:832122ce6748 418 // there is a mission in flash check if there is already logged data
darienf 0:832122ce6748 419 if (isFlashEmpty() == 0) {
darienf 0:832122ce6748 420 // just do default mission
darienf 0:832122ce6748 421 printf("Logged Data Detected...ExecuteDefaultMission...");
darienf 0:832122ce6748 422 fflush(stdout);
darienf 0:832122ce6748 423 ExecuteDefaultMission();
darienf 0:832122ce6748 424 // do not log this data
darienf 0:832122ce6748 425 loggingOutput = eLogToNothing;
darienf 0:832122ce6748 426 } else {
darienf 0:832122ce6748 427 // flag that we are logging to flash
darienf 0:832122ce6748 428 loggingOutput = eLogToFlash;
darienf 0:832122ce6748 429 }
darienf 0:832122ce6748 430 }
darienf 0:832122ce6748 431 }
darienf 0:832122ce6748 432
darienf 0:832122ce6748 433 // if we are logging to flash then read mission in flash
darienf 0:832122ce6748 434 if (loggingOutput == eLogToFlash) {
darienf 0:832122ce6748 435 if (_LoggingService_ReadMissionFromFlash() ==
darienf 0:832122ce6748 436 false) { // if there is no mission in flash then get out
darienf 0:832122ce6748 437 Logging_SetStart(false);
darienf 0:832122ce6748 438 Peripherals::hspLed()->pattern(0xC3C3C3C3, 20);
darienf 0:832122ce6748 439 wait(2);
darienf 0:832122ce6748 440 printf("Abort Logging, Mission does not exist. ");
darienf 0:832122ce6748 441 fflush(stdout);
darienf 0:832122ce6748 442 return 0;
darienf 0:832122ce6748 443 }
darienf 0:832122ce6748 444 currentPage = Logging_GetLoggingStartPage();
darienf 0:832122ce6748 445 endPage = Logging_GetLoggingEndPage();
darienf 0:832122ce6748 446 }
darienf 0:832122ce6748 447
darienf 0:832122ce6748 448 MAX30001_Helper_SetupInterrupts();
darienf 0:832122ce6748 449 if (MAX30001_AnyStreamingSet() == 1) {
darienf 0:832122ce6748 450 MAX30001_Helper_StartSync();
darienf 0:832122ce6748 451 }
darienf 0:832122ce6748 452
darienf 0:832122ce6748 453 SetDataLoggingStream(TRUE);
darienf 0:832122ce6748 454 ServiceNonInterrupt_Init();
darienf 0:832122ce6748 455 ServiceNonInterrupt_StartTimer();
darienf 0:832122ce6748 456
darienf 0:832122ce6748 457 while (usbSerialPtr->readable()) {
darienf 0:832122ce6748 458 usbSerialPtr->_getc();
darienf 0:832122ce6748 459 }
darienf 0:832122ce6748 460 fifo_clear(GetUSBIncomingFifo()); // clear USB serial incoming fifo
darienf 0:832122ce6748 461 fifo_clear(GetStreamOutFifo());
darienf 0:832122ce6748 462
darienf 0:832122ce6748 463 sram_buffer_0_dirty = 0;
darienf 0:832122ce6748 464 sram_buffer_1_dirty = 0;
darienf 0:832122ce6748 465
darienf 0:832122ce6748 466
darienf 0:832122ce6748 467 if (loggingOutput == eLogToNothing) { printf("eLogToNothing..."); fflush(stdout); }
darienf 0:832122ce6748 468 if (loggingOutput == eLogToFlash) { printf("eLogToFlash..."); fflush(stdout); }
darienf 0:832122ce6748 469 if (loggingOutput == eLogtoUsb) { printf("eLogtoUsb..."); fflush(stdout); }
darienf 0:832122ce6748 470 printf("highDataRate=%u...",(unsigned int)highDataRate); fflush(stdout);
darienf 0:832122ce6748 471
darienf 0:832122ce6748 472
darienf 0:832122ce6748 473 Peripherals::timestampTimer()->reset();
darienf 0:832122ce6748 474 Peripherals::timestampTimer()->start();
darienf 0:832122ce6748 475
darienf 0:832122ce6748 476 _LoggingServer_OutputToCdcAcm_Start();
darienf 0:832122ce6748 477 while (1) {
darienf 0:832122ce6748 478 if (loggingOutput == eLogToFlash) {
darienf 0:832122ce6748 479 // check if we are at the end of flash
darienf 0:832122ce6748 480 endPage = Logging_GetLoggingEndPage();
darienf 0:832122ce6748 481 if (currentPage >= endPage) {
darienf 0:832122ce6748 482 BlinkEndOfDatalogging(); // blink for 3 seconds to signal end of logging
darienf 0:832122ce6748 483 break;
darienf 0:832122ce6748 484 }
darienf 0:832122ce6748 485 }
darienf 0:832122ce6748 486
darienf 0:832122ce6748 487 if (startEvent == eStartEvent_BUTTON) {
darienf 0:832122ce6748 488 buttonPressed = Peripherals::pushButton()->GetButtonFallState();
darienf 0:832122ce6748 489 if (buttonPressed) {
darienf 0:832122ce6748 490 Peripherals::pushButton()->clearButtonFallState();
darienf 0:832122ce6748 491 // if there is a dirty sram buffer... flush it to flash
darienf 0:832122ce6748 492 _LoggingServer_WriteDirtySramBufferToFlash();
darienf 0:832122ce6748 493 BlinkEndOfDatalogging(); // blink for 3 seconds to signal end of logging
darienf 0:832122ce6748 494 break;
darienf 0:832122ce6748 495 }
darienf 0:832122ce6748 496 }
darienf 0:832122ce6748 497
darienf 0:832122ce6748 498 if (loggingTrigger == eTriggerLog_BLE) {
darienf 0:832122ce6748 499 if (Peripherals::hspBLE()->getStartDataLogging() == false) {
darienf 0:832122ce6748 500 // if there is a dirty sram buffer... flush it to flash
darienf 0:832122ce6748 501 _LoggingServer_WriteDirtySramBufferToFlash();
darienf 0:832122ce6748 502 BlinkEndOfDatalogging(); // blink for 3 seconds to signal end of logging
darienf 0:832122ce6748 503 break;
darienf 0:832122ce6748 504 }
darienf 0:832122ce6748 505 }
darienf 0:832122ce6748 506
darienf 0:832122ce6748 507 if (startEvent == eStartEvent_RPC_TO_USB ||
darienf 0:832122ce6748 508 startEvent == eStartEvent_RPC_TO_FLASH) {
darienf 0:832122ce6748 509 if (usbSerialPtr->available()) {
darienf 0:832122ce6748 510 if (loggingOutput == eLogToFlash) {
darienf 0:832122ce6748 511 _LoggingServer_WriteDirtySramBufferToFlash();
darienf 0:832122ce6748 512 }
darienf 0:832122ce6748 513 wait(0.2f);
darienf 0:832122ce6748 514 while (usbSerialPtr->available()) {
darienf 0:832122ce6748 515 usbSerialPtr->_getc();
darienf 0:832122ce6748 516 }
darienf 0:832122ce6748 517 fifo_clear(GetUSBIncomingFifo()); // clear USB serial incoming fifo
darienf 0:832122ce6748 518 fifo_clear(GetStreamOutFifo());
darienf 0:832122ce6748 519 break;
darienf 0:832122ce6748 520 }
darienf 0:832122ce6748 521 }
darienf 0:832122ce6748 522
darienf 0:832122ce6748 523 // check to see if data is available
darienf 0:832122ce6748 524 packetBurstCount = 0;
darienf 0:832122ce6748 525 while (PacketFifo_Empty() == 0) {
darienf 0:832122ce6748 526 if (packetBurstCount >= 100)
darienf 0:832122ce6748 527 break;
darienf 0:832122ce6748 528 fifoData = PacketFifo_GetUint32();
darienf 0:832122ce6748 529 if (loggingOutput == eLogToFlash) {
darienf 0:832122ce6748 530 _LoggingServer_OutputToFlash(fifoData);
darienf 0:832122ce6748 531 }
darienf 0:832122ce6748 532 if (loggingOutput == eLogtoUsb) {
darienf 0:832122ce6748 533 if (highDataRate == 0)
darienf 0:832122ce6748 534 _LoggingServer_OutputToCdcAcm(fifoData);
darienf 0:832122ce6748 535 else
darienf 0:832122ce6748 536 _LoggingServer_OutputToCdcAcm_Block(fifoData);
darienf 0:832122ce6748 537 }
darienf 0:832122ce6748 538 packetBurstCount++;
darienf 0:832122ce6748 539 }
darienf 0:832122ce6748 540
darienf 0:832122ce6748 541 if (PacketFifo_Empty() != 0) {
darienf 0:832122ce6748 542 Peripherals::ble()->waitForEvent();
darienf 0:832122ce6748 543 }
darienf 0:832122ce6748 544 ServiceNonInterrupt_BMP280(bmp280_Logging);
darienf 0:832122ce6748 545 ServiceNonInterrupt_MAX30205(MAX30205_0_Logging,
darienf 0:832122ce6748 546 Peripherals::max30205_top(),
darienf 0:832122ce6748 547 PACKET_MAX30205_TEMP_TOP);
darienf 0:832122ce6748 548 ServiceNonInterrupt_MAX30205(MAX30205_1_Logging,
darienf 0:832122ce6748 549 Peripherals::max30205_bottom(),
darienf 0:832122ce6748 550 PACKET_MAX30205_TEMP_BOTTOM);
darienf 0:832122ce6748 551 }
darienf 0:832122ce6748 552 _LoggingServer_OutputToCdcAcm_End();
darienf 0:832122ce6748 553 printf("End Logging.\n");
darienf 0:832122ce6748 554 fflush(stdout);
darienf 0:832122ce6748 555
darienf 0:832122ce6748 556 bmp280_Logging->stop();
darienf 0:832122ce6748 557 MAX30205_0_Logging->stop();
darienf 0:832122ce6748 558 MAX30205_1_Logging->stop();
darienf 0:832122ce6748 559 MAX30001_Helper_Stop(); // if any MAX30001 streams have been started, stop
darienf 0:832122ce6748 560 // them
darienf 0:832122ce6748 561 MAX30101_Helper_Stop(); // if any MAX30101 streams have been started, stop
darienf 0:832122ce6748 562 // them
darienf 0:832122ce6748 563 Peripherals::lis2dh()->stop();
darienf 0:832122ce6748 564 SetDataLoggingStream(FALSE);
darienf 0:832122ce6748 565 Peripherals::timestampTimer()->stop();
darienf 0:832122ce6748 566 hspLed->blink(1000);
darienf 0:832122ce6748 567 // default to non-usb packet speed optimizing
darienf 0:832122ce6748 568 highDataRate = 0;
darienf 0:832122ce6748 569 loggingTrigger = eTriggerLog_NULL;
darienf 0:832122ce6748 570 return 1;
darienf 0:832122ce6748 571 }