ST / Mbed OS Node_BLE_Sensors_Device

Dependencies:   X_NUCLEO_IKS01A2

Fork of Node_BLE_Switch_Device by ST

Bluetooth Low Energy enabled device with environmental and inertial features, i.e. "Pressure", "Humidity", "Temperature", "Accelerometer", "Gyroscope", and "Magnetometer", plus "Switch" feature, compatible with BlueST Protocol.

Committer:
Davidroid
Date:
Tue May 22 16:35:05 2018 +0000
Revision:
6:01d49589410e
Parent:
5:445024130101
Child:
7:2b5ed57b088c
Add Inertial sensors

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Davidroid 0:6b34c49b5285 1 /**
Davidroid 0:6b34c49b5285 2 *******************************************************************************
Davidroid 0:6b34c49b5285 3 * @file CustomService.h
Davidroid 0:6b34c49b5285 4 * @author Davide Aliprandi, STMicroelectronics
Davidroid 0:6b34c49b5285 5 * @version V1.0.0
Davidroid 0:6b34c49b5285 6 * @date March 31st, 2018
Davidroid 0:6b34c49b5285 7 * @brief mbed test application for the STMicroelectronics X-NUCLEO-IDB05A1
Davidroid 0:6b34c49b5285 8 * Bluetooth Low energy Expansion Board.
Davidroid 0:6b34c49b5285 9 *******************************************************************************
Davidroid 0:6b34c49b5285 10 * @attention
Davidroid 0:6b34c49b5285 11 *
Davidroid 0:6b34c49b5285 12 * <h2><center>&copy; COPYRIGHT(c) 2018 STMicroelectronics</center></h2>
Davidroid 0:6b34c49b5285 13 *
Davidroid 0:6b34c49b5285 14 * Redistribution and use in source and binary forms, with or without
Davidroid 0:6b34c49b5285 15 * modification, are permitted provided that the following conditions are met:
Davidroid 0:6b34c49b5285 16 * 1. Redistributions of source code must retain the above copyright notice,
Davidroid 0:6b34c49b5285 17 * this list of conditions and the following disclaimer.
Davidroid 0:6b34c49b5285 18 * 2. Redistributions in binary form must reproduce the above copyright
Davidroid 0:6b34c49b5285 19 * notice, this list of conditions and the following disclaimer in the
Davidroid 0:6b34c49b5285 20 * documentation and/or other materials provided with the distribution.
Davidroid 0:6b34c49b5285 21 * 3. Neither the name of STMicroelectronics nor the names of its
Davidroid 0:6b34c49b5285 22 * contributors may be used to endorse or promote products derived from
Davidroid 0:6b34c49b5285 23 * this software without specific prior written permission.
Davidroid 0:6b34c49b5285 24 *
Davidroid 0:6b34c49b5285 25 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Davidroid 0:6b34c49b5285 26 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Davidroid 0:6b34c49b5285 27 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
Davidroid 0:6b34c49b5285 28 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS
Davidroid 0:6b34c49b5285 29 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
Davidroid 0:6b34c49b5285 30 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
Davidroid 0:6b34c49b5285 31 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
Davidroid 0:6b34c49b5285 32 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
Davidroid 0:6b34c49b5285 33 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
Davidroid 0:6b34c49b5285 34 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Davidroid 0:6b34c49b5285 35 * POSSIBILITY OF SUCH DAMAGE.
Davidroid 0:6b34c49b5285 36 *
Davidroid 0:6b34c49b5285 37 *******************************************************************************
Davidroid 0:6b34c49b5285 38 */
Davidroid 0:6b34c49b5285 39
Davidroid 0:6b34c49b5285 40
Davidroid 0:6b34c49b5285 41 #ifndef __BLE_CUSTOM_SERVICE_H__
Davidroid 0:6b34c49b5285 42 #define __BLE_CUSTOM_SERVICE_H__
Davidroid 0:6b34c49b5285 43
Davidroid 6:01d49589410e 44
Davidroid 6:01d49589410e 45 /* Includes ------------------------------------------------------------------*/
Davidroid 6:01d49589410e 46
Davidroid 0:6b34c49b5285 47 #include "ble_utils.h"
Davidroid 0:6b34c49b5285 48
Davidroid 6:01d49589410e 49
Davidroid 6:01d49589410e 50 /* Definitions ---------------------------------------------------------------*/
Davidroid 6:01d49589410e 51
Davidroid 6:01d49589410e 52 #define TIMESTAMP_LENGTH (sizeof(uint16_t))
Davidroid 6:01d49589410e 53 #define STATE_LENGTH (sizeof(uint8_t))
Davidroid 6:01d49589410e 54 #define COMMAND_LENGTH (sizeof(uint8_t))
Davidroid 6:01d49589410e 55 #define PRESSURE_LENGTH (sizeof(uint32_t))
Davidroid 6:01d49589410e 56 #define HUMIDITY_LENGTH (sizeof(uint16_t))
Davidroid 6:01d49589410e 57 #define TEMPERATURE_LENGTH (sizeof(uint16_t))
Davidroid 6:01d49589410e 58 #define ACCELEROMETER_LENGTH (sizeof(uint16_t))
Davidroid 6:01d49589410e 59 #define GYROSCOPE_LENGTH (sizeof(uint16_t))
Davidroid 6:01d49589410e 60 #define MAGNETOMETER_LENGTH (sizeof(uint16_t))
Davidroid 6:01d49589410e 61
Davidroid 6:01d49589410e 62 #define STATE_DATA_LENGTH (TIMESTAMP_LENGTH + STATE_LENGTH)
Davidroid 6:01d49589410e 63 #define COMMAND_DATA_LENGTH (COMMAND_LENGTH)
Davidroid 6:01d49589410e 64 #define ENV_SENSORS_DATA_LENGTH (TIMESTAMP_LENGTH + PRESSURE_LENGTH + HUMIDITY_LENGTH + TEMPERATURE_LENGTH)
Davidroid 6:01d49589410e 65 #define INE_SENSORS_DATA_LENGTH (TIMESTAMP_LENGTH + (3 * ACCELEROMETER_LENGTH) + (3 * GYROSCOPE_LENGTH) + (3 * MAGNETOMETER_LENGTH))
Davidroid 6:01d49589410e 66
Davidroid 0:6b34c49b5285 67
Davidroid 6:01d49589410e 68 /* Types ---------------------------------------------------------------------*/
Davidroid 6:01d49589410e 69
Davidroid 6:01d49589410e 70 /* Axes. */
Davidroid 6:01d49589410e 71 typedef struct
Davidroid 6:01d49589410e 72 {
Davidroid 6:01d49589410e 73 int32_t x;
Davidroid 6:01d49589410e 74 int32_t y;
Davidroid 6:01d49589410e 75 int32_t z;
Davidroid 6:01d49589410e 76 } axes_t;
Davidroid 4:a10e2c94c8c8 77
Davidroid 6:01d49589410e 78
Davidroid 6:01d49589410e 79 /* Constants -----------------------------------------------------------------*/
Davidroid 6:01d49589410e 80
Davidroid 6:01d49589410e 81 const UUID::LongUUIDBytes_t CUSTOM_SERVICE_UUID = {0x00,0x00,0x00,0x00,0x00,0x01,0x11,0xe1,0xac,0x36,0x00,0x02,0xa5,0xd5,0xc5,0x1b};
Davidroid 6:01d49589410e 82 const UUID::LongUUIDBytes_t CUSTOM_SWITCH_CHARACTERISTIC_UUID = {0x20,0x00,0x00,0x00,0x00,0x01,0x11,0xe1,0xac,0x36,0x00,0x02,0xa5,0xd5,0xc5,0x1b};
Davidroid 6:01d49589410e 83 const UUID::LongUUIDBytes_t CUSTOM_ENV_SENSORS_CHARACTERISTIC_UUID = {0x00,0x1c,0x00,0x00,0x00,0x01,0x11,0xe1,0xac,0x36,0x00,0x02,0xa5,0xd5,0xc5,0x1b};
Davidroid 6:01d49589410e 84 const UUID::LongUUIDBytes_t CUSTOM_INE_SENSORS_CHARACTERISTIC_UUID = {0x00,0xe0,0x00,0x00,0x00,0x01,0x11,0xe1,0xac,0x36,0x00,0x02,0xa5,0xd5,0xc5,0x1b};
Davidroid 6:01d49589410e 85
Davidroid 6:01d49589410e 86
Davidroid 6:01d49589410e 87 /* Classes -------------------------------------------------------------------*/
Davidroid 0:6b34c49b5285 88
Davidroid 0:6b34c49b5285 89 class CustomService {
Davidroid 0:6b34c49b5285 90 public:
Davidroid 0:6b34c49b5285 91
Davidroid 0:6b34c49b5285 92 /* Switch states. */
Davidroid 0:6b34c49b5285 93 typedef enum
Davidroid 0:6b34c49b5285 94 {
Davidroid 0:6b34c49b5285 95 SWITCH_OFF = 0,
Davidroid 0:6b34c49b5285 96 SWITCH_ON
Davidroid 0:6b34c49b5285 97 } switch_state_t;
Davidroid 0:6b34c49b5285 98
Davidroid 0:6b34c49b5285 99 CustomService(BLEDevice &_ble) :
Davidroid 0:6b34c49b5285 100 ble(_ble),
Davidroid 4:a10e2c94c8c8 101 state_command(CUSTOM_SWITCH_CHARACTERISTIC_UUID, packed_state_command, STATE_DATA_LENGTH, STATE_DATA_LENGTH,
Davidroid 4:a10e2c94c8c8 102 /*GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | */GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY),
Davidroid 6:01d49589410e 103 env_sensors(CUSTOM_ENV_SENSORS_CHARACTERISTIC_UUID, packed_env_sensors, ENV_SENSORS_DATA_LENGTH, ENV_SENSORS_DATA_LENGTH,
Davidroid 6:01d49589410e 104 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY),
Davidroid 6:01d49589410e 105 ine_sensors(CUSTOM_INE_SENSORS_CHARACTERISTIC_UUID, packed_ine_sensors, INE_SENSORS_DATA_LENGTH, INE_SENSORS_DATA_LENGTH,
Davidroid 4:a10e2c94c8c8 106 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)
Davidroid 0:6b34c49b5285 107 {
Davidroid 6:01d49589410e 108 GattCharacteristic *char_table[] = {&state_command, &env_sensors, &ine_sensors};
Davidroid 6:01d49589410e 109 GattService iot_service(CUSTOM_SERVICE_UUID, char_table, sizeof(char_table) / sizeof(GattCharacteristic *));
Davidroid 6:01d49589410e 110 ble.addService(iot_service);
Davidroid 4:a10e2c94c8c8 111 memset (packed_state_command, 0, STATE_DATA_LENGTH);
Davidroid 6:01d49589410e 112 memset (packed_env_sensors, 0, ENV_SENSORS_DATA_LENGTH);
Davidroid 6:01d49589410e 113 memset (packed_ine_sensors, 0, INE_SENSORS_DATA_LENGTH);
Davidroid 0:6b34c49b5285 114 }
Davidroid 0:6b34c49b5285 115
Davidroid 0:6b34c49b5285 116 void send_state(uint16_t time_stamp, uint8_t current_state) {
Davidroid 4:a10e2c94c8c8 117 memset (packed_state_command, 0, STATE_DATA_LENGTH);
Davidroid 0:6b34c49b5285 118 STORE_LE_16(packed_state_command, time_stamp);
Davidroid 4:a10e2c94c8c8 119 packed_state_command[TIMESTAMP_LENGTH] = current_state;
Davidroid 4:a10e2c94c8c8 120 ble.gattServer().write(get_state_command_handle(), (uint8_t *) &packed_state_command, STATE_DATA_LENGTH, 0);
Davidroid 0:6b34c49b5285 121 }
Davidroid 0:6b34c49b5285 122
Davidroid 6:01d49589410e 123 void send_env_sensors(
Davidroid 6:01d49589410e 124 uint16_t time_stamp,
Davidroid 6:01d49589410e 125 float pressure, float humidity, float temperature
Davidroid 6:01d49589410e 126 ) {
Davidroid 6:01d49589410e 127 memset (packed_env_sensors, 0, ENV_SENSORS_DATA_LENGTH);
Davidroid 4:a10e2c94c8c8 128 int p = 0;
Davidroid 6:01d49589410e 129 STORE_LE_16(&packed_env_sensors[p], time_stamp);
Davidroid 5:445024130101 130 p += TIMESTAMP_LENGTH;
Davidroid 6:01d49589410e 131 STORE_LE_32(&packed_env_sensors[p], (uint32_t) (pressure * 10));
Davidroid 5:445024130101 132 p += PRESSURE_LENGTH;
Davidroid 6:01d49589410e 133 STORE_LE_16(&packed_env_sensors[p], (uint16_t) (humidity * 10));
Davidroid 5:445024130101 134 p += HUMIDITY_LENGTH;
Davidroid 6:01d49589410e 135 STORE_LE_16(&packed_env_sensors[p], (uint16_t) (temperature * 10));
Davidroid 6:01d49589410e 136 ble.gattServer().write(get_env_sensors_handle(), (uint8_t *) &packed_env_sensors, ENV_SENSORS_DATA_LENGTH, 0);
Davidroid 6:01d49589410e 137 }
Davidroid 6:01d49589410e 138
Davidroid 6:01d49589410e 139 void send_ine_sensors(
Davidroid 6:01d49589410e 140 uint16_t time_stamp,
Davidroid 6:01d49589410e 141 axes_t *accelerometer, axes_t *gyroscope, axes_t *magnetometer
Davidroid 6:01d49589410e 142 ) {
Davidroid 6:01d49589410e 143 memset (packed_ine_sensors, 0, INE_SENSORS_DATA_LENGTH);
Davidroid 6:01d49589410e 144 int p = 0;
Davidroid 6:01d49589410e 145 STORE_LE_16(&packed_ine_sensors[p], time_stamp);
Davidroid 6:01d49589410e 146 p += TIMESTAMP_LENGTH;
Davidroid 6:01d49589410e 147 STORE_LE_16(&packed_ine_sensors[p], (int16_t) accelerometer->x);
Davidroid 6:01d49589410e 148 p += ACCELEROMETER_LENGTH;
Davidroid 6:01d49589410e 149 STORE_LE_16(&packed_ine_sensors[p], (int16_t) accelerometer->y);
Davidroid 6:01d49589410e 150 p += ACCELEROMETER_LENGTH;
Davidroid 6:01d49589410e 151 STORE_LE_16(&packed_ine_sensors[p], (int16_t) accelerometer->z);
Davidroid 6:01d49589410e 152 p += ACCELEROMETER_LENGTH;
Davidroid 6:01d49589410e 153 STORE_LE_16(&packed_ine_sensors[p], (int16_t) gyroscope->x);
Davidroid 6:01d49589410e 154 p += GYROSCOPE_LENGTH;
Davidroid 6:01d49589410e 155 STORE_LE_16(&packed_ine_sensors[p], (int16_t) gyroscope->y);
Davidroid 6:01d49589410e 156 p += GYROSCOPE_LENGTH;
Davidroid 6:01d49589410e 157 STORE_LE_16(&packed_ine_sensors[p], (int16_t) gyroscope->z);
Davidroid 6:01d49589410e 158 p += GYROSCOPE_LENGTH;
Davidroid 6:01d49589410e 159 STORE_LE_16(&packed_ine_sensors[p], (int16_t) magnetometer->x);
Davidroid 6:01d49589410e 160 p += MAGNETOMETER_LENGTH;
Davidroid 6:01d49589410e 161 STORE_LE_16(&packed_ine_sensors[p], (int16_t) magnetometer->y);
Davidroid 6:01d49589410e 162 p += MAGNETOMETER_LENGTH;
Davidroid 6:01d49589410e 163 STORE_LE_16(&packed_ine_sensors[p], (int16_t) magnetometer->z);
Davidroid 6:01d49589410e 164 ble.gattServer().write(get_ine_sensors_handle(), (uint8_t *) &packed_ine_sensors, INE_SENSORS_DATA_LENGTH, 0);
Davidroid 4:a10e2c94c8c8 165 }
Davidroid 4:a10e2c94c8c8 166
Davidroid 4:a10e2c94c8c8 167 GattAttribute::Handle_t get_state_command_handle() const
Davidroid 0:6b34c49b5285 168 {
Davidroid 0:6b34c49b5285 169 return state_command.getValueAttribute().getHandle();
Davidroid 0:6b34c49b5285 170 }
Davidroid 0:6b34c49b5285 171
Davidroid 6:01d49589410e 172 GattAttribute::Handle_t get_env_sensors_handle() const
Davidroid 4:a10e2c94c8c8 173 {
Davidroid 6:01d49589410e 174 return env_sensors.getValueAttribute().getHandle();
Davidroid 6:01d49589410e 175 }
Davidroid 6:01d49589410e 176
Davidroid 6:01d49589410e 177 GattAttribute::Handle_t get_ine_sensors_handle() const
Davidroid 6:01d49589410e 178 {
Davidroid 6:01d49589410e 179 return ine_sensors.getValueAttribute().getHandle();
Davidroid 4:a10e2c94c8c8 180 }
Davidroid 4:a10e2c94c8c8 181
Davidroid 0:6b34c49b5285 182 private:
Davidroid 0:6b34c49b5285 183 BLEDevice &ble;
Davidroid 0:6b34c49b5285 184 GattCharacteristic state_command;
Davidroid 6:01d49589410e 185 GattCharacteristic env_sensors;
Davidroid 6:01d49589410e 186 GattCharacteristic ine_sensors;
Davidroid 4:a10e2c94c8c8 187 uint8_t packed_state_command[STATE_DATA_LENGTH];
Davidroid 6:01d49589410e 188 uint8_t packed_env_sensors[ENV_SENSORS_DATA_LENGTH];
Davidroid 6:01d49589410e 189 uint8_t packed_ine_sensors[INE_SENSORS_DATA_LENGTH];
Davidroid 0:6b34c49b5285 190 };
Davidroid 0:6b34c49b5285 191
Davidroid 0:6b34c49b5285 192 #endif /* #ifndef __BLE_CUSTOM_SERVICE_H__ */