SunTracker_BLE
Dependencies: BLE_API X_NUCLEO_6180XA1 X_NUCLEO_IDB0XA1 X_NUCLEO_IHM01A1 X_NUCLEO_IKS01A1 mbed
Fork of SunTracker_BLE by
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.
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 structureis 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 efficiencywith 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
- Nucleo-F401RE platform using a STM32F401RET6 microcontroller.
- X-NUCLEO-IHM01A1 - Stepper motor driver board based on the EasySPIN L6474.
- X-NUCLEO-6180XA1 - 3-in-1 proximity and ambient light sensor board based on ST FlightSense technology.
- VL6180X-SATEL - Satellite boards compatible with X-NUCLEO-6180XA1 board.
- X-NUCLEO-IKS01A1 - Motion MEMS and environmental sensor board.
- X-NUCLEO-IDB04A1 or X-NUCLEO-IDB05A1 - Bluetooth Low Energy Bluetooth low energy evaluation board.
- 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
- Nucleo-F401RE platform using a STM32F401RET6 microcontroller.
- X-NUCLEO-IKS01A1 - Motion MEMS and environmental sensor board.
- X-NUCLEO-IDB04A1 or X-NUCLEO-IDB05A1- Bluetooth Low Energy Bluetooth low energy evaluation board.
MECHANICAL STRUCTURE
Find here the STL files to print with a 3D printer.
FLAT CABLE ASSEMBLY
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
CustomSensorsService.h@14:644f9e7278e9, 2016-03-16 (annotated)
- 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?
User | Revision | Line number | New 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>© 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 | }; |