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.

Committer:
mapellil
Date:
Mon Dec 21 13:05:16 2015 +0000
Revision:
8:b042fe719f51
Parent:
7:34014895dda8
Child:
9:2693f9ef8ff7
Reworked ble congestion control

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mapellil 8:b042fe719f51 1 /* mbed Microcontroller Library
mapellil 8:b042fe719f51 2 * Copyright (c) 2006-2013 ARM Limited
mapellil 0:e93a11b4e044 3 *
mapellil 8:b042fe719f51 4 * Licensed under the Apache License, Version 2.0 (the "License");
mapellil 8:b042fe719f51 5 * you may not use this file except in compliance with the License.
mapellil 8:b042fe719f51 6 * You may obtain a copy of the License at
mapellil 0:e93a11b4e044 7 *
mapellil 8:b042fe719f51 8 * http://www.apache.org/licenses/LICENSE-2.0
mapellil 0:e93a11b4e044 9 *
mapellil 8:b042fe719f51 10 * Unless required by applicable law or agreed to in writing, software
mapellil 8:b042fe719f51 11 * distributed under the License is distributed on an "AS IS" BASIS,
mapellil 8:b042fe719f51 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
mapellil 8:b042fe719f51 13 * See the License for the specific language governing permissions and
mapellil 8:b042fe719f51 14 * limitations under the License.
mapellil 0:e93a11b4e044 15 */
mapellil 0:e93a11b4e044 16
mapellil 0:e93a11b4e044 17 #ifndef __CUSTOM_BLE_SOFTWARE_SERVICE_H__
mapellil 0:e93a11b4e044 18 #define __CUSTOM_BLE_SOFTWARE_SERVICE_H__
mapellil 0:e93a11b4e044 19 #include "BLE.h"
mapellil 0:e93a11b4e044 20
mapellil 0:e93a11b4e044 21 #define SEND_N_QUATERNIONS 3 // The number of quaternions to be sent per BLE update (could be 1,2,3)
mapellil 0:e93a11b4e044 22
mapellil 0:e93a11b4e044 23 #if SEND_N_QUATERNIONS == 1
mapellil 0:e93a11b4e044 24 #elif SEND_N_QUATERNIONS == 2
mapellil 0:e93a11b4e044 25 #elif SEND_N_QUATERNIONS == 3
mapellil 0:e93a11b4e044 26 #else
mapellil 0:e93a11b4e044 27 #error SEND_N_QUATERNIONS could be only 1,2,3
mapellil 0:e93a11b4e044 28 #endif
mapellil 0:e93a11b4e044 29
mapellil 0:e93a11b4e044 30 #define SIZEOF_QUAT 2+2*3*SEND_N_QUATERNIONS // timestamp+sizeof(quat)*xyz*nquat
mapellil 0:e93a11b4e044 31 #define SIZEOF_FLOAT_QUAT 2+4*3
mapellil 0:e93a11b4e044 32
mapellil 0:e93a11b4e044 33
mapellil 8:b042fe719f51 34 const LongUUIDBytes_t SOFTWARE_SERVICE_UUID_128 = { 0x1b,0xc5,0xa5,0xd5,0x02,0x00,0xb4,0x9a,0xe1,0x11,0x02,0x00,0x00,0x00,0x00,0x00};
mapellil 8:b042fe719f51 35 const LongUUIDBytes_t QUATERNIONS_CHAR_UUID_128 = { 0x1b,0xc5,0xa5,0xd5,0x02,0x00,0x36,0xac,0xe1,0x11,0x01,0x00,0x00,0x01,0x00,0x00};
mapellil 8:b042fe719f51 36 const LongUUIDBytes_t QUATERNIONS_FLOAT_CHAR_UUID_128 = { 0x1b,0xc5,0xa5,0xd5,0x02,0x00,0x36,0xac,0xe1,0x11,0x01,0x00,0x80,0x00,0x00,0x00};
mapellil 0:e93a11b4e044 37
mapellil 0:e93a11b4e044 38 /* Custom Software Service */
mapellil 0:e93a11b4e044 39 class CustomSoftwareService {
mapellil 0:e93a11b4e044 40 public:
mapellil 8:b042fe719f51 41 CustomSoftwareService(BLEDevice &_ble) :
mapellil 0:e93a11b4e044 42 ble(_ble),
mapellil 0:e93a11b4e044 43 swQuaternionsCharacteristic(QUATERNIONS_CHAR_UUID_128, swQuaternions, SIZEOF_QUAT, SIZEOF_QUAT,
mapellil 0:e93a11b4e044 44 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY),
mapellil 0:e93a11b4e044 45 swFloatQuaternionsCharacteristic(QUATERNIONS_FLOAT_CHAR_UUID_128, swFloatQuaternions, SIZEOF_FLOAT_QUAT, SIZEOF_FLOAT_QUAT,
mapellil 0:e93a11b4e044 46 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)
mapellil 0:e93a11b4e044 47 {
mapellil 0:e93a11b4e044 48
mapellil 0:e93a11b4e044 49 static bool serviceAdded = false; /* We should only ever need to add the heart rate service once. */
mapellil 0:e93a11b4e044 50 if (serviceAdded) {
mapellil 0:e93a11b4e044 51 return;
mapellil 0:e93a11b4e044 52 }
mapellil 0:e93a11b4e044 53
mapellil 0:e93a11b4e044 54 GattCharacteristic *charTable[] = {&swQuaternionsCharacteristic, &swFloatQuaternionsCharacteristic};
mapellil 0:e93a11b4e044 55
mapellil 0:e93a11b4e044 56 GattService quaternionsService(SOFTWARE_SERVICE_UUID_128, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
mapellil 0:e93a11b4e044 57
mapellil 0:e93a11b4e044 58 ble.gattServer().addService(quaternionsService);
mapellil 0:e93a11b4e044 59
mapellil 0:e93a11b4e044 60 isEnabledQuatNotify = false;
mapellil 0:e93a11b4e044 61 isEnabledFloatQuatnotify = false;
mapellil 0:e93a11b4e044 62
mapellil 0:e93a11b4e044 63 memset (swQuaternions, 0, SIZEOF_QUAT);
mapellil 0:e93a11b4e044 64 memset (swFloatQuaternions, 0, SIZEOF_FLOAT_QUAT);
mapellil 0:e93a11b4e044 65
mapellil 0:e93a11b4e044 66 serviceAdded = true;
mapellil 0:e93a11b4e044 67 }
mapellil 0:e93a11b4e044 68
mapellil 8:b042fe719f51 69 uint32_t updateQuaternions(AxesRaw_TypeDef *data, uint16_t TimeStamp) {
mapellil 8:b042fe719f51 70 STORE_LE_16(swQuaternions ,TimeStamp);
mapellil 0:e93a11b4e044 71 #if SEND_N_QUATERNIONS == 1
mapellil 8:b042fe719f51 72 STORE_LE_16(swQuaternions+2,data[0].AXIS_X);
mapellil 8:b042fe719f51 73 STORE_LE_16(swQuaternions+4,data[0].AXIS_Y);
mapellil 8:b042fe719f51 74 STORE_LE_16(swQuaternions+6,data[0].AXIS_Z);
mapellil 0:e93a11b4e044 75 #elif SEND_N_QUATERNIONS == 2
mapellil 8:b042fe719f51 76 STORE_LE_16(swQuaternions+2,data[0].AXIS_X);
mapellil 8:b042fe719f51 77 STORE_LE_16(swQuaternions+4,data[0].AXIS_Y);
mapellil 8:b042fe719f51 78 STORE_LE_16(swQuaternions+6,data[0].AXIS_Z);
mapellil 0:e93a11b4e044 79
mapellil 8:b042fe719f51 80 STORE_LE_16(swQuaternions+8 ,data[1].AXIS_X);
mapellil 8:b042fe719f51 81 STORE_LE_16(swQuaternions+10,data[1].AXIS_Y);
mapellil 8:b042fe719f51 82 STORE_LE_16(swQuaternions+12,data[1].AXIS_Z);
mapellil 0:e93a11b4e044 83 #elif SEND_N_QUATERNIONS == 3
mapellil 8:b042fe719f51 84 STORE_LE_16(swQuaternions+2,data[0].AXIS_X);
mapellil 8:b042fe719f51 85 STORE_LE_16(swQuaternions+4,data[0].AXIS_Y);
mapellil 8:b042fe719f51 86 STORE_LE_16(swQuaternions+6,data[0].AXIS_Z);
mapellil 0:e93a11b4e044 87
mapellil 8:b042fe719f51 88 STORE_LE_16(swQuaternions+8 ,data[1].AXIS_X);
mapellil 8:b042fe719f51 89 STORE_LE_16(swQuaternions+10,data[1].AXIS_Y);
mapellil 8:b042fe719f51 90 STORE_LE_16(swQuaternions+12,data[1].AXIS_Z);
mapellil 0:e93a11b4e044 91
mapellil 8:b042fe719f51 92 STORE_LE_16(swQuaternions+14,data[2].AXIS_X);
mapellil 8:b042fe719f51 93 STORE_LE_16(swQuaternions+16,data[2].AXIS_Y);
mapellil 8:b042fe719f51 94 STORE_LE_16(swQuaternions+18,data[2].AXIS_Z);
mapellil 0:e93a11b4e044 95 #else
mapellil 0:e93a11b4e044 96 #error SEND_N_QUATERNIONS could be only 1,2,3
mapellil 0:e93a11b4e044 97 #endif
mapellil 8:b042fe719f51 98 return ble.gattServer().write(swQuaternionsCharacteristic.getValueAttribute().getHandle(), swQuaternions, SIZEOF_QUAT,0);
mapellil 0:e93a11b4e044 99 }
mapellil 0:e93a11b4e044 100
mapellil 8:b042fe719f51 101 uint32_t updateFloatQuaternions(float *QuatFloat, uint16_t TimeStamp) {
mapellil 8:b042fe719f51 102 STORE_LE_16(swFloatQuaternions ,TimeStamp);
mapellil 8:b042fe719f51 103 STORE_LE_32(swFloatQuaternions+2 ,((uint32_t*)(QuatFloat))[0]);
mapellil 8:b042fe719f51 104 STORE_LE_32(swFloatQuaternions+6 ,((uint32_t*)(QuatFloat))[1]);
mapellil 8:b042fe719f51 105 STORE_LE_32(swFloatQuaternions+10,((uint32_t*)(QuatFloat))[2]);
mapellil 0:e93a11b4e044 106
mapellil 8:b042fe719f51 107 return ble.gattServer().write(swFloatQuaternionsCharacteristic.getValueAttribute().getHandle(), swFloatQuaternions, SIZEOF_FLOAT_QUAT,0);
mapellil 0:e93a11b4e044 108 }
mapellil 0:e93a11b4e044 109
mapellil 0:e93a11b4e044 110 void enNotify (Gap::Handle_t handle) {
mapellil 0:e93a11b4e044 111 if (isQuatHandle(handle)) { isEnabledQuatNotify = true; return; }
mapellil 0:e93a11b4e044 112 if (isFloatQuatHandle(handle)) { isEnabledFloatQuatnotify = true; return; }
mapellil 0:e93a11b4e044 113 }
mapellil 0:e93a11b4e044 114
mapellil 0:e93a11b4e044 115 void disNotify (Gap::Handle_t handle) {
mapellil 0:e93a11b4e044 116 if (isQuatHandle(handle)) { isEnabledQuatNotify = false; return; }
mapellil 0:e93a11b4e044 117 if (isFloatQuatHandle(handle)) { isEnabledFloatQuatnotify = false; return; }
mapellil 0:e93a11b4e044 118 }
mapellil 0:e93a11b4e044 119
mapellil 0:e93a11b4e044 120 bool isQuatHandle (Gap::Handle_t handle) {
mapellil 0:e93a11b4e044 121 if (handle == swQuaternionsCharacteristic.getValueAttribute().getHandle()) return true;
mapellil 0:e93a11b4e044 122 return false;
mapellil 0:e93a11b4e044 123 }
mapellil 0:e93a11b4e044 124
mapellil 0:e93a11b4e044 125 bool isFloatQuatHandle (Gap::Handle_t handle) {
mapellil 0:e93a11b4e044 126 if (handle == swFloatQuaternionsCharacteristic.getValueAttribute().getHandle()) return true;
mapellil 0:e93a11b4e044 127 return false;
mapellil 0:e93a11b4e044 128 }
mapellil 0:e93a11b4e044 129
mapellil 0:e93a11b4e044 130 void updateConnectionStatus(ConnectionStatus_t status) {
mapellil 0:e93a11b4e044 131 isEnabledQuatNotify = false;
mapellil 0:e93a11b4e044 132 isEnabledFloatQuatnotify = false;
mapellil 0:e93a11b4e044 133 memset (swQuaternions, 0, SIZEOF_QUAT);
mapellil 0:e93a11b4e044 134 memset (swFloatQuaternions, 0, SIZEOF_FLOAT_QUAT);
mapellil 0:e93a11b4e044 135 }
mapellil 0:e93a11b4e044 136
mapellil 0:e93a11b4e044 137 private:
mapellil 8:b042fe719f51 138 BLEDevice &ble;
mapellil 0:e93a11b4e044 139 GattCharacteristic swQuaternionsCharacteristic;
mapellil 0:e93a11b4e044 140 GattCharacteristic swFloatQuaternionsCharacteristic;
mapellil 8:b042fe719f51 141
mapellil 0:e93a11b4e044 142 uint8_t swQuaternions[SIZEOF_QUAT];
mapellil 0:e93a11b4e044 143 uint8_t swFloatQuaternions[SIZEOF_FLOAT_QUAT];
mapellil 8:b042fe719f51 144
mapellil 0:e93a11b4e044 145 bool isEnabledQuatNotify;
mapellil 0:e93a11b4e044 146 bool isEnabledFloatQuatnotify;
mapellil 8:b042fe719f51 147
mapellil 8:b042fe719f51 148 ConnectionStatus_t isBTLEConnected;
mapellil 0:e93a11b4e044 149 };
mapellil 0:e93a11b4e044 150
mapellil 0:e93a11b4e044 151 #endif /* #ifndef __CUSTOM_BLE_CONFIG_SERVICE_H__*/