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:
Thu Oct 19 07:43:37 2017 +0000
Revision:
36:7abc45e9b0a5
Parent:
33:dec779879624
Updated libs

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mapellil 9:2693f9ef8ff7 1 /**
mapellil 9:2693f9ef8ff7 2 ******************************************************************************
mapellil 9:2693f9ef8ff7 3 * @file main.h
mapellil 9:2693f9ef8ff7 4 * @author Central Labs / AST
mapellil 9:2693f9ef8ff7 5 * @version V0.9.0
mapellil 9:2693f9ef8ff7 6 * @date 23-Dec-2015
mapellil 9:2693f9ef8ff7 7 * @brief Main program body
mapellil 9:2693f9ef8ff7 8 ******************************************************************************
mapellil 9:2693f9ef8ff7 9 * @attention
mapellil 9:2693f9ef8ff7 10 *
mapellil 9:2693f9ef8ff7 11 * <h2><center>&copy; COPYRIGHT(c) 2015 STMicroelectronics</center></h2>
mapellil 9:2693f9ef8ff7 12 *
mapellil 9:2693f9ef8ff7 13 * Redistribution and use in source and binary forms, with or without modification,
mapellil 9:2693f9ef8ff7 14 * are permitted provided that the following conditions are met:
mapellil 9:2693f9ef8ff7 15 * 1. Redistributions of source code must retain the above copyright notice,
mapellil 9:2693f9ef8ff7 16 * this list of conditions and the following disclaimer.
mapellil 9:2693f9ef8ff7 17 * 2. Redistributions in binary form must reproduce the above copyright notice,
mapellil 9:2693f9ef8ff7 18 * this list of conditions and the following disclaimer in the documentation
mapellil 9:2693f9ef8ff7 19 * and/or other materials provided with the distribution.
mapellil 9:2693f9ef8ff7 20 * 3. Neither the name of STMicroelectronics nor the names of its contributors
mapellil 9:2693f9ef8ff7 21 * may be used to endorse or promote products derived from this software
mapellil 9:2693f9ef8ff7 22 * without specific prior written permission.
mapellil 9:2693f9ef8ff7 23 *
mapellil 9:2693f9ef8ff7 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
mapellil 9:2693f9ef8ff7 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
mapellil 9:2693f9ef8ff7 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
mapellil 9:2693f9ef8ff7 27 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
mapellil 9:2693f9ef8ff7 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
mapellil 9:2693f9ef8ff7 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
mapellil 9:2693f9ef8ff7 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
mapellil 9:2693f9ef8ff7 31 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
mapellil 9:2693f9ef8ff7 32 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
mapellil 9:2693f9ef8ff7 33 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
mapellil 9:2693f9ef8ff7 34 *
mapellil 9:2693f9ef8ff7 35 ******************************************************************************
mapellil 9:2693f9ef8ff7 36 */
mapellil 0:e93a11b4e044 37
mapellil 0:e93a11b4e044 38 #ifndef __MAIN_H__
mapellil 0:e93a11b4e044 39 #define __MAIN_H__
mapellil 0:e93a11b4e044 40
mapellil 0:e93a11b4e044 41 /* Enable the following define for printout the calibration value
mapellil 0:e93a11b4e044 42 read/written from/to Memory */
mapellil 0:e93a11b4e044 43 //#define BLUEMSYS_DEBUG_CALIB
mapellil 27:dccb3b0fae57 44 #define CUST_CONS_SERV // Uncomment to enable console service
mapellil 0:e93a11b4e044 45 //#define CUST_BATT_SERV // Uncomment to enable battery service /** FIXME tb implemented **/
mapellil 0:e93a11b4e044 46
mapellil 0:e93a11b4e044 47 #define CUST_SENS_SERV // Uncomment to enable env/MEMS sensor service
mapellil 0:e93a11b4e044 48 #define DS3_ONBOARD false // deft DS3 module NOT plugged onto MEMS exp board
mapellil 0:e93a11b4e044 49 //#define DS3_ONBOARD true // Uncomment if DS3 module is plugged onto MEMS exp board
mapellil 0:e93a11b4e044 50
mapellil 0:e93a11b4e044 51 #ifdef USE_SENSOR_FUSION_LIB // if sensor fusion lib present enable calibration service and quaternion service
mapellil 33:dec779879624 52 #define USE_IKS01A2 // this MotionFX porting is for IKS01A2 only (sensor orientation)
mapellil 26:1bc571e52ad9 53 #define CUST_CONFIG_SERV // enable magnetometer calibration service
mapellil 28:a1364ca7b456 54 //#define BLUEMSYS_STORE_CALIB_FLASH // enable flash storage of calibration data only for 401RE
mapellil 0:e93a11b4e044 55 #define CUST_SW_SERV // enable quaternion service
mapellil 0:e93a11b4e044 56 #endif
mapellil 0:e93a11b4e044 57
mapellil 0:e93a11b4e044 58 /*************** Debug Defines ******************/
mapellil 0:e93a11b4e044 59 /* For enabling connection and notification subscriptions debug */
mapellil 0:e93a11b4e044 60 //#define BLUEMSYS_DEBUG_CONNECTION
mapellil 0:e93a11b4e044 61
mapellil 0:e93a11b4e044 62 /* For enabling trasmission for notified services (except for quaternions) */
mapellil 0:e93a11b4e044 63 //#define BLUEMSYS_DEBUG_NOTIFY_TRAMISSION
mapellil 0:e93a11b4e044 64
mapellil 0:e93a11b4e044 65 #define MAX_I2C_SPEED 400000
mapellil 6:c1b8fb74072e 66 #define NUCLEO_I2C_SHIELDS_SPEED MAX_I2C_SPEED // I2C speed in Hz
mapellil 0:e93a11b4e044 67
mapellil 20:b97e14ade434 68 #define ENV_TIMER 500 // 500 mSec
mapellil 20:b97e14ade434 69 #define CALIB_TIMER 400 // 40mS
mapellil 20:b97e14ade434 70 #define MEMS_TIMER 10 // 10mS
mapellil 20:b97e14ade434 71
mapellil 20:b97e14ade434 72 #define FROM_MG_TO_G 0.001f
mapellil 20:b97e14ade434 73 #define FROM_G_TO_MG 1000.0f
mapellil 20:b97e14ade434 74 #define FROM_MDPS_TO_DPS 0.001f
mapellil 20:b97e14ade434 75 #define FROM_DPS_TO_MDPS 1000.0f
mapellil 20:b97e14ade434 76 #define FROM_MGAUSS_TO_UT50 (0.1f/50.0f)
mapellil 20:b97e14ade434 77 #define FROM_UT50_TO_MGAUSS 500.0f
mapellil 20:b97e14ade434 78
mapellil 20:b97e14ade434 79 #define MOTIONFX_ENGINE_DELTATIME 0.01f
mapellil 20:b97e14ade434 80 #define SAMPLE_PERIOD ((uint8_t)10) /* [ms] */
mapellil 0:e93a11b4e044 81
mapellil 0:e93a11b4e044 82 /*************** Don't Change the following defines *************/
mapellil 0:e93a11b4e044 83 /* Calibration mask for Sensor fusion short precision */
mapellil 0:e93a11b4e044 84 #define MASK_CALIB_SENSORFUSION_SHORT 0x00000100
mapellil 0:e93a11b4e044 85 /* Calibration mask for Sensor fusion float precision */
mapellil 0:e93a11b4e044 86 #define MASK_CALIB_SENSORFUSION_FLOAT 0x00000080
mapellil 0:e93a11b4e044 87 /* W2ST command for asking the calibration status */
mapellil 0:e93a11b4e044 88 #define W2ST_COMMAND_CAL_STATUS 0xFF
mapellil 0:e93a11b4e044 89 /* W2ST command for resetting the calibration */
mapellil 0:e93a11b4e044 90 #define W2ST_COMMAND_CAL_RESET 0x00
mapellil 0:e93a11b4e044 91 /* W2ST command for stopping the calibration process */
mapellil 0:e93a11b4e044 92 #define W2ST_COMMAND_CAL_STOP 0x01
mapellil 0:e93a11b4e044 93 /****************************************************************/
mapellil 0:e93a11b4e044 94
mapellil 32:f47005b845b4 95 #define BLE_DEV_NAME "MotEnvMbedOS"
mapellil 0:e93a11b4e044 96 #define BLE_DEV_MAC 0xFF,0x00,0x25,0xAA,0x02,0x04
mapellil 0:e93a11b4e044 97 #define QUAT_FLOAT_UPDATE_MUL_10MS 2
mapellil 0:e93a11b4e044 98 #define ACC_GYRO_MAG_UPDATE_MUL_10MS 10
mapellil 0:e93a11b4e044 99
mapellil 0:e93a11b4e044 100 #define BLUEMSYS_CHECK_CALIBRATION ((uint32_t)0x12345678)
mapellil 0:e93a11b4e044 101
mapellil 0:e93a11b4e044 102 #define BUTTON_TIME 1.0 // 1.0Sec
mapellil 0:e93a11b4e044 103 #define BLUEMSYS_N_BUTTON_PRESS 3 // n push button in BUTTON_TIME
mapellil 0:e93a11b4e044 104
mapellil 20:b97e14ade434 105 /** Valid only for F401RE **/
mapellil 0:e93a11b4e044 106 #ifdef BLUEMSYS_STORE_CALIB_FLASH
mapellil 0:e93a11b4e044 107 #define BLUEMSYS_FLASH_ADD ((uint32_t)0x08060000)
mapellil 0:e93a11b4e044 108 #define BLUEMSYS_FLASH_SECTOR FLASH_SECTOR_7
mapellil 0:e93a11b4e044 109 #endif /* BLUEMSYS_STORE_CALIB_FLASH */
mapellil 0:e93a11b4e044 110
mapellil 8:b042fe719f51 111 #define BLE_TX_SKIP_NUM 30
mapellil 0:e93a11b4e044 112 #define BLE_ADVERTISING_INTERVAL 1000
mapellil 0:e93a11b4e044 113 //#define BLE_ADVERTISING_INTERVAL 160 /* 100ms; in multiples of 0.625ms. */
mapellil 0:e93a11b4e044 114
mapellil 13:d00147d01d4e 115 #define BLE_HANDLE_EN_DIS_OFFSET 2 // Offset from En/Dis UUID 2902 to UUID 2803 (Characteristic UUID)
mapellil 13:d00147d01d4e 116 #define BLE_HANDLE_VALUE_OFFSET 1 // Offset from Value UUID xxx to to UUID 2803 (Characteristic UUID)
mapellil 13:d00147d01d4e 117
mapellil 26:1bc571e52ad9 118 #if defined (SENSOR_TILE) && !defined(MINI_CRADLE)
mapellil 20:b97e14ade434 119 #include <stdio.h>
mapellil 20:b97e14ade434 120 /* redirect printf on the Sensor Tile UART5 allowing printf throgh the Nucleo USB connector
mapellil 20:b97e14ade434 121 (close the cradle and the Nucleo solder bridges to re-route the UART) */
mapellil 20:b97e14ade434 122 static Serial ser(PC_12,PD_2);
mapellil 26:1bc571e52ad9 123 #define printf(...) ser.printf(__VA_ARGS__)
mapellil 26:1bc571e52ad9 124 #else
mapellil 26:1bc571e52ad9 125 #if defined (SENSOR_TILE) && defined(MINI_CRADLE)
mapellil 26:1bc571e52ad9 126 #define printf(...)
mapellil 20:b97e14ade434 127 #endif
mapellil 26:1bc571e52ad9 128 #endif
mapellil 26:1bc571e52ad9 129
mapellil 20:b97e14ade434 130
mapellil 20:b97e14ade434 131
mapellil 20:b97e14ade434 132 typedef struct
mapellil 20:b97e14ade434 133 {
mapellil 20:b97e14ade434 134 int32_t AXIS_X;
mapellil 20:b97e14ade434 135 int32_t AXIS_Y;
mapellil 20:b97e14ade434 136 int32_t AXIS_Z;
mapellil 20:b97e14ade434 137 } SensorAxes_t;
mapellil 13:d00147d01d4e 138
mapellil 0:e93a11b4e044 139 typedef enum ConnectionStatus_t {
mapellil 0:e93a11b4e044 140 DISCONNECTED =0,
mapellil 0:e93a11b4e044 141 CONNECTED =1
mapellil 0:e93a11b4e044 142 }cns_t;
mapellil 0:e93a11b4e044 143
mapellil 0:e93a11b4e044 144 const unsigned LENGTH_OF_LONG_UUID = 16;
mapellil 0:e93a11b4e044 145 typedef uint16_t ShortUUIDBytes_t;
mapellil 20:b97e14ade434 146 //typedef uint8_t LongUUIDBytes_t[LENGTH_OF_LONG_UUID];
mapellil 0:e93a11b4e044 147
mapellil 0:e93a11b4e044 148 #ifdef __cplusplus
mapellil 0:e93a11b4e044 149 extern "C" {
mapellil 0:e93a11b4e044 150 #endif
mapellil 0:e93a11b4e044 151
mapellil 0:e93a11b4e044 152 #ifdef __cplusplus
mapellil 0:e93a11b4e044 153 }
mapellil 0:e93a11b4e044 154 #endif
mapellil 0:e93a11b4e044 155
mapellil 0:e93a11b4e044 156 #endif // ifndef __MAIN_H__