Los Putacos / Mbed OS WearableDevice_Nucleo

Dependencies:   MPU9250_SPI SDFileSystem XBeeLib

Committer:
Muglug
Date:
Tue Dec 19 10:15:19 2017 +0000
Revision:
28:c7e977a19564
Parent:
27:c4b2ce6fa5b8
Child:
29:ab809198c1ba
Newest Version.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gusteibolt 6:939df52d75c9 1 /*
gusteibolt 6:939df52d75c9 2 * Los Putacos
gusteibolt 6:939df52d75c9 3 * Copyright (C) 2017, All rights reserved.
Muglug 23:aad5fd1b3ef9 4 * ________________________________________
gusteibolt 6:939df52d75c9 5 *
gusteibolt 6:939df52d75c9 6 * Created by: Gustavo Campana, Michael Schmidt, Miguel Lopez
gusteibolt 6:939df52d75c9 7 * Date: 12-Oct-2017
gusteibolt 6:939df52d75c9 8 * Version: V0.1
gusteibolt 10:577e1fc4453e 9 */
Muglug 26:4bc56ce08d15 10 //-----------------------------------------------------------------
gusteibolt 7:ebaaff27840b 11
Muglug 26:4bc56ce08d15 12 //-----------------------------------------------------------------
Muglug 26:4bc56ce08d15 13 // Includes
Muglug 26:4bc56ce08d15 14 #include "event.h"
Muglug 26:4bc56ce08d15 15 //-----------------------------------------------------------------
gusteibolt 10:577e1fc4453e 16
Muglug 26:4bc56ce08d15 17 //-----------------------------------------------------------------
Muglug 28:c7e977a19564 18 void ReceiveCommand(void)
Muglug 23:aad5fd1b3ef9 19 {
Muglug 28:c7e977a19564 20 if (Socket_TCP.recv(Data_Buffer, sizeof Data_Buffer) > 0) {
Muglug 28:c7e977a19564 21 PC.printf("Socket Data Received! - %s\n", Data_Buffer);
Muglug 28:c7e977a19564 22
Muglug 28:c7e977a19564 23 if (strlen(Data_Buffer) == 9) { // Check Package Length (correct: len = 9)
Muglug 28:c7e977a19564 24 if ((Data_Buffer[0] == '#') && (Data_Buffer[6] == ',')) { // Check for "#" and "," at specific Positions
Muglug 28:c7e977a19564 25 if (strstr(Data_Buffer, DeviceNr) != NULL) { // Check for valid DeviceNr in Package
Muglug 28:c7e977a19564 26 Time_Buffer[0] = Data_Buffer[7];
Muglug 28:c7e977a19564 27 Time_Buffer[1] = Data_Buffer[8];
Muglug 28:c7e977a19564 28 Requested_Time = atoi(Time_Buffer); // Requested Time by received Package
Muglug 28:c7e977a19564 29
Muglug 28:c7e977a19564 30 CheckCommandDone_Flag = 1;
Muglug 28:c7e977a19564 31 PC.printf("Requested Time: %d\n", Requested_Time);
Muglug 28:c7e977a19564 32 memset(Data_Buffer, 0, sizeof(Data_Buffer)); // Clear Data_Buffer
Muglug 28:c7e977a19564 33 Ticker_ReceiveCommand.detach();
Muglug 28:c7e977a19564 34 }
Muglug 28:c7e977a19564 35 }
Muglug 28:c7e977a19564 36 }
Muglug 28:c7e977a19564 37 }
Muglug 23:aad5fd1b3ef9 38 }
Muglug 23:aad5fd1b3ef9 39 //-----------------------------------------------------------------
Muglug 23:aad5fd1b3ef9 40
Muglug 23:aad5fd1b3ef9 41 //-----------------------------------------------------------------
Muglug 26:4bc56ce08d15 42 void ReadIMU(void)
Muglug 26:4bc56ce08d15 43 {
Muglug 26:4bc56ce08d15 44 Time_Data = TimeStamp.read_ms(); // Read TimeStamp Data
Muglug 26:4bc56ce08d15 45
Muglug 26:4bc56ce08d15 46 if (Time_Data <= Requested_Time * 1000) { // Check Time Elapsed
Muglug 28:c7e977a19564 47 imu.read_acc();
Muglug 26:4bc56ce08d15 48
Muglug 28:c7e977a19564 49 Data_Storage_MIC[writePointer_MIC++] = micro.read_u16(); // Store Microphone Data
Muglug 28:c7e977a19564 50 Data_Storage[writePointer++] = imu.accelerometer_data[2]; // Store Z-Axis Accelerometer Data
Muglug 28:c7e977a19564 51 Data_Storage[writePointer++] = imu.accelerometer_data[1]; // Store Y-Axis Accelerometer Data
Muglug 28:c7e977a19564 52 Data_Storage[writePointer++] = imu.accelerometer_data[0]; // Store X-Axis Accelerometer Data
Muglug 28:c7e977a19564 53 Data_Storage[writePointer++] = Time_Data; // Store Time Data
Muglug 26:4bc56ce08d15 54 } else {
Muglug 26:4bc56ce08d15 55 Ticker_IMU.detach(); // Detach Timer to Stop "ReadIMU"
Muglug 26:4bc56ce08d15 56 TimeStamp.stop(); // Stop TimeStamp
Muglug 28:c7e977a19564 57 TimeStamp.reset(); // Reset TimeStamp
Muglug 26:4bc56ce08d15 58
Muglug 27:c4b2ce6fa5b8 59 TimeStamp.start();
Muglug 27:c4b2ce6fa5b8 60 ReadIMUDone_Flag = 1;
Muglug 28:c7e977a19564 61 PC.printf("Measurement Done!\n");
Muglug 26:4bc56ce08d15 62 }
Muglug 26:4bc56ce08d15 63 }
Muglug 26:4bc56ce08d15 64 //-----------------------------------------------------------------
Muglug 26:4bc56ce08d15 65
Muglug 23:aad5fd1b3ef9 66 //-----------------------------------------------------------------