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:
Fri May 18 18:41:27 2018 +0000
Revision:
5:445024130101
Parent:
4:a10e2c94c8c8
Child:
6:01d49589410e
Environmental data plus Switch feature

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Davidroid 0:6b34c49b5285 1 /**
Davidroid 0:6b34c49b5285 2 *******************************************************************************
Davidroid 0:6b34c49b5285 3 * @file main.cpp
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 /* Includes ------------------------------------------------------------------*/
Davidroid 0:6b34c49b5285 42
Davidroid 0:6b34c49b5285 43 /* mbed specific header files. */
Davidroid 0:6b34c49b5285 44 #include <events/mbed_events.h>
Davidroid 0:6b34c49b5285 45 #include <mbed.h>
Davidroid 0:6b34c49b5285 46 #include "ble/BLE.h"
Davidroid 0:6b34c49b5285 47 #include "CustomService.h"
Davidroid 4:a10e2c94c8c8 48 #include "XNucleoIKS01A2.h"
Davidroid 0:6b34c49b5285 49
Davidroid 0:6b34c49b5285 50
Davidroid 0:6b34c49b5285 51 /* Definitions ---------------------------------------------------------------*/
Davidroid 0:6b34c49b5285 52
Davidroid 0:6b34c49b5285 53 #define BLE_ADVERTISING_INTERVAL_ms 1000
Davidroid 0:6b34c49b5285 54 #define BLUETOOTH_PERIODIC_CALLBACK_ms 500
Davidroid 0:6b34c49b5285 55 #define DELAY_1 100
Davidroid 0:6b34c49b5285 56
Davidroid 0:6b34c49b5285 57
Davidroid 0:6b34c49b5285 58 /* Types ---------------------------------------------------------------------*/
Davidroid 0:6b34c49b5285 59
Davidroid 0:6b34c49b5285 60 /* Toggle state. */
Davidroid 0:6b34c49b5285 61 typedef enum
Davidroid 0:6b34c49b5285 62 {
Davidroid 0:6b34c49b5285 63 TOGGLE_OFF = 0,
Davidroid 0:6b34c49b5285 64 TOGGLE_ON
Davidroid 0:6b34c49b5285 65 } toggle_t;
Davidroid 0:6b34c49b5285 66
Davidroid 0:6b34c49b5285 67
Davidroid 0:6b34c49b5285 68 /* Variables -----------------------------------------------------------------*/
Davidroid 0:6b34c49b5285 69
Davidroid 0:6b34c49b5285 70 /* Button state. */
Davidroid 0:6b34c49b5285 71 bool toggle_state;
Davidroid 0:6b34c49b5285 72
Davidroid 0:6b34c49b5285 73 /* LED to indicate system state. */
Davidroid 0:6b34c49b5285 74 DigitalOut led_state(LED1); //Conflicts with SPI CLK on D13.
Davidroid 0:6b34c49b5285 75
Davidroid 0:6b34c49b5285 76 /* Bluetooth. */
Davidroid 4:a10e2c94c8c8 77 const static char DEVICE_NAME[] = "SENSORS_DEVICE";
Davidroid 4:a10e2c94c8c8 78 const static uint8_t MANUFACTURER_SPECIFIC_DATA[]= {0x01,0x80,0x20,0x1c,0x00,0x00};
Davidroid 0:6b34c49b5285 79 static EventQueue event_queue(/* event count */ 10 * EVENTS_EVENT_SIZE);
Davidroid 0:6b34c49b5285 80 CustomService *custom_service;
Davidroid 0:6b34c49b5285 81
Davidroid 0:6b34c49b5285 82 /* Button event. */
Davidroid 0:6b34c49b5285 83 InterruptIn event(USER_BUTTON);
Davidroid 0:6b34c49b5285 84
Davidroid 4:a10e2c94c8c8 85 /* Instantiate the expansion board */
Davidroid 4:a10e2c94c8c8 86 static XNucleoIKS01A2 *mems_expansion_board = XNucleoIKS01A2::instance(D14, D15, D4, D5);
Davidroid 4:a10e2c94c8c8 87
Davidroid 4:a10e2c94c8c8 88 /* Components. */
Davidroid 4:a10e2c94c8c8 89 //static LSM303AGRMagSensor *magnetometer = mems_expansion_board->magnetometer;
Davidroid 4:a10e2c94c8c8 90 static HTS221Sensor *hum_temp = mems_expansion_board->ht_sensor;
Davidroid 4:a10e2c94c8c8 91 static LPS22HBSensor *press_temp = mems_expansion_board->pt_sensor;
Davidroid 4:a10e2c94c8c8 92 //static LSM6DSLSensor *acc_gyro = mems_expansion_board->acc_gyro;
Davidroid 4:a10e2c94c8c8 93 //static LSM303AGRAccSensor *accelerometer = mems_expansion_board->accelerometer;
Davidroid 4:a10e2c94c8c8 94
Davidroid 4:a10e2c94c8c8 95 static uint16_t time_stamp = 0;
Davidroid 4:a10e2c94c8c8 96
Davidroid 4:a10e2c94c8c8 97
Davidroid 4:a10e2c94c8c8 98 /* Custom service related functions ------------------------------------------*/
Davidroid 4:a10e2c94c8c8 99
Davidroid 4:a10e2c94c8c8 100 void button_callback(void) {
Davidroid 4:a10e2c94c8c8 101 toggle_state = true;
Davidroid 4:a10e2c94c8c8 102 }
Davidroid 4:a10e2c94c8c8 103
Davidroid 4:a10e2c94c8c8 104 void get_sensors(float *pressure, float *humidity, float *temperature) {
Davidroid 4:a10e2c94c8c8 105 press_temp->get_pressure(pressure);
Davidroid 4:a10e2c94c8c8 106 hum_temp->get_humidity(humidity);
Davidroid 4:a10e2c94c8c8 107 hum_temp->get_temperature(temperature);
Davidroid 4:a10e2c94c8c8 108 }
Davidroid 4:a10e2c94c8c8 109
Davidroid 0:6b34c49b5285 110
Davidroid 0:6b34c49b5285 111 /* Bluetooth related functions -----------------------------------------------*/
Davidroid 0:6b34c49b5285 112
Davidroid 0:6b34c49b5285 113 void on_disconnection_callback(const Gap::DisconnectionCallbackParams_t *params)
Davidroid 0:6b34c49b5285 114 {
Davidroid 0:6b34c49b5285 115 (void) params;
Davidroid 0:6b34c49b5285 116 BLE::Instance().gap().startAdvertising();
Davidroid 0:6b34c49b5285 117 }
Davidroid 0:6b34c49b5285 118
Davidroid 0:6b34c49b5285 119 /**
Davidroid 0:6b34c49b5285 120 * This callback allows the custom service to read updates from the
Davidroid 0:6b34c49b5285 121 * characteristic.
Davidroid 0:6b34c49b5285 122 *
Davidroid 0:6b34c49b5285 123 * @param[in] params
Davidroid 0:6b34c49b5285 124 * Information about the characterisitc being updated.
Davidroid 0:6b34c49b5285 125 */
Davidroid 0:6b34c49b5285 126 void on_data_read_callback(const GattReadCallbackParams *params) {
Davidroid 4:a10e2c94c8c8 127 /* Reading characteristic and sending it via bluetooth. */
Davidroid 4:a10e2c94c8c8 128 if (params->handle == custom_service->get_sensors_handle()) {
Davidroid 0:6b34c49b5285 129 if (BLE::Instance().getGapState().connected) {
Davidroid 4:a10e2c94c8c8 130 float pressure, humidity, temperature;
Davidroid 4:a10e2c94c8c8 131 get_sensors(&pressure, &humidity, &temperature);
Davidroid 5:445024130101 132 event_queue.call(Callback<void(uint16_t, uint32_t, uint16_t, uint16_t)>(custom_service, &CustomService::send_sensors), time_stamp++, (uint32_t) (pressure * 10), (uint16_t) (humidity * 10), (uint16_t) (temperature * 10));
Davidroid 4:a10e2c94c8c8 133 //printf("Sensors: (%d) %d %d %d\r\n", time_stamp, (uint32_t) (pressure * 100), (uint16_t) (humidity * 10), (uint16_t) (temperature * 10));
Davidroid 0:6b34c49b5285 134 }
Davidroid 0:6b34c49b5285 135 }
Davidroid 0:6b34c49b5285 136 }
Davidroid 0:6b34c49b5285 137
Davidroid 0:6b34c49b5285 138 /**
Davidroid 0:6b34c49b5285 139 * This callback allows the custom service to write updates to the
Davidroid 0:6b34c49b5285 140 * characteristic.
Davidroid 0:6b34c49b5285 141 *
Davidroid 0:6b34c49b5285 142 * @param[in] params
Davidroid 0:6b34c49b5285 143 * Information about the characterisitc being updated.
Davidroid 0:6b34c49b5285 144 */
Davidroid 0:6b34c49b5285 145 void on_data_written_callback(const GattWriteCallbackParams *params) {
Davidroid 4:a10e2c94c8c8 146 /* Receiving data via bluetooth and writing it to the characteristic. */
Davidroid 4:a10e2c94c8c8 147 if (params->handle == custom_service->get_state_command_handle()) {
Davidroid 0:6b34c49b5285 148 led_state.write(((CustomService::switch_state_t) ((uint8_t *) (params->data))[0]));
Davidroid 4:a10e2c94c8c8 149 }
Davidroid 0:6b34c49b5285 150 }
Davidroid 0:6b34c49b5285 151
Davidroid 0:6b34c49b5285 152 /**
Davidroid 4:a10e2c94c8c8 153 * This function is called periodically and sends notifications.
Davidroid 0:6b34c49b5285 154 */
Davidroid 0:6b34c49b5285 155 void periodic_callback(void)
Davidroid 0:6b34c49b5285 156 {
Davidroid 4:a10e2c94c8c8 157 /* Reading toggle command and sending it via bluetooth, if needed. */
Davidroid 0:6b34c49b5285 158 if (toggle_state) {
Davidroid 0:6b34c49b5285 159 if (BLE::Instance().getGapState().connected) {
Davidroid 0:6b34c49b5285 160 event_queue.call(Callback<void(uint16_t, uint8_t)>(custom_service, &CustomService::send_state), time_stamp++, toggle_state ? TOGGLE_ON : TOGGLE_OFF);
Davidroid 0:6b34c49b5285 161 toggle_state = false;
Davidroid 0:6b34c49b5285 162 }
Davidroid 0:6b34c49b5285 163 }
Davidroid 4:a10e2c94c8c8 164
Davidroid 4:a10e2c94c8c8 165 /* Reading sensors and sending data via bluetooth. */
Davidroid 4:a10e2c94c8c8 166 if (BLE::Instance().getGapState().connected) {
Davidroid 4:a10e2c94c8c8 167 float pressure, humidity, temperature;
Davidroid 4:a10e2c94c8c8 168 get_sensors(&pressure, &humidity, &temperature);
Davidroid 5:445024130101 169 event_queue.call(Callback<void(uint16_t, uint32_t, uint16_t, uint16_t)>(custom_service, &CustomService::send_sensors), time_stamp++, (uint32_t) (pressure * 10), (uint16_t) (humidity * 10), (uint16_t) (temperature * 10));
Davidroid 4:a10e2c94c8c8 170 //printf("Sensors: (%d) %d %d %d\r\n", time_stamp, (uint32_t) (pressure * 100), (uint16_t) (humidity * 10), (uint16_t) (temperature * 10));
Davidroid 4:a10e2c94c8c8 171 }
Davidroid 0:6b34c49b5285 172 }
Davidroid 0:6b34c49b5285 173
Davidroid 0:6b34c49b5285 174 /**
Davidroid 0:6b34c49b5285 175 * This function is called when the ble initialization process has failled.
Davidroid 0:6b34c49b5285 176 */
Davidroid 0:6b34c49b5285 177 void on_ble_init_error_callback(BLE &ble, ble_error_t error)
Davidroid 0:6b34c49b5285 178 {
Davidroid 0:6b34c49b5285 179 /* Initialization error handling should go here */
Davidroid 0:6b34c49b5285 180 }
Davidroid 0:6b34c49b5285 181
Davidroid 0:6b34c49b5285 182 /**
Davidroid 0:6b34c49b5285 183 * Callback triggered when the ble initialization process has finished.
Davidroid 0:6b34c49b5285 184 */
Davidroid 0:6b34c49b5285 185 void ble_init_complete(BLE::InitializationCompleteCallbackContext *params)
Davidroid 0:6b34c49b5285 186 {
Davidroid 0:6b34c49b5285 187 BLE& ble = params->ble;
Davidroid 0:6b34c49b5285 188 ble_error_t error = params->error;
Davidroid 0:6b34c49b5285 189
Davidroid 0:6b34c49b5285 190 if (error != BLE_ERROR_NONE) {
Davidroid 0:6b34c49b5285 191 /* In case of error, forward the error handling to on_ble_init_error_callback */
Davidroid 0:6b34c49b5285 192 on_ble_init_error_callback(ble, error);
Davidroid 0:6b34c49b5285 193 return;
Davidroid 0:6b34c49b5285 194 }
Davidroid 0:6b34c49b5285 195
Davidroid 0:6b34c49b5285 196 /* Ensure that it is the default instance of BLE */
Davidroid 0:6b34c49b5285 197 if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) {
Davidroid 0:6b34c49b5285 198 return;
Davidroid 0:6b34c49b5285 199 }
Davidroid 0:6b34c49b5285 200
Davidroid 0:6b34c49b5285 201 ble.gap().onDisconnection(on_disconnection_callback);
Davidroid 0:6b34c49b5285 202 ble.gattServer().onDataWritten(on_data_written_callback);
Davidroid 4:a10e2c94c8c8 203 ble.gattServer().onDataRead(on_data_read_callback);
Davidroid 0:6b34c49b5285 204
Davidroid 0:6b34c49b5285 205 custom_service = new CustomService(ble);
Davidroid 0:6b34c49b5285 206
Davidroid 0:6b34c49b5285 207 /* Setup advertising data. */
Davidroid 0:6b34c49b5285 208 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
Davidroid 4:a10e2c94c8c8 209 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS, (uint8_t *) CUSTOM_SERVICE_UUID, sizeof(CUSTOM_SERVICE_UUID));
Davidroid 0:6b34c49b5285 210 ble.gap().accumulateScanResponse(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, MANUFACTURER_SPECIFIC_DATA, sizeof(MANUFACTURER_SPECIFIC_DATA));
Davidroid 3:b880b9a9ccdf 211 ble.gap().accumulateScanResponse(GapAdvertisingData::COMPLETE_LOCAL_NAME, (const uint8_t *) DEVICE_NAME, sizeof(DEVICE_NAME) - 1);
Davidroid 0:6b34c49b5285 212 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
Davidroid 0:6b34c49b5285 213 ble.gap().setAdvertisingInterval(BLE_ADVERTISING_INTERVAL_ms);
Davidroid 0:6b34c49b5285 214 ble.gap().startAdvertising();
Davidroid 0:6b34c49b5285 215 }
Davidroid 0:6b34c49b5285 216
Davidroid 0:6b34c49b5285 217 void schedule_ble_events_processing(BLE::OnEventsToProcessCallbackContext* context) {
Davidroid 0:6b34c49b5285 218 BLE &ble = BLE::Instance();
Davidroid 0:6b34c49b5285 219 event_queue.call(Callback<void()>(&ble, &BLE::processEvents));
Davidroid 0:6b34c49b5285 220 }
Davidroid 0:6b34c49b5285 221
Davidroid 0:6b34c49b5285 222
Davidroid 0:6b34c49b5285 223 /* Main function -------------------------------------------------------------*/
Davidroid 0:6b34c49b5285 224
Davidroid 0:6b34c49b5285 225 int main()
Davidroid 0:6b34c49b5285 226 {
Davidroid 0:6b34c49b5285 227 /*----- Initialization. -----*/
Davidroid 0:6b34c49b5285 228
Davidroid 0:6b34c49b5285 229 /* Printing to the console. */
Davidroid 4:a10e2c94c8c8 230 printf("Sensors Node Application Example\r\n\n");
Davidroid 0:6b34c49b5285 231
Davidroid 0:6b34c49b5285 232 /* Bluetooth. */
Davidroid 0:6b34c49b5285 233 event_queue.call_every(BLUETOOTH_PERIODIC_CALLBACK_ms, periodic_callback);
Davidroid 0:6b34c49b5285 234 BLE &ble = BLE::Instance();
Davidroid 0:6b34c49b5285 235 ble.onEventsToProcess(schedule_ble_events_processing);
Davidroid 0:6b34c49b5285 236 ble.init(ble_init_complete);
Davidroid 0:6b34c49b5285 237
Davidroid 0:6b34c49b5285 238 /* Attaching and enabling interrupt handlers. */
Davidroid 0:6b34c49b5285 239 event.fall(button_callback);
Davidroid 0:6b34c49b5285 240
Davidroid 0:6b34c49b5285 241 /* Setting up initial state: led OFF, no toggle state. */
Davidroid 0:6b34c49b5285 242 led_state.write(CustomService::SWITCH_OFF);
Davidroid 0:6b34c49b5285 243 toggle_state = false;
Davidroid 4:a10e2c94c8c8 244
Davidroid 4:a10e2c94c8c8 245 /* Enabling sensors. */
Davidroid 4:a10e2c94c8c8 246 hum_temp->enable();
Davidroid 4:a10e2c94c8c8 247 press_temp->enable();
Davidroid 0:6b34c49b5285 248
Davidroid 0:6b34c49b5285 249 /* Start. */
Davidroid 0:6b34c49b5285 250 event_queue.dispatch_forever();
Davidroid 0:6b34c49b5285 251
Davidroid 0:6b34c49b5285 252 return 0;
Davidroid 0:6b34c49b5285 253 }