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/LoggingService/DataLoggingService.cpp@5:bc128a16232f, 2021-05-02 (annotated)

Committer:
darienf
Date:
Sun May 02 23:09:04 2021 +0000
Revision:
5:bc128a16232f
Parent:
3:36de8b9e4b1a 
This is the program that was last used, that has the working temperature and some comments

Who changed what in which revision?

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