ST / Mbed OS MOTENV_Mbed

Motion and Environmental sensor reader application connected via BLE to ST BlueMS iOS/Android application.

Dependencies:   HTS221 LIS3MDL LPS22HB LSM303AGR LSM6DSL

Fork of MOTENV_Mbed by ST Expansion SW Team

This application supports three different sets of ST hardware boards:

  • STEVAL-STLKT01V1 (aka SensorTile)
  • X-NUCLEO-IDB05A1 and X-NUCLEO-IKS01A2 expansion boards
  • B-L475E-IOT01A IoT Discovery board

    and runs over four different target configurations:

  • Nucleo F401RE + X-NUCLEO-IDB05A1 + X-NUCLEO-IKS01A2 (set target NUCLEO_F401RE)
  • DISCO_L475VG_IOT01A (set target DISCO_L475VG_IOT01A)
  • Nucleo L476RG + CRADLE + SENSORTILE (set compile target NUCLEO_L476RG)
  • Nucleo L476RG + CRADLE_EXPANSION_BOARD + SENSORTILE (set compile target NUCLEO_L476RG, remove macro MINI_CRADLE from mbed_app.json)

The first 2 configurations do not require any HW modifications (just use the above indicated targets).

Third configuration (CRADLE ) only requires to remove the two ST-LINK jumpers and JP6 from the Nucleo L476RG board in order to allow flashing the SensorTile through the Nucleo Jtag controller. Once flashed, if the battery is properly plugged and charged, the SensorTile could be mounted in the plastic enclosure being able to run as a small stand alone wearable device. Please note that this configuration do not provide a serial console for printf.

To enable last configuration (CRADLE_EXPANSION_BOARD), follow the steps below:

  • On Nucleo L476RG
    • open the two "ST-LINK" jumpers
    • open the MCU power supply jumper JP6
    • close the solder bridges SB63 and SB62 (to enable the serial console)
  • On SensorTile Arduino Cradle close the solder bridges SB21 and SB10 (to enable the serial console) and move the jumper J2 to the 5V position
  • Plug the Sensor Tile on the Arduino Cradle
  • Plug the Cradle on the Nucleo Arduino connector and connect the debug flat cable between Cradle and Nucleo Jtag connector (the cradle pin1 -identified by a dot- must be connected to the Nucleo pin1 (dot) of SWD CN4 jtag connector)
  • Plug the Nucleo USB cable on PC (a new COM port should appear); no need to plug the micro USB cable on the cradle.
  • Open a PC terminal to see the messages
  • Compile from mbed CLI or on-line compiler removing macro MINI_CRADLE from mbed_app.json file and selecting NUCLEO_ L476RG target
  • Flash the board with the binary

For all configurations on an Android or iOS device download and open the ST BlueMS application and connect to "MotEnvMbedOS" BLE device to see the sensor data.

For all configurations is also possible to add a 9 axis MotionFX sensor fusion library, which is part of the X-CUBE-MEMS package at this link.
The library comes in three flavours, choose your preferred according to the toolchain used (IAR, Keil or GC, Keil version should be used for the online compiler) and copy it in the Middlewares\ST\STM32_MotionFX_Library\Lib directory changing the file extension according to the toolchain used (.a for GCC, .ar for Keil).
In the file mbed_app.json add the macro definition "USE_SENSOR_FUSION_LIB" to the chosen target.
If compiling from CLI and using GCC_ARM toolchain option, in the file \mbed-os\tools\toolchains\gcc.py change the compiling option from

        if target.core == "Cortex-M4F":
            self.cpu.append("-mfpu=fpv4-sp-d16")
            self.cpu.append("-mfloat-abi=softfp")

to

        if target.core == "Cortex-M4F":
            self.cpu.append("-mfpu=fpv4-sp-d16")
            self.cpu.append("-mfloat-abi=hard")

and compile.

Diff: main.cpp

Revision:
18:e2360c944484
Parent:
16:b794ff225d9d
Child:
20:b97e14ade434
diff -r b794ff225d9d -r e2360c944484 main.cpp
--- a/main.cpp	Thu Jun 08 09:25:00 2017 +0200
+++ b/main.cpp	Fri Jun 09 10:59:36 2017 +0200
@@ -110,11 +110,11 @@
 static EventQueue eventQueue(/* event count */ 16 * /* event size */ 32);
 static Queue <char, 5>QueueMainActivity;
 
-#define TMO_MEMS  1
-#define TMO_CALIB 2
+#define TMO_MEMS          1
+#define TMO_CALIB         2
 #define TMO_SENSOR_FUSION 3
-#define TMO_ENV   4
-
+#define TMO_ENV           4
+#define BLE_STARTED       5
     
 #ifdef CUST_CONS_SERV
 static CustomConsoleService    * p_customconsoleservice = NULL;
@@ -728,23 +728,9 @@
     if (ble.getInstanceID() != BLE::DEFAULT_INSTANCE) {
         return;
     }
