SunTracker_BLE

Dependencies:   BLE_API X_NUCLEO_6180XA1 X_NUCLEO_IDB0XA1 X_NUCLEO_IHM01A1 X_NUCLEO_IKS01A1 mbed

Fork of SunTracker_BLE by ST Expansion SW Team

Overview

The SunTracker is a demo application running on ST Nucleo-F401RE stacking a set of ST X-NUCLEO expansion boards.
Main features provided are:

  • A solar panel follows the light source, orienting the panel in order to achieve the best panel efficiency.
  • Orientation is controlled thanks to a couple of VL6180X FlightSense light sensors mounted on a X-NUCLEO-6180XA1 expansion board and driven by X-NUCLEO-IHM01A1 controlled stepper motor acting as actuator to orientate the panel.
  • The system features a progressive control on the stepper motor in order to modulate the panel rotation speed according to the light angle.
  • The application is also able to control the panel productivity reading the panel voltage through an ADC and proving feedback on the local display.
  • A manual orientation is possible by using the accelerometer on a X-NUCLEO-IKS01A1 expansion board that, according on board tilt, controls the speed and the rotate direction.
  • A remote control is available using a X-NUCLEO-IDB04A1 or a X-NUCLEO-IDB05A1 Bluetooth Low Energy expansion board. Remote control software is here.

/media/uploads/fabiombed/suntracker_server-client.png

Working Status

  • SunTracker has 3 working status visible on FlightSense display and switchable by pressing the User Button:

Status 0 (Idle)

  • Motor: Free Turning
  • Display: Waiting for User Button

Status 1

  • Motor: Driven by Light
  • Display: Direction and Light Intensity = Direction and Motor Speed

Status 2

  • Motor: Driven by Light
  • Display: Solar Panel Efficiency

Status 3

  • Motor: Driven by Accelerometer
  • Display: Direction and Accelerometer Intensity

Server Startup

  • When you plug the power supply, the word ‘PUSH’ is shown on display.
  • You can manually rotate the structure to assign the ‘Zero Point’. Then press the User Button to launch the application.
  • The display will show this status, which means that the structure is oriented to maximize the efficiency of the solar panel.
  • If there is a light displacement, the structure will rotate, left or right, to follow the light source and on display is shown the direction and the speed.
  • You can press the User Button to show the panel efficiency with 4 digits that represent the range from 0v (0000) to 3,3v (3300).
  • Further pressing the User Button you will manual rotate the panel by tilt the Server or Client accelerometer depending by BLE connection.

Client Startup

  • The Client application can remotely control the User Button and the Accelerometer functions.
  • Power on the Client AFTER the Server, it will automatically search for the SunTracker and will establish a BLE connection.
  • The Green Led on Nucleo Client board will be powered on.

Rotation Features

  • It has been implemented a block of rotation to avoid cables twist.
  • The blocking point can be set in the firmware by changing a constant.
  • You can manually rotate the structure to assign the ‘Zero Point’ before press the User Button to launch the application.
  • The system features a progressive control on the stepper motor in order to modulate the rotation speed according to the light or accelerometer angle.

List of Components

SERVER SunTracker_BLE

  • Stepper Motor 400’’ (Part Number 5350401) - To orientate the Mechanical Structure.
  • Solar Panel 0.446w (Part Number 0194127) - To capture sunlight and generate electrical current.
  • Power Supply 12v (Part Number 7262993) - To provide power supply at the Stepper Motor.
  • Flat Cable 6 ways (Part Number 1807010) - To plug VL6180X-SATEL with X-NUCLEO-6180XA1 (60cm length each x2).
  • Cable Connector (Part Number 6737694) - To plug the Flat Cable (x4).
  • Power Connector (Part Number 0487842) - To provide Power Supply to X-NUCLEO-IHM01A1.

CLIENT SunTracker_BLE_Remote

MECHANICAL STRUCTURE

Find here the STL files to print with a 3D printer.

/media/uploads/fabiombed/assembly.png

/media/uploads/fabiombed/mechanical_structure_and_motor_legs.png

FLAT CABLE ASSEMBLY

/media/uploads/fabiombed/flat_cable.png

HARDWARE SETUP

Nucleo ADC + Solar Panel

Connect Solar Panel cables to Nucleo Morpho PC_3 (white) and Nucleo Morpho GND (black). Connect a capacitor 10uF between PC_3 and GND to stabilize its voltage value shown on display.

EasySpin (L6474) + BLE

Hardware conflict between EasySpin DIR1 and BLE Reset, both on same Arduino Pin PA_8. Disconnect PA_8 between EasySpin and Nucleo by fold EasySpin Pin. PB_2 has been configured as EasySpin DIR1 in the firmware . Connect Nucleo Morpho PB_2 to FlightSense Arduino PA_8 by a wire.

