Samples acceleration at 100 Hz for 10 seconds. At the end of the 10 seconds, turns on: - LED1 if the board stayed horizontal for most time - LED2 if the board stayed on the long edge for most time - LED3 if the board stayed on the short edge for most time

Dependencies:   BSP_B-L475E-IOT01

Files at this revision

API Documentation at this revision

Comitter:
vicara
Date:
Thu Dec 06 14:55:07 2018 +0000
Child:
1:164c6bd28b13
Commit message:
Acceleration File;

Changed in this revision

BSP_B-L475E-IOT01.lib Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file
mbed-os.lib Show annotated file Show diff for this revision Revisions of this file
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/BSP_B-L475E-IOT01.lib	Thu Dec 06 14:55:07 2018 +0000
@@ -0,0 +1,1 @@
+http://developer.mbed.org/teams/ST/code/BSP_B-L475E-IOT01/#9dfa42666f03
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Dec 06 14:55:07 2018 +0000
@@ -0,0 +1,189 @@
+#include "mbed.h"
+
+#include "stm32l475e_iot01_accelero.h"
+
+#include <stdio.h>
+#include <errno.h>
+
+// Block devices
+#if COMPONENT_SPIF
+#include "SPIFBlockDevice.h"
+#endif
+
+#if COMPONENT_DATAFLASH
+#include "DataFlashBlockDevice.h"
+#endif 
+
+#if COMPONENT_SD
+#include "SDBlockDevice.h"
+#endif 
+
+#include "HeapBlockDevice.h"
+
+// File systems
+#include "LittleFileSystem.h"
+#include "FATFileSystem.h"
+
+// Physical block device, can be any device that supports the BlockDevice API
+/*SPIFBlockDevice bd(
+        MBED_CONF_SPIF_DRIVER_SPI_MOSI,
+        MBED_CONF_SPIF_DRIVER_SPI_MISO,
+        MBED_CONF_SPIF_DRIVER_SPI_CLK,
+        MBED_CONF_SPIF_DRIVER_SPI_CS);*/
+
+#define BLOCK_SIZE 512
+HeapBlockDevice bd(16384, BLOCK_SIZE);
+
+// File system declaration
+LittleFileSystem fs("fs");
+
+DigitalOut led1(LED1);
+DigitalOut led2(LED2);
+DigitalOut led3(LED3);
+
+Ticker timeout_ticker;
+Thread t;
+
+static FILE *f;
+volatile int seconds_passed = 0;
+EventQueue queue(32 * EVENTS_EVENT_SIZE);
+
+InterruptIn button(USER_BUTTON);
+int16_t pDataXYZ[3] = {0};
+
+void toggle_led(int led1_status, int led2_status, int led3_status){
+    led1 = led1_status;
+    led2 = led2_status;
+    led3 = led3_status;
+}
+
+void write_positions_on_file() {
+    int16_t pDataXYZ[3] = {0};
+    BSP_ACCELERO_AccGetXYZ(pDataXYZ);
+    if ((pDataXYZ[0] < -950  && pDataXYZ[0] > -1030) || (pDataXYZ[0] < 1030 && pDataXYZ[0] > 950)) {
+            fprintf(f, "%d\n", 0);
+        } else if ((pDataXYZ[1] < 1030 && pDataXYZ[1] > 950) || (pDataXYZ[1] < -950 && pDataXYZ[1] > -1030)) {
+            fprintf(f, "%d\n", 1);
+        } else if ((pDataXYZ[2] < 1030 && pDataXYZ[2] > 950) || (pDataXYZ[2] < -950 && pDataXYZ[2] > -1030)) {
+             fprintf(f, "%d\n", 2);
+        } else {
+             fprintf(f, "%d\n", -1);
+        }
+    fflush(f);
+    fflush(stdout);
+}
+
+void toggle_led_based_on_position() {
+      int horizontal_occurrencies = 0;
+      int long_vertical_occurrencies = 0;
+      int short_vertical_occurrencies = 0;
+      fflush(stdout);
+      fflush(f);
+      
+      fseek(f, 0, SEEK_SET);
+      int position;
+      while (!feof(f)) {
+        fscanf(f, "%d", &position); 
+        if (position == 0) {
+            short_vertical_occurrencies +=1;
+        } else if(position == 1) {
+            long_vertical_occurrencies +=1;
+        } else if(position == 2) {
+            horizontal_occurrencies +=1;
+        }
+      }
+      printf("horizontal occ: %d \n",horizontal_occurrencies);
+      printf("long vert occ: %d \n",long_vertical_occurrencies);
+      printf("short vert occ: %d \n",short_vertical_occurrencies);
+      if (horizontal_occurrencies >= long_vertical_occurrencies && horizontal_occurrencies >= short_vertical_occurrencies) {
+            toggle_led(1,0,0);
+        } else if (long_vertical_occurrencies >= horizontal_occurrencies && long_vertical_occurrencies >= short_vertical_occurrencies ) {
+            toggle_led(0,1,0);
+        } else if (short_vertical_occurrencies >= horizontal_occurrencies && short_vertical_occurrencies >= long_vertical_occurrencies) {
+            toggle_led(0,0,1);
+        }
+      
+      fflush(stdout);
+      int err = fclose(f);
+      printf("%s\n", (err < 0 ? "Fail :(" : "OK"));
+      if (err < 0) {
+        error("error: %s (%d)\n", strerror(err), -err);
+      }
+      err = fs.unmount();
+      printf("%s\n", (err < 0 ? "Fail :(" : "OK"));
+      if (err < 0) {
+          error("error: %s (%d)\n", strerror(-err), err);
+      }    
+      printf("Press the restart button to sample again.");
+}
+
+void toggle() {
+    int16_t pDataXYZ[3] = {0};
+    BSP_ACCELERO_AccGetXYZ(pDataXYZ);
+    printf("ACCELERO_X = %d\n", pDataXYZ[0]);
+    printf("ACCELERO_Y = %d\n", pDataXYZ[1]);
+    printf("ACCELERO_Z = %d\n\n", pDataXYZ[2]);
+}
+
+bool is_board_horizontal() {
+    return (pDataXYZ[2] < 1030 && pDataXYZ[2] > 950) || (pDataXYZ[2] < -950 && pDataXYZ[2] > -1030);
+}
+
+bool is_board_vertical_short() {
+    return (pDataXYZ[0] < -950  && pDataXYZ[0] > -1030) || (pDataXYZ[0] < 1030 && pDataXYZ[0] > 950);
+}
+
+bool is_board_vertical_long() {
+    return (pDataXYZ[1] < 1030 && pDataXYZ[1] > 950) || (pDataXYZ[1] < -950 && pDataXYZ[1] > -1030);
+}
+
+void ticker_attach() {    
+    queue.call(write_positions_on_file);
+    seconds_passed++;
+//    Blink correct led after 10 seconds
+    if (seconds_passed == 1000) {
+      timeout_ticker.detach();
+      queue.call(toggle_led_based_on_position);
+      seconds_passed = 0;
+    }
+}
+
+int main(){
+    t.start(callback(&queue, &EventQueue::dispatch_forever));
+    BSP_ACCELERO_Init();
+    
+    // Try to mount the filesystem
+    printf("Mounting the filesystem... ");
+    fflush(stdout);
+    int err = fs.mount(&bd);
+    printf("%s\n", (err ? "Fail :(" : "OK"));
+    if (err) {
+        // Reformat if we can't mount the filesystem
+        // this should only happen on the first boot
+        printf("No filesystem found, formatting... ");
+        fflush(stdout);
+        err = fs.reformat(&bd);
+        printf("%s\n", (err ? "Fail :(" : "OK"));
+        if (err) {
+            error("error: %s (%d)\n", strerror(-err), err);
+        }
+    }
+    
+    // Open the numbers file
+    printf("Opening \"/fs/numbers.txt\"... ");
+    fflush(stdout);
+    f = fopen("/fs/numbers.txt", "r+");
+    printf("%s\n", (!f ? "Fail :(" : "OK"));
+    if (!f) {
+        // Create the numbers file if it doesn't exist
+        printf("No file found, creating a new file... ");
+        fflush(stdout);
+        f = fopen("/fs/numbers.txt", "w+");
+        printf("%s\n", (!f ? "Fail :(" : "OK"));
+        if (!f) {
+            error("error: %s (%d)\n", strerror(errno), -errno);
+        }
+    }
+
+    timeout_ticker.attach(&ticker_attach, 0.01);
+}
\ No newline at end of file
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed-os.lib	Thu Dec 06 14:55:07 2018 +0000
@@ -0,0 +1,1 @@
+https://github.com/ARMmbed/mbed-os/#610e35ddc6d59f153173c1e7b2748cf96d6c9bcd