-	ble_started=1;
-#if 0
-    ble.gap().onDisconnection(disconnectionCallback);
-
-    /* Setup primary service. */
-    hrServicePtr = new HeartRateService(ble, hrmCounter, HeartRateService::LOCATION_FINGER);
-  
-    /* Setup advertising. */
-    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
-    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
-    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_HEART_RATE_SENSOR);
-    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
-    ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
-//    ble.gap().setAdvertisingInterval(1000); /* 1000ms */
-    ble.gap().setAdvertisingInterval(500); /* 1000ms */
-    ble.gap().startAdvertising();
-#endif
+		char msg;
+	  msg = BLE_STARTED;
+		QueueMainActivity.put((char*)msg);			
 }
 
 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) {
@@ -1003,7 +989,7 @@
                             p_customsensorservice->updateEnvTemperature(TempToSend, TimeStamp);
                         }
                     }
-#if 0   // Hum sensor not present on SensorTile
+#if 0   // Hum sensor not present on SensorTile (hum is HTS221 on mini cradle)
                     if (p_customsensorservice->isHumNotificationEn()) {
 //                        err = p_mems_expansion_board->ht_sensor->GetHumidity(&hum);  /** FIXME no hum sens on Tile */
                         if ( err != HUM_TEMP_OK) {
@@ -1077,32 +1063,26 @@
            MEMS_TIMER/1000*QUAT_FLOAT_UPDATE_MUL_10MS
 #endif
           );
-                    
- /*
-    p_BLEdev = new BLE;
-    if (!p_BLEdev) {
-        printf("\r\nBLE Device creation failed\r\n");
-        return 0;
-    }        
-    p_BLEdev->init(bleInitComplete);         
- */
 //    eventQueue.call_every(500, periodicCallback); 
     BLE &ble = BLE::Instance();
 		p_BLEdev = &ble;
     p_BLEdev->onEventsToProcess(scheduleBleEventsProcessing);
     p_BLEdev->init(bleInitComplete);
  
- for (; !ble_started; wait_ms(10));
+    ble_started = 0;
+    osEvent RxEvt = QueueMainActivity.get();	 // waiting for bleInitComplete cb to be called
+		if (RxEvt.value.v == BLE_STARTED) ble_started = 1;
+			
 //    greenled = 0;//Switch OFF LED1
     
     /* set the BLE CB functions */
     p_BLEdev->gattServer().onUpdatesEnabled(onUpdatesEnabledCallback);
     p_BLEdev->gattServer().onUpdatesDisabled(onUpdatesDisabledCallback);
-/*    p_BLEdev->gattServer().onConfirmationReceived(onConfirmationReceivedCallback);    
+    p_BLEdev->gattServer().onConfirmationReceived(onConfirmationReceivedCallback);    
     p_BLEdev->gattServer().onDataSent(onDataSentCallback);
     p_BLEdev->gattServer().onDataRead(onDataReadCallback);
     p_BLEdev->gattServer().onDataWritten(onDataWriteCallback);
-*/		
+		
     p_BLEdev->gap().onConnection(onConnectionCallback);
     p_BLEdev->gap().onDisconnection(onDisconnectionCallback);
 /*    p_BLEdev->gap().onTimeout(onTimeoutCallback);
@@ -1163,19 +1143,19 @@
     printf("\rHW      Service W2ST console added successfully\r\n");
 #endif
 #ifdef CUST_SW_SERV
-        AxesRaw_TypeDef quat_axes[SEND_N_QUATERNIONS];
-        float QuatFloat[SEND_N_QUATERNIONS];        
-        if (SensorFusionOK) {
-            p_customsoftwareservice = new CustomSoftwareService(*p_BLEdev);
-            if (!p_customsoftwareservice) {
-                    printf("SW      Service W2ST quaternions add FAILED!\n\r");
-                    return 0;
-            }
-            printf("SW      Service W2ST quaternions added successfully\r\n");
-        }
+    AxesRaw_TypeDef quat_axes[SEND_N_QUATERNIONS];
+    float QuatFloat[SEND_N_QUATERNIONS];        
+    if (SensorFusionOK) {
+         p_customsoftwareservice = new CustomSoftwareService(*p_BLEdev);
+         if (!p_customsoftwareservice) {
+                 printf("SW      Service W2ST quaternions add FAILED!\n\r");
+                 return 0;
+         }
+         printf("SW      Service W2ST quaternions added successfully\r\n");
+    }
 #endif      
         
-        const static char     DEVICE_NAME[]        = BLE_DEV_NAME;
+    const static char     DEVICE_NAME[]        = BLE_DEV_NAME;
     /* Setup advertising. */
     p_BLEdev->gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
 //    p_BLEdev->gap().accumulateAdvertisingPayloadTxPower(txPower); 
@@ -1204,16 +1184,16 @@
     MemsTimer.attach_us(&Ticker_Mems, MEMS_TIMER);
 
     /* Control if the calibration is already available in memory */
-        if (SensorFusionOK) {
-            ReCallCalibrationFromMemory();
+    if (SensorFusionOK) {
+       ReCallCalibrationFromMemory();
 
-            /* Switch on/off the LED according to calibration */
-            if(isCal) {
-//                    greenled =1;
-            } else {
- //                   greenled =0;
-            }
-        }
+    /* Switch on/off the LED according to calibration */
+       if(isCal) {
+//        greenled =1;
+       } else {
+ //       greenled =0;
+       } 
+    }
 #ifdef CUST_SW_SERV        
     uint32_t QuaternionNumber =0;
     uint32_t CounterFloat =0;