FlightSense Satellites

In case of instability with I2C due to long flat cables, solder 4 SMD capacitors 47pF on FlightSense board in parallel between R15, R16, R17, R18 and plug 2 capacitors 15pF between FlightSense Arduino PB_8 and PB_9 to GND pin to cut-off noises over 720 KHz.

Arduino & Morpho Pinout

/media/uploads/fabiombed/arduino_pinout.png /media/uploads/fabiombed/morpho_pinout.png

Committer:
fabiombed
Date:
Wed Mar 16 19:17:08 2016 +0000
Revision:
14:644f9e7278e9
Parent:
8:144855fe02bd
Child:
15:019b8d60c89d
Update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
fabiombed 4:1d3d071a4c2c 1 /******************************************************************************
fabiombed 5:76fb6b783487 2 * @file CustomSensorsService.h
fabiombed 5:76fb6b783487 3 * @author Fabio Brembilla
fabiombed 5:76fb6b783487 4 * @version V1.0.0
fabiombed 6:4cbf7303b496 5 * @date January, 2016
fabiombed 5:76fb6b783487 6 * @brief SunTracker Custom Service for BlueTooth (IDB0XA1 expansion board)
fabiombed 5:76fb6b783487 7 *****************************************************************************
fabiombed 5:76fb6b783487 8 * @attention
fabiombed 5:76fb6b783487 9 *
fabiombed 5:76fb6b783487 10 * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
fabiombed 5:76fb6b783487 11 *
fabiombed 5:76fb6b783487 12 * Redistribution and use in source and binary forms, with or without modification,
fabiombed 5:76fb6b783487 13 * are permitted provided that the following conditions are met:
fabiombed 5:76fb6b783487 14 * 1. Redistributions of source code must retain the above copyright notice,
fabiombed 5:76fb6b783487 15 * this list of conditions and the following disclaimer.
fabiombed 5:76fb6b783487 16 * 2. Redistributions in binary form must reproduce the above copyright notice,
fabiombed 5:76fb6b783487 17 * this list of conditions and the following disclaimer in the documentation
fabiombed 5:76fb6b783487 18 * and/or other materials provided with the distribution.
fabiombed 5:76fb6b783487 19 * 3. Neither the name of STMicroelectronics nor the names of its contributors
fabiombed 5:76fb6b783487 20 * may be used to endorse or promote products derived from this software
fabiombed 5:76fb6b783487 21 * without specific prior written permission.
fabiombed 5:76fb6b783487 22 *
fabiombed 5:76fb6b783487 23 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
fabiombed 5:76fb6b783487 24 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
fabiombed 5:76fb6b783487 25 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
fabiombed 5:76fb6b783487 26 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
fabiombed 5:76fb6b783487 27 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
fabiombed 5:76fb6b783487 28 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
fabiombed 5:76fb6b783487 29 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
fabiombed 5:76fb6b783487 30 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
fabiombed 5:76fb6b783487 31 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
fabiombed 5:76fb6b783487 32 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
fabiombed 5:76fb6b783487 33 *
fabiombed 5:76fb6b783487 34 ******************************************************************************
fabiombed 5:76fb6b783487 35 */
fabiombed 4:1d3d071a4c2c 36
fabiombed 4:1d3d071a4c2c 37 #include "BLE.h"
fabiombed 5:76fb6b783487 38 #include "UUID.h"
fabiombed 4:1d3d071a4c2c 39
fabiombed 14:644f9e7278e9 40 /* BLE Services: Primary + 3 Secondary (Char Desk) */
fabiombed 14:644f9e7278e9 41 //const LongUUIDBytes_t SENS_SERVICE_UUID_128 = {0x00,0x00,0x00,0x00,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B}; //Primary
fabiombed 14:644f9e7278e9 42 //const LongUUIDBytes_t SENS_DIFFERENCE_CHAR_UUID_128 = {0x00,0x00,0x00,0x01,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B}; //Difference Light/Mems
fabiombed 14:644f9e7278e9 43 //const LongUUIDBytes_t SENS_POSITION_CHAR_UUID_128 = {0x00,0x00,0x00,0x02,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B}; //Motor Position
fabiombed 14:644f9e7278e9 44 //const LongUUIDBytes_t SENS_SUNPANEL_CHAR_UUID_128 = {0x00,0x00,0x00,0x03,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B,0x0B}; //SunPanel Voltage
fabiombed 14:644f9e7278e9 45 const ShortUUIDBytes_t SENS_SERVICE_UUID_128 = 0xB000; //Primary
fabiombed 14:644f9e7278e9 46 const ShortUUIDBytes_t SENS_DIFFERENCE_CHAR_UUID_128 = 0xB001; //Difference Light/Mems Sensors
fabiombed 14:644f9e7278e9 47 const ShortUUIDBytes_t SENS_POSITION_CHAR_UUID_128 = 0xB002; //Motor Position
fabiombed 14:644f9e7278e9 48 const ShortUUIDBytes_t SENS_SUNPANEL_CHAR_UUID_128 = 0xB003; //SunPanel Voltage
fabiombed 14:644f9e7278e9 49
fabiombed 14:644f9e7278e9 50 #define DIFFERENCE_DATA_LEN 4
fabiombed 14:644f9e7278e9 51 #define POSITION_DATA_LEN 4
fabiombed 14:644f9e7278e9 52 #define SUNPANEL_DATA_LEN 4
fabiombed 4:1d3d071a4c2c 53
fabiombed 4:1d3d071a4c2c 54 /* Custom Sensors Service */
fabiombed 4:1d3d071a4c2c 55 class CustomSensorService {
fabiombed 4:1d3d071a4c2c 56 public:
fabiombed 4:1d3d071a4c2c 57 CustomSensorService(BLEDevice &_ble) :
fabiombed 4:1d3d071a4c2c 58 ble(_ble),
fabiombed 14:644f9e7278e9 59 differenceCharacteristic(SENS_DIFFERENCE_CHAR_UUID_128, envDifference, DIFFERENCE_DATA_LEN, DIFFERENCE_DATA_LEN,
fabiombed 14:644f9e7278e9 60 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY),
fabiombed 5:76fb6b783487 61 positionCharacteristic(SENS_POSITION_CHAR_UUID_128, envPosition, POSITION_DATA_LEN, POSITION_DATA_LEN,
fabiombed 5:76fb6b783487 62 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY),
fabiombed 5:76fb6b783487 63 sunpanelCharacteristic(SENS_SUNPANEL_CHAR_UUID_128, envSunpanel, SUNPANEL_DATA_LEN, SUNPANEL_DATA_LEN,
fabiombed 7:54984d031243 64 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)
fabiombed 5:76fb6b783487 65 {
fabiombed 5:76fb6b783487 66 static bool serviceAdded = false; // To be sure to define just one time
fabiombed 4:1d3d071a4c2c 67 if (serviceAdded) {
fabiombed 4:1d3d071a4c2c 68 return;
fabiombed 4:1d3d071a4c2c 69 }
fabiombed 4:1d3d071a4c2c 70
fabiombed 14:644f9e7278e9 71 GattCharacteristic *charTable[] = {&differenceCharacteristic, &positionCharacteristic, &sunpanelCharacteristic};
fabiombed 14:644f9e7278e9 72 GattService envService(SENS_SERVICE_UUID_128, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
fabiombed 4:1d3d071a4c2c 73 ble.gattServer().addService(envService);
fabiombed 4:1d3d071a4c2c 74
fabiombed 14:644f9e7278e9 75 isEnabledDifferenceNotify = false;
fabiombed 5:76fb6b783487 76 isEnabledPositionNotify = false;
fabiombed 5:76fb6b783487 77 isEnabledSunpanelNotify = false;
fabiombed 14:644f9e7278e9 78 memset (envDifference, 0, DIFFERENCE_DATA_LEN);
fabiombed 14:644f9e7278e9 79 memset (envPosition, 0, POSITION_DATA_LEN);
fabiombed 14:644f9e7278e9 80 memset (envSunpanel, 0, SUNPANEL_DATA_LEN);
fabiombed 4:1d3d071a4c2c 81 isBTLEConnected = DISCONNECTED;
fabiombed 4:1d3d071a4c2c 82 serviceAdded = true;
fabiombed 4:1d3d071a4c2c 83 }
fabiombed 4:1d3d071a4c2c 84
fabiombed 5:76fb6b783487 85 // Tests Method
fabiombed 7:54984d031243 86
fabiombed 14:644f9e7278e9 87 void sendEnvDifference (uint32_t Dif) {
fabiombed 14:644f9e7278e9 88 STORE_LE_32(envDifference,Dif);
fabiombed 14:644f9e7278e9 89 PRINTF("sendEnvDifference handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed 14:644f9e7278e9 90 memcpy (pastenvDifference, envDifference, DIFFERENCE_DATA_LEN);
fabiombed 14:644f9e7278e9 91 ble.gattServer().write(differenceCharacteristic.getValueAttribute().getHandle(), envDifference, DIFFERENCE_DATA_LEN, 0);
fabiombed 14:644f9e7278e9 92 printf(" (Update)");
fabiombed 14:644f9e7278e9 93 }
fabiombed 14:644f9e7278e9 94
fabiombed 14:644f9e7278e9 95 void updateEnvDifference (uint32_t Temp) {
fabiombed 14:644f9e7278e9 96 if (memcmp (&pastenvDifference[0], &Temp, 4) != 0) {
fabiombed 14:644f9e7278e9 97 sendEnvDifference (Temp);
fabiombed 14:644f9e7278e9 98 }
fabiombed 14:644f9e7278e9 99 }
fabiombed 14:644f9e7278e9 100
fabiombed 14:644f9e7278e9 101 void sendEnvPosition (uint32_t Pos) {
fabiombed 14:644f9e7278e9 102 STORE_LE_32(envPosition,Pos);
fabiombed 14:644f9e7278e9 103 PRINTF("sendEnvPosition handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed 14:644f9e7278e9 104 memcpy (pastenvPosition, envPosition, POSITION_DATA_LEN);
fabiombed 14:644f9e7278e9 105 ble.gattServer().write(positionCharacteristic.getValueAttribute().getHandle(), envPosition, POSITION_DATA_LEN, 0);
fabiombed 14:644f9e7278e9 106 printf(" (Update)");
fabiombed 14:644f9e7278e9 107 }
fabiombed 14:644f9e7278e9 108
fabiombed 14:644f9e7278e9 109 void updateEnvPosition (uint32_t Temp) {
fabiombed 14:644f9e7278e9 110 if (memcmp (&pastenvPosition[0], &Temp, 4) != 0) {
fabiombed 14:644f9e7278e9 111 sendEnvPosition (Temp);
fabiombed 14:644f9e7278e9 112 }
fabiombed 14:644f9e7278e9 113 }
fabiombed 14:644f9e7278e9 114
fabiombed 14:644f9e7278e9 115 void sendEnvSunpanel (uint32_t Sun) {
fabiombed 14:644f9e7278e9 116 STORE_LE_32(envSunpanel,Sun);
fabiombed 14:644f9e7278e9 117 PRINTF("sendEnvSunpanel handle: %d\n\r", sunpanelCharacteristic.getValueAttribute().getHandle());
fabiombed 14:644f9e7278e9 118 memcpy (pastenvSunpanel, envSunpanel, SUNPANEL_DATA_LEN);
fabiombed 14:644f9e7278e9 119 ble.gattServer().write(sunpanelCharacteristic.getValueAttribute().getHandle(), envSunpanel, SUNPANEL_DATA_LEN, 0);
fabiombed 14:644f9e7278e9 120 printf(" (Update)");
fabiombed 14:644f9e7278e9 121 }
fabiombed 14:644f9e7278e9 122
fabiombed 14:644f9e7278e9 123 void updateEnvSunpanel (uint32_t Temp) {
fabiombed 14:644f9e7278e9 124 if (memcmp (&pastenvSunpanel[0], &Temp, 4) != 0) {
fabiombed 14:644f9e7278e9 125 sendEnvSunpanel (Temp);
fabiombed 14:644f9e7278e9 126 }
fabiombed 14:644f9e7278e9 127 }
fabiombed 14:644f9e7278e9 128
fabiombed 14:644f9e7278e9 129 /* with TimeStamp
fabiombed 14:644f9e7278e9 130
fabiombed 14:644f9e7278e9 131 void sendEnvDifference (int16_t Dif, uint16_t TimeStamp) {
fabiombed 14:644f9e7278e9 132 STORE_LE_16(envDifference,TimeStamp);
fabiombed 14:644f9e7278e9 133 STORE_LE_16(envDifference+2,Dif);
fabiombed 14:644f9e7278e9 134 PRINTF("sendEnvDifference!! handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed 14:644f9e7278e9 135 memcpy (pastenvDifference, envDifference, DIFFERENCE_DATA_LEN);
fabiombed 14:644f9e7278e9 136 ble.gattServer().write(differenceCharacteristic.getValueAttribute().getHandle(), envDifference, DIFFERENCE_DATA_LEN, 0);
fabiombed 14:644f9e7278e9 137 }
fabiombed 14:644f9e7278e9 138
fabiombed 14:644f9e7278e9 139 void updateEnvDifference (int16_t Temp, uint16_t TimeStamp) {
fabiombed 14:644f9e7278e9 140 if (memcmp (&pastenvDifference[2], &Temp, 2) != 0) {
fabiombed 14:644f9e7278e9 141 sendEnvDifference (Temp, TimeStamp);
fabiombed 14:644f9e7278e9 142 }
fabiombed 14:644f9e7278e9 143 }
fabiombed 14:644f9e7278e9 144
fabiombed 7:54984d031243 145 void sendEnvPosition (int16_t Pos, uint16_t TimeStamp) {
fabiombed 7:54984d031243 146 STORE_LE_16(envPosition,TimeStamp);
fabiombed 7:54984d031243 147 STORE_LE_16(envPosition+2,Pos);
fabiombed 14:644f9e7278e9 148 PRINTF("sendEnvPosition!! handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed 7:54984d031243 149 memcpy (pastenvPosition, envPosition, POSITION_DATA_LEN);
fabiombed 7:54984d031243 150 ble.gattServer().write(positionCharacteristic.getValueAttribute().getHandle(), envPosition, POSITION_DATA_LEN, 0);
fabiombed 7:54984d031243 151 }
fabiombed 7:54984d031243 152
fabiombed 14:644f9e7278e9 153 void updateEnvPosition (int16_t Temp, uint16_t TimeStamp) {
fabiombed 14:644f9e7278e9 154 if (memcmp (&pastenvPosition[2], &Temp, 2) != 0) {
fabiombed 14:644f9e7278e9 155 sendEnvPosition (Temp, TimeStamp);
fabiombed 14:644f9e7278e9 156 }
fabiombed 14:644f9e7278e9 157 }
fabiombed 14:644f9e7278e9 158
fabiombed 14:644f9e7278e9 159 void sendEnvSunpanel (int16_t Sun, uint16_t TimeStamp) {
fabiombed 14:644f9e7278e9 160 STORE_LE_16(envSunpanel,TimeStamp);
fabiombed 14:644f9e7278e9 161 STORE_LE_16(envSunpanel+2,Sun);
fabiombed 14:644f9e7278e9 162 PRINTF("sendEnvSunpanel!! handle: %d\n\r", sunpanelCharacteristic.getValueAttribute().getHandle());
fabiombed 14:644f9e7278e9 163 memcpy (pastenvSunpanel, envSunpanel, SUNPANEL_DATA_LEN);
fabiombed 14:644f9e7278e9 164 ble.gattServer().write(sunpanelCharacteristic.getValueAttribute().getHandle(), envSunpanel, SUNPANEL_DATA_LEN, 0);
fabiombed 14:644f9e7278e9 165 }
fabiombed 14:644f9e7278e9 166
fabiombed 14:644f9e7278e9 167 void updateEnvSunpanel (int16_t Temp, uint16_t TimeStamp) {
fabiombed 14:644f9e7278e9 168 if (memcmp (&pastenvSunpanel[2], &Temp, 2) != 0) {
fabiombed 14:644f9e7278e9 169 sendEnvSunpanel (Temp, TimeStamp);
fabiombed 14:644f9e7278e9 170 }
fabiombed 14:644f9e7278e9 171 }
fabiombed 14:644f9e7278e9 172
fabiombed 14:644f9e7278e9 173 */
fabiombed 14:644f9e7278e9 174
fabiombed 5:76fb6b783487 175 /*
fabiombed 5:76fb6b783487 176
fabiombed 4:1d3d071a4c2c 177 void sendEnvTemperature (int16_t Temp, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 178 STORE_LE_16(envTemperature,TimeStamp);
fabiombed 4:1d3d071a4c2c 179 STORE_LE_16(envTemperature+2,Temp);
fabiombed 4:1d3d071a4c2c 180 PRINTF("sendEnvTemperature!! handle: %d\n\r", envTemperatureCharacteristic.getValueAttribute().getHandle());
fabiombed 4:1d3d071a4c2c 181 memcpy (pastenvTemperature, envTemperature, TEMP_DATA_LEN);
fabiombed 4:1d3d071a4c2c 182 ble.gattServer().write(envTemperatureCharacteristic.getValueAttribute().getHandle(), envTemperature, TEMP_DATA_LEN, 0);
fabiombed 4:1d3d071a4c2c 183 }
fabiombed 4:1d3d071a4c2c 184
fabiombed 4:1d3d071a4c2c 185 void updateEnvTemperature (int16_t Temp, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 186 if (memcmp (&pastenvTemperature[2], &Temp, 2) != 0) {
fabiombed 4:1d3d071a4c2c 187 sendEnvTemperature (Temp, TimeStamp);
fabiombed 4:1d3d071a4c2c 188 }
fabiombed 4:1d3d071a4c2c 189 }
fabiombed 4:1d3d071a4c2c 190
fabiombed 4:1d3d071a4c2c 191 void sendEnvHumidity(uint16_t Hum, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 192 STORE_LE_16(envHumidity,TimeStamp);
fabiombed 4:1d3d071a4c2c 193 STORE_LE_16(envHumidity+2,Hum);
fabiombed 4:1d3d071a4c2c 194 memcpy (pastenvHumidity, envHumidity, HUM_DATA_LEN);
fabiombed 4:1d3d071a4c2c 195 ble.gattServer().write(envHumidityCharacteristic.getValueAttribute().getHandle(), envHumidity, HUM_DATA_LEN, 0);
fabiombed 4:1d3d071a4c2c 196
fabiombed 4:1d3d071a4c2c 197 }
fabiombed 4:1d3d071a4c2c 198
fabiombed 4:1d3d071a4c2c 199 void updateEnvHumidity(uint16_t Hum, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 200 if (memcmp (&pastenvHumidity[2], &Hum, 2) != 0) {
fabiombed 4:1d3d071a4c2c 201 sendEnvHumidity(Hum, TimeStamp);
fabiombed 4:1d3d071a4c2c 202 }
fabiombed 4:1d3d071a4c2c 203 }
fabiombed 4:1d3d071a4c2c 204
fabiombed 4:1d3d071a4c2c 205 void sendEnvPressure(uint32_t Press, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 206 STORE_LE_16(envPressure,TimeStamp);
fabiombed 4:1d3d071a4c2c 207 STORE_LE_32(envPressure+2,Press);
fabiombed 4:1d3d071a4c2c 208 memcpy (pastenvPressure, envPressure, PRES_DATA_LEN);
fabiombed 4:1d3d071a4c2c 209 ble.gattServer().write(envPressureCharacteristic.getValueAttribute().getHandle(), envPressure, PRES_DATA_LEN, 0);
fabiombed 4:1d3d071a4c2c 210 }
fabiombed 4:1d3d071a4c2c 211
fabiombed 4:1d3d071a4c2c 212 void updateEnvPressure(uint32_t Press, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 213 if (memcmp (&pastenvPressure[2], &Press, 2) != 0) {
fabiombed 4:1d3d071a4c2c 214 sendEnvPressure(Press, TimeStamp);
fabiombed 4:1d3d071a4c2c 215 }
fabiombed 4:1d3d071a4c2c 216 }
fabiombed 4:1d3d071a4c2c 217
fabiombed 4:1d3d071a4c2c 218 void sendEnvMagnetometer(AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed 4:1d3d071a4c2c 219 STORE_LE_16(envMagn,TimeStamp);
fabiombed 4:1d3d071a4c2c 220 STORE_LE_16(envMagn+2,(Magn->AXIS_X - magOffset.magOffX));
fabiombed 4:1d3d071a4c2c 221 STORE_LE_16(envMagn+4,(Magn->AXIS_Y - magOffset.magOffY));
fabiombed 4:1d3d071a4c2c 222 STORE_LE_16(envMagn+6,(Magn->AXIS_Z - magOffset.magOffZ));
fabiombed 4:1d3d071a4c2c 223 ble.gattServer().write(envMagnetometerCharacteristic.getValueAttribute().getHandle(), envMagn, MAG_DATA_LEN, 0);
fabiombed 4:1d3d071a4c2c 224 }
fabiombed 4:1d3d071a4c2c 225
fabiombed 4:1d3d071a4c2c 226 void updateEnvMagnetometer(AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed 4:1d3d071a4c2c 227 if (isMagNotificationEn()) sendEnvMagnetometer(Magn, TimeStamp, magOffset);
fabiombed 4:1d3d071a4c2c 228 }
fabiombed 4:1d3d071a4c2c 229
fabiombed 4:1d3d071a4c2c 230 void sendEnvAccelerometer (AxesRaw_TypeDef *Acc, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 231 STORE_LE_16(envAcce,TimeStamp);
fabiombed 4:1d3d071a4c2c 232 STORE_LE_16(envAcce+2,Acc->AXIS_X);
fabiombed 4:1d3d071a4c2c 233 STORE_LE_16(envAcce+4,Acc->AXIS_Y);
fabiombed 4:1d3d071a4c2c 234 STORE_LE_16(envAcce+6,Acc->AXIS_Z);
fabiombed 4:1d3d071a4c2c 235 ble.gattServer().write(envAccelerometerCharacteristic.getValueAttribute().getHandle(), envAcce, ACC_DATA_LEN, 0);
fabiombed 4:1d3d071a4c2c 236 }
fabiombed 4:1d3d071a4c2c 237
fabiombed 4:1d3d071a4c2c 238 void updateEnvAccelerometer (AxesRaw_TypeDef *Acc, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 239 if (isAccNotificationEn()) sendEnvAccelerometer (Acc, TimeStamp);
fabiombed 4:1d3d071a4c2c 240 }
fabiombed 4:1d3d071a4c2c 241
fabiombed 4:1d3d071a4c2c 242 void sendEnvGyroscope (AxesRaw_TypeDef *Gyro, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 243 STORE_LE_16(envGyro,TimeStamp);
fabiombed 4:1d3d071a4c2c 244 STORE_LE_16(envGyro+2,Gyro->AXIS_X);
fabiombed 4:1d3d071a4c2c 245 STORE_LE_16(envGyro+4,Gyro->AXIS_Y);
fabiombed 4:1d3d071a4c2c 246 STORE_LE_16(envGyro+6,Gyro->AXIS_Z);
fabiombed 4:1d3d071a4c2c 247 ble.gattServer().write(envGyroCharacteristic.getValueAttribute().getHandle(), envGyro, GYRO_DATA_LEN, 0);
fabiombed 4:1d3d071a4c2c 248 }
fabiombed 4:1d3d071a4c2c 249
fabiombed 4:1d3d071a4c2c 250 void updateEnvGyroscope (AxesRaw_TypeDef *Gyro, uint16_t TimeStamp) {
fabiombed 4:1d3d071a4c2c 251 if (isGyroNotificationEn()) sendEnvGyroscope (Gyro, TimeStamp);
fabiombed 4:1d3d071a4c2c 252 }
fabiombed 4:1d3d071a4c2c 253
fabiombed 4:1d3d071a4c2c 254 void sendEnvAccGyroMag (AxesRaw_TypeDef *Acc, AxesRaw_TypeDef *Gyro, AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed 4:1d3d071a4c2c 255 STORE_LE_16(envAccGyroMag,TimeStamp);
fabiombed 4:1d3d071a4c2c 256 STORE_LE_16(envAccGyroMag+2,Acc->AXIS_X);
fabiombed 4:1d3d071a4c2c 257 STORE_LE_16(envAccGyroMag+4,Acc->AXIS_Y);
fabiombed 4:1d3d071a4c2c 258 STORE_LE_16(envAccGyroMag+6,Acc->AXIS_Z);
fabiombed 4:1d3d071a4c2c 259
fabiombed 4:1d3d071a4c2c 260 STORE_LE_16(envAccGyroMag+8,Gyro->AXIS_X);
fabiombed 4:1d3d071a4c2c 261 STORE_LE_16(envAccGyroMag+10,Gyro->AXIS_Y);
fabiombed 4:1d3d071a4c2c 262 STORE_LE_16(envAccGyroMag+12,Gyro->AXIS_Z);
fabiombed 4:1d3d071a4c2c 263
fabiombed 4:1d3d071a4c2c 264 STORE_LE_16(envAccGyroMag+14,(Magn->AXIS_X - magOffset.magOffX));
fabiombed 4:1d3d071a4c2c 265 STORE_LE_16(envAccGyroMag+16,(Magn->AXIS_Y - magOffset.magOffY));
fabiombed 4:1d3d071a4c2c 266 STORE_LE_16(envAccGyroMag+18,(Magn->AXIS_Z - magOffset.magOffZ));
fabiombed 4:1d3d071a4c2c 267 ble.gattServer().write(envAccGyroMagCharacteristic.getValueAttribute().getHandle(), envAccGyroMag, ACCGYROMAG_DATA_LEN, 0);
fabiombed 4:1d3d071a4c2c 268 }
fabiombed 4:1d3d071a4c2c 269
fabiombed 4:1d3d071a4c2c 270 void updateEnvAccGyroMag (AxesRaw_TypeDef *Acc, AxesRaw_TypeDef *Gyro, AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed 4:1d3d071a4c2c 271 if (isAccGyroMagNotificationEn())sendEnvAccGyroMag (Acc, Gyro, Magn, TimeStamp, magOffset);
fabiombed 5:76fb6b783487 272 }
fabiombed 5:76fb6b783487 273
fabiombed 5:76fb6b783487 274 */
fabiombed 8:144855fe02bd 275
fabiombed 4:1d3d071a4c2c 276 void enNotify (Gap::Handle_t handle) {
fabiombed 14:644f9e7278e9 277 if (isDifferenceHandle(handle)) { isEnabledDifferenceNotify = true; memset(envDifference,0,DIFFERENCE_DATA_LEN); return; }
fabiombed 5:76fb6b783487 278 if (isPositionHandle(handle)) { isEnabledPositionNotify = true; memset(envPosition,0,POSITION_DATA_LEN); return; }
fabiombed 5:76fb6b783487 279 if (isSunpanelHandle(handle)) { isEnabledSunpanelNotify = true; memset(envSunpanel,0,SUNPANEL_DATA_LEN); return; }
fabiombed 4:1d3d071a4c2c 280 }
fabiombed 4:1d3d071a4c2c 281
fabiombed 4:1d3d071a4c2c 282 void disNotify (Gap::Handle_t handle) {
fabiombed 14:644f9e7278e9 283 if (isDifferenceHandle(handle)) { isEnabledDifferenceNotify = false; memset(envDifference,0,DIFFERENCE_DATA_LEN); return; }
fabiombed 5:76fb6b783487 284 if (isPositionHandle(handle)) { isEnabledPositionNotify = false; memset(envPosition,0,POSITION_DATA_LEN); return; }
fabiombed 5:76fb6b783487 285 if (isSunpanelHandle(handle)) { isEnabledSunpanelNotify = false; memset(envSunpanel,0,SUNPANEL_DATA_LEN); return; }
fabiombed 4:1d3d071a4c2c 286 }
fabiombed 4:1d3d071a4c2c 287
fabiombed 14:644f9e7278e9 288 bool isDifferenceNotificationEn (void) {
fabiombed 14:644f9e7278e9 289 return isEnabledDifferenceNotify;
fabiombed 14:644f9e7278e9 290 }
fabiombed 14:644f9e7278e9 291
fabiombed 5:76fb6b783487 292 bool isPositionNotificationEn (void) {
fabiombed 5:76fb6b783487 293 return isEnabledPositionNotify;
fabiombed 4:1d3d071a4c2c 294 }
fabiombed 4:1d3d071a4c2c 295
fabiombed 5:76fb6b783487 296 bool isSunpanelNotificationEn (void) {
fabiombed 5:76fb6b783487 297 return isEnabledSunpanelNotify;
fabiombed 5:76fb6b783487 298 }
fabiombed 5:76fb6b783487 299
fabiombed 14:644f9e7278e9 300 bool isDifferenceHandle (Gap::Handle_t handle) {
fabiombed 14:644f9e7278e9 301 if (handle == differenceCharacteristic.getValueAttribute().getHandle()) return true;
fabiombed 14:644f9e7278e9 302 return false;
fabiombed 14:644f9e7278e9 303 }
fabiombed 14:644f9e7278e9 304
fabiombed 5:76fb6b783487 305 bool isPositionHandle (Gap::Handle_t handle) {
fabiombed 5:76fb6b783487 306 if (handle == positionCharacteristic.getValueAttribute().getHandle()) return true;
fabiombed 4:1d3d071a4c2c 307 return false;
fabiombed 4:1d3d071a4c2c 308 }
fabiombed 4:1d3d071a4c2c 309
fabiombed 5:76fb6b783487 310 bool isSunpanelHandle (Gap::Handle_t handle) {
fabiombed 5:76fb6b783487 311 if (handle == sunpanelCharacteristic.getValueAttribute().getHandle()) return true;
fabiombed 4:1d3d071a4c2c 312 return false;
fabiombed 4:1d3d071a4c2c 313 }
fabiombed 4:1d3d071a4c2c 314
fabiombed 4:1d3d071a4c2c 315 void updateConnectionStatus(ConnectionStatus_t status) {
fabiombed 14:644f9e7278e9 316 isEnabledDifferenceNotify = false;
fabiombed 5:76fb6b783487 317 isEnabledPositionNotify = false;
fabiombed 5:76fb6b783487 318 isEnabledSunpanelNotify = false;
fabiombed 14:644f9e7278e9 319 memset (envDifference, 0, DIFFERENCE_DATA_LEN);
fabiombed 5:76fb6b783487 320 memset (envPosition, 0, POSITION_DATA_LEN);
fabiombed 5:76fb6b783487 321 memset (envSunpanel, 0, SUNPANEL_DATA_LEN);
fabiombed 4:1d3d071a4c2c 322 isBTLEConnected = status;
fabiombed 4:1d3d071a4c2c 323 }
fabiombed 4:1d3d071a4c2c 324
fabiombed 5:76fb6b783487 325 // Variables Initialization
fabiombed 4:1d3d071a4c2c 326 private:
fabiombed 4:1d3d071a4c2c 327
fabiombed 4:1d3d071a4c2c 328 BLEDevice &ble;
fabiombed 14:644f9e7278e9 329 uint8_t envDifference [DIFFERENCE_DATA_LEN];
fabiombed 5:76fb6b783487 330 uint8_t envPosition [POSITION_DATA_LEN];
fabiombed 5:76fb6b783487 331 uint8_t envSunpanel [SUNPANEL_DATA_LEN];
fabiombed 14:644f9e7278e9 332 uint8_t pastenvDifference [POSITION_DATA_LEN];
fabiombed 7:54984d031243 333 uint8_t pastenvPosition [POSITION_DATA_LEN];
fabiombed 7:54984d031243 334 uint8_t pastenvSunpanel [SUNPANEL_DATA_LEN];
fabiombed 7:54984d031243 335
fabiombed 14:644f9e7278e9 336 GattCharacteristic differenceCharacteristic;
fabiombed 5:76fb6b783487 337 GattCharacteristic positionCharacteristic;
fabiombed 5:76fb6b783487 338 GattCharacteristic sunpanelCharacteristic;
fabiombed 14:644f9e7278e9 339
fabiombed 4:1d3d071a4c2c 340 ConnectionStatus_t isBTLEConnected;
fabiombed 4:1d3d071a4c2c 341
fabiombed 14:644f9e7278e9 342 bool isEnabledDifferenceNotify;
fabiombed 5:76fb6b783487 343 bool isEnabledPositionNotify;
fabiombed 5:76fb6b783487 344 bool isEnabledSunpanelNotify;
fabiombed 4:1d3d071a4c2c 345
fabiombed 4:1d3d071a4c2c 346 };