ST » Code » SunTracker_BLE

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 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.

/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

CustomSensorsService.h@15:019b8d60c89d, 2016-03-21 (annotated)

Committer:: fabiombed
Date:: Mon Mar 21 10:18:41 2016 +0000
Revision:: 15:019b8d60c89d
Parent:: 14:644f9e7278e9
Child:: 17:582eba752042

Update SERVER

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	15:019b8d60c89d	50	#define DIFFERENCE_DATA_LEN 2
fabiombed	15:019b8d60c89d	51	#define POSITION_DATA_LEN 2
fabiombed	15:019b8d60c89d	52	#define SUNPANEL_DATA_LEN 2
fabiombed	15:019b8d60c89d	53	// 1 byte 0xFF 8 bit int8
fabiombed	15:019b8d60c89d	54	// 2 byte 0xFFFF 16 bit int16
fabiombed	4:1d3d071a4c2c	55
fabiombed	4:1d3d071a4c2c	56	/* Custom Sensors Service */
fabiombed	4:1d3d071a4c2c	57	class CustomSensorService {
fabiombed	4:1d3d071a4c2c	58	public:
fabiombed	4:1d3d071a4c2c	59	CustomSensorService(BLEDevice &_ble) :
fabiombed	4:1d3d071a4c2c	60	ble(_ble),
fabiombed	14:644f9e7278e9	61	differenceCharacteristic(SENS_DIFFERENCE_CHAR_UUID_128, envDifference, DIFFERENCE_DATA_LEN, DIFFERENCE_DATA_LEN,
fabiombed	14:644f9e7278e9	62	GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ \| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE \| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY),
fabiombed	5:76fb6b783487	63	positionCharacteristic(SENS_POSITION_CHAR_UUID_128, envPosition, POSITION_DATA_LEN, POSITION_DATA_LEN,
fabiombed	5:76fb6b783487	64	GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ \| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE \| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY),
fabiombed	5:76fb6b783487	65	sunpanelCharacteristic(SENS_SUNPANEL_CHAR_UUID_128, envSunpanel, SUNPANEL_DATA_LEN, SUNPANEL_DATA_LEN,
fabiombed	7:54984d031243	66	GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ \| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)
fabiombed	5:76fb6b783487	67	{
fabiombed	5:76fb6b783487	68	static bool serviceAdded = false; // To be sure to define just one time
fabiombed	4:1d3d071a4c2c	69	if (serviceAdded) {
fabiombed	4:1d3d071a4c2c	70	return;
fabiombed	4:1d3d071a4c2c	71	}
fabiombed	4:1d3d071a4c2c	72
fabiombed	14:644f9e7278e9	73	GattCharacteristic *charTable[] = {&differenceCharacteristic, &positionCharacteristic, &sunpanelCharacteristic};
fabiombed	14:644f9e7278e9	74	GattService envService(SENS_SERVICE_UUID_128, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
fabiombed	4:1d3d071a4c2c	75	ble.gattServer().addService(envService);
fabiombed	4:1d3d071a4c2c	76
fabiombed	14:644f9e7278e9	77	isEnabledDifferenceNotify = false;
fabiombed	5:76fb6b783487	78	isEnabledPositionNotify = false;
fabiombed	5:76fb6b783487	79	isEnabledSunpanelNotify = false;
fabiombed	14:644f9e7278e9	80	memset (envDifference, 0, DIFFERENCE_DATA_LEN);
fabiombed	14:644f9e7278e9	81	memset (envPosition, 0, POSITION_DATA_LEN);
fabiombed	14:644f9e7278e9	82	memset (envSunpanel, 0, SUNPANEL_DATA_LEN);
fabiombed	4:1d3d071a4c2c	83	isBTLEConnected = DISCONNECTED;
fabiombed	4:1d3d071a4c2c	84	serviceAdded = true;
fabiombed	4:1d3d071a4c2c	85	}
fabiombed	4:1d3d071a4c2c	86
fabiombed	5:76fb6b783487	87	// Tests Method
fabiombed	7:54984d031243	88
fabiombed	15:019b8d60c89d	89	void sendEnvDifference (uint16_t Dif) {
fabiombed	15:019b8d60c89d	90	STORE_LE_16(envDifference,Dif);
fabiombed	14:644f9e7278e9	91	PRINTF("sendEnvDifference handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed	14:644f9e7278e9	92	memcpy (pastenvDifference, envDifference, DIFFERENCE_DATA_LEN);
fabiombed	14:644f9e7278e9	93	ble.gattServer().write(differenceCharacteristic.getValueAttribute().getHandle(), envDifference, DIFFERENCE_DATA_LEN, 0);
fabiombed	14:644f9e7278e9	94	printf(" (Update)");
fabiombed	14:644f9e7278e9	95	}
fabiombed	14:644f9e7278e9	96
fabiombed	15:019b8d60c89d	97	void updateEnvDifference (uint16_t Temp) {
fabiombed	15:019b8d60c89d	98	if (ble.getGapState().connected && isEnabledDifferenceNotify ) {
fabiombed	15:019b8d60c89d	99	if (memcmp (&pastenvDifference[0], &Temp, DIFFERENCE_DATA_LEN) != 0) {
fabiombed	15:019b8d60c89d	100	sendEnvDifference (Temp);
fabiombed	15:019b8d60c89d	101	}
fabiombed	14:644f9e7278e9	102	}
fabiombed	14:644f9e7278e9	103	}
fabiombed	14:644f9e7278e9	104
fabiombed	15:019b8d60c89d	105	void sendEnvPosition (uint16_t Pos) {
fabiombed	15:019b8d60c89d	106	STORE_LE_16(envPosition,Pos);
fabiombed	14:644f9e7278e9	107	PRINTF("sendEnvPosition handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed	14:644f9e7278e9	108	memcpy (pastenvPosition, envPosition, POSITION_DATA_LEN);
fabiombed	14:644f9e7278e9	109	ble.gattServer().write(positionCharacteristic.getValueAttribute().getHandle(), envPosition, POSITION_DATA_LEN, 0);
fabiombed	14:644f9e7278e9	110	printf(" (Update)");
fabiombed	14:644f9e7278e9	111	}
fabiombed	14:644f9e7278e9	112
fabiombed	15:019b8d60c89d	113	void updateEnvPosition (uint16_t Temp) {
fabiombed	15:019b8d60c89d	114	if (ble.getGapState().connected && isEnabledPositionNotify ) {
fabiombed	15:019b8d60c89d	115	if (memcmp (&pastenvPosition[0], &Temp, POSITION_DATA_LEN) != 0) {
fabiombed	15:019b8d60c89d	116	sendEnvPosition (Temp);
fabiombed	15:019b8d60c89d	117	}
fabiombed	14:644f9e7278e9	118	}
fabiombed	14:644f9e7278e9	119	}
fabiombed	14:644f9e7278e9	120
fabiombed	15:019b8d60c89d	121	void sendEnvSunpanel (uint16_t Sun) {
fabiombed	15:019b8d60c89d	122	STORE_LE_16(envSunpanel,Sun);
fabiombed	14:644f9e7278e9	123	PRINTF("sendEnvSunpanel handle: %d\n\r", sunpanelCharacteristic.getValueAttribute().getHandle());
fabiombed	14:644f9e7278e9	124	memcpy (pastenvSunpanel, envSunpanel, SUNPANEL_DATA_LEN);
fabiombed	14:644f9e7278e9	125	ble.gattServer().write(sunpanelCharacteristic.getValueAttribute().getHandle(), envSunpanel, SUNPANEL_DATA_LEN, 0);
fabiombed	14:644f9e7278e9	126	printf(" (Update)");
fabiombed	14:644f9e7278e9	127	}
fabiombed	14:644f9e7278e9	128
fabiombed	15:019b8d60c89d	129	void updateEnvSunpanel (uint16_t Temp) {
fabiombed	15:019b8d60c89d	130	if (ble.getGapState().connected && isEnabledSunpanelNotify ) {
fabiombed	15:019b8d60c89d	131	if (memcmp (&pastenvSunpanel[0], &Temp, SUNPANEL_DATA_LEN) != 0) {
fabiombed	15:019b8d60c89d	132	sendEnvSunpanel (Temp);
fabiombed	15:019b8d60c89d	133	}
fabiombed	14:644f9e7278e9	134	}
fabiombed	14:644f9e7278e9	135	}
fabiombed	14:644f9e7278e9	136
fabiombed	14:644f9e7278e9	137	/* with TimeStamp
fabiombed	14:644f9e7278e9	138
fabiombed	14:644f9e7278e9	139	void sendEnvDifference (int16_t Dif, uint16_t TimeStamp) {
fabiombed	14:644f9e7278e9	140	STORE_LE_16(envDifference,TimeStamp);
fabiombed	14:644f9e7278e9	141	STORE_LE_16(envDifference+2,Dif);
fabiombed	14:644f9e7278e9	142	PRINTF("sendEnvDifference!! handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed	14:644f9e7278e9	143	memcpy (pastenvDifference, envDifference, DIFFERENCE_DATA_LEN);
fabiombed	14:644f9e7278e9	144	ble.gattServer().write(differenceCharacteristic.getValueAttribute().getHandle(), envDifference, DIFFERENCE_DATA_LEN, 0);
fabiombed	14:644f9e7278e9	145	}
fabiombed	14:644f9e7278e9	146
fabiombed	14:644f9e7278e9	147	void updateEnvDifference (int16_t Temp, uint16_t TimeStamp) {
fabiombed	14:644f9e7278e9	148	if (memcmp (&pastenvDifference[2], &Temp, 2) != 0) {
fabiombed	14:644f9e7278e9	149	sendEnvDifference (Temp, TimeStamp);
fabiombed	14:644f9e7278e9	150	}
fabiombed	14:644f9e7278e9	151	}
fabiombed	14:644f9e7278e9	152
fabiombed	7:54984d031243	153	void sendEnvPosition (int16_t Pos, uint16_t TimeStamp) {
fabiombed	7:54984d031243	154	STORE_LE_16(envPosition,TimeStamp);
fabiombed	7:54984d031243	155	STORE_LE_16(envPosition+2,Pos);
fabiombed	14:644f9e7278e9	156	PRINTF("sendEnvPosition!! handle: %d\n\r", positionCharacteristic.getValueAttribute().getHandle());
fabiombed	7:54984d031243	157	memcpy (pastenvPosition, envPosition, POSITION_DATA_LEN);
fabiombed	7:54984d031243	158	ble.gattServer().write(positionCharacteristic.getValueAttribute().getHandle(), envPosition, POSITION_DATA_LEN, 0);
fabiombed	7:54984d031243	159	}
fabiombed	7:54984d031243	160
fabiombed	14:644f9e7278e9	161	void updateEnvPosition (int16_t Temp, uint16_t TimeStamp) {
fabiombed	14:644f9e7278e9	162	if (memcmp (&pastenvPosition[2], &Temp, 2) != 0) {
fabiombed	14:644f9e7278e9	163	sendEnvPosition (Temp, TimeStamp);
fabiombed	14:644f9e7278e9	164	}
fabiombed	14:644f9e7278e9	165	}
fabiombed	14:644f9e7278e9	166
fabiombed	14:644f9e7278e9	167	void sendEnvSunpanel (int16_t Sun, uint16_t TimeStamp) {
fabiombed	14:644f9e7278e9	168	STORE_LE_16(envSunpanel,TimeStamp);
fabiombed	14:644f9e7278e9	169	STORE_LE_16(envSunpanel+2,Sun);
fabiombed	14:644f9e7278e9	170	PRINTF("sendEnvSunpanel!! handle: %d\n\r", sunpanelCharacteristic.getValueAttribute().getHandle());
fabiombed	14:644f9e7278e9	171	memcpy (pastenvSunpanel, envSunpanel, SUNPANEL_DATA_LEN);
fabiombed	14:644f9e7278e9	172	ble.gattServer().write(sunpanelCharacteristic.getValueAttribute().getHandle(), envSunpanel, SUNPANEL_DATA_LEN, 0);
fabiombed	14:644f9e7278e9	173	}
fabiombed	14:644f9e7278e9	174
fabiombed	14:644f9e7278e9	175	void updateEnvSunpanel (int16_t Temp, uint16_t TimeStamp) {
fabiombed	14:644f9e7278e9	176	if (memcmp (&pastenvSunpanel[2], &Temp, 2) != 0) {
fabiombed	14:644f9e7278e9	177	sendEnvSunpanel (Temp, TimeStamp);
fabiombed	14:644f9e7278e9	178	}
fabiombed	14:644f9e7278e9	179	}
fabiombed	14:644f9e7278e9	180
fabiombed	14:644f9e7278e9	181	*/
fabiombed	14:644f9e7278e9	182
fabiombed	5:76fb6b783487	183	/*
fabiombed	5:76fb6b783487	184
fabiombed	4:1d3d071a4c2c	185	void sendEnvTemperature (int16_t Temp, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	186	STORE_LE_16(envTemperature,TimeStamp);
fabiombed	4:1d3d071a4c2c	187	STORE_LE_16(envTemperature+2,Temp);
fabiombed	4:1d3d071a4c2c	188	PRINTF("sendEnvTemperature!! handle: %d\n\r", envTemperatureCharacteristic.getValueAttribute().getHandle());
fabiombed	4:1d3d071a4c2c	189	memcpy (pastenvTemperature, envTemperature, TEMP_DATA_LEN);
fabiombed	4:1d3d071a4c2c	190	ble.gattServer().write(envTemperatureCharacteristic.getValueAttribute().getHandle(), envTemperature, TEMP_DATA_LEN, 0);
fabiombed	4:1d3d071a4c2c	191	}
fabiombed	4:1d3d071a4c2c	192
fabiombed	4:1d3d071a4c2c	193	void updateEnvTemperature (int16_t Temp, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	194	if (memcmp (&pastenvTemperature[2], &Temp, 2) != 0) {
fabiombed	4:1d3d071a4c2c	195	sendEnvTemperature (Temp, TimeStamp);
fabiombed	4:1d3d071a4c2c	196	}
fabiombed	4:1d3d071a4c2c	197	}
fabiombed	4:1d3d071a4c2c	198
fabiombed	4:1d3d071a4c2c	199	void sendEnvHumidity(uint16_t Hum, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	200	STORE_LE_16(envHumidity,TimeStamp);
fabiombed	4:1d3d071a4c2c	201	STORE_LE_16(envHumidity+2,Hum);
fabiombed	4:1d3d071a4c2c	202	memcpy (pastenvHumidity, envHumidity, HUM_DATA_LEN);
fabiombed	4:1d3d071a4c2c	203	ble.gattServer().write(envHumidityCharacteristic.getValueAttribute().getHandle(), envHumidity, HUM_DATA_LEN, 0);
fabiombed	4:1d3d071a4c2c	204
fabiombed	4:1d3d071a4c2c	205	}
fabiombed	4:1d3d071a4c2c	206
fabiombed	4:1d3d071a4c2c	207	void updateEnvHumidity(uint16_t Hum, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	208	if (memcmp (&pastenvHumidity[2], &Hum, 2) != 0) {
fabiombed	4:1d3d071a4c2c	209	sendEnvHumidity(Hum, TimeStamp);
fabiombed	4:1d3d071a4c2c	210	}
fabiombed	4:1d3d071a4c2c	211	}
fabiombed	4:1d3d071a4c2c	212
fabiombed	4:1d3d071a4c2c	213	void sendEnvPressure(uint32_t Press, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	214	STORE_LE_16(envPressure,TimeStamp);
fabiombed	4:1d3d071a4c2c	215	STORE_LE_32(envPressure+2,Press);
fabiombed	4:1d3d071a4c2c	216	memcpy (pastenvPressure, envPressure, PRES_DATA_LEN);
fabiombed	4:1d3d071a4c2c	217	ble.gattServer().write(envPressureCharacteristic.getValueAttribute().getHandle(), envPressure, PRES_DATA_LEN, 0);
fabiombed	4:1d3d071a4c2c	218	}
fabiombed	4:1d3d071a4c2c	219
fabiombed	4:1d3d071a4c2c	220	void updateEnvPressure(uint32_t Press, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	221	if (memcmp (&pastenvPressure[2], &Press, 2) != 0) {
fabiombed	4:1d3d071a4c2c	222	sendEnvPressure(Press, TimeStamp);
fabiombed	4:1d3d071a4c2c	223	}
fabiombed	4:1d3d071a4c2c	224	}
fabiombed	4:1d3d071a4c2c	225
fabiombed	4:1d3d071a4c2c	226	void sendEnvMagnetometer(AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed	4:1d3d071a4c2c	227	STORE_LE_16(envMagn,TimeStamp);
fabiombed	4:1d3d071a4c2c	228	STORE_LE_16(envMagn+2,(Magn->AXIS_X - magOffset.magOffX));
fabiombed	4:1d3d071a4c2c	229	STORE_LE_16(envMagn+4,(Magn->AXIS_Y - magOffset.magOffY));
fabiombed	4:1d3d071a4c2c	230	STORE_LE_16(envMagn+6,(Magn->AXIS_Z - magOffset.magOffZ));
fabiombed	4:1d3d071a4c2c	231	ble.gattServer().write(envMagnetometerCharacteristic.getValueAttribute().getHandle(), envMagn, MAG_DATA_LEN, 0);
fabiombed	4:1d3d071a4c2c	232	}
fabiombed	4:1d3d071a4c2c	233
fabiombed	4:1d3d071a4c2c	234	void updateEnvMagnetometer(AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed	4:1d3d071a4c2c	235	if (isMagNotificationEn()) sendEnvMagnetometer(Magn, TimeStamp, magOffset);
fabiombed	4:1d3d071a4c2c	236	}
fabiombed	4:1d3d071a4c2c	237
fabiombed	4:1d3d071a4c2c	238	void sendEnvAccelerometer (AxesRaw_TypeDef *Acc, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	239	STORE_LE_16(envAcce,TimeStamp);
fabiombed	4:1d3d071a4c2c	240	STORE_LE_16(envAcce+2,Acc->AXIS_X);
fabiombed	4:1d3d071a4c2c	241	STORE_LE_16(envAcce+4,Acc->AXIS_Y);
fabiombed	4:1d3d071a4c2c	242	STORE_LE_16(envAcce+6,Acc->AXIS_Z);
fabiombed	4:1d3d071a4c2c	243	ble.gattServer().write(envAccelerometerCharacteristic.getValueAttribute().getHandle(), envAcce, ACC_DATA_LEN, 0);
fabiombed	4:1d3d071a4c2c	244	}
fabiombed	4:1d3d071a4c2c	245
fabiombed	4:1d3d071a4c2c	246	void updateEnvAccelerometer (AxesRaw_TypeDef *Acc, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	247	if (isAccNotificationEn()) sendEnvAccelerometer (Acc, TimeStamp);
fabiombed	4:1d3d071a4c2c	248	}
fabiombed	4:1d3d071a4c2c	249
fabiombed	4:1d3d071a4c2c	250	void sendEnvGyroscope (AxesRaw_TypeDef *Gyro, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	251	STORE_LE_16(envGyro,TimeStamp);
fabiombed	4:1d3d071a4c2c	252	STORE_LE_16(envGyro+2,Gyro->AXIS_X);
fabiombed	4:1d3d071a4c2c	253	STORE_LE_16(envGyro+4,Gyro->AXIS_Y);
fabiombed	4:1d3d071a4c2c	254	STORE_LE_16(envGyro+6,Gyro->AXIS_Z);
fabiombed	4:1d3d071a4c2c	255	ble.gattServer().write(envGyroCharacteristic.getValueAttribute().getHandle(), envGyro, GYRO_DATA_LEN, 0);
fabiombed	4:1d3d071a4c2c	256	}
fabiombed	4:1d3d071a4c2c	257
fabiombed	4:1d3d071a4c2c	258	void updateEnvGyroscope (AxesRaw_TypeDef *Gyro, uint16_t TimeStamp) {
fabiombed	4:1d3d071a4c2c	259	if (isGyroNotificationEn()) sendEnvGyroscope (Gyro, TimeStamp);
fabiombed	4:1d3d071a4c2c	260	}
fabiombed	4:1d3d071a4c2c	261
fabiombed	4:1d3d071a4c2c	262	void sendEnvAccGyroMag (AxesRaw_TypeDef Acc, AxesRaw_TypeDef Gyro, AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed	4:1d3d071a4c2c	263	STORE_LE_16(envAccGyroMag,TimeStamp);
fabiombed	4:1d3d071a4c2c	264	STORE_LE_16(envAccGyroMag+2,Acc->AXIS_X);
fabiombed	4:1d3d071a4c2c	265	STORE_LE_16(envAccGyroMag+4,Acc->AXIS_Y);
fabiombed	4:1d3d071a4c2c	266	STORE_LE_16(envAccGyroMag+6,Acc->AXIS_Z);
fabiombed	4:1d3d071a4c2c	267
fabiombed	4:1d3d071a4c2c	268	STORE_LE_16(envAccGyroMag+8,Gyro->AXIS_X);
fabiombed	4:1d3d071a4c2c	269	STORE_LE_16(envAccGyroMag+10,Gyro->AXIS_Y);
fabiombed	4:1d3d071a4c2c	270	STORE_LE_16(envAccGyroMag+12,Gyro->AXIS_Z);
fabiombed	4:1d3d071a4c2c	271
fabiombed	4:1d3d071a4c2c	272	STORE_LE_16(envAccGyroMag+14,(Magn->AXIS_X - magOffset.magOffX));
fabiombed	4:1d3d071a4c2c	273	STORE_LE_16(envAccGyroMag+16,(Magn->AXIS_Y - magOffset.magOffY));
fabiombed	4:1d3d071a4c2c	274	STORE_LE_16(envAccGyroMag+18,(Magn->AXIS_Z - magOffset.magOffZ));
fabiombed	4:1d3d071a4c2c	275	ble.gattServer().write(envAccGyroMagCharacteristic.getValueAttribute().getHandle(), envAccGyroMag, ACCGYROMAG_DATA_LEN, 0);
fabiombed	4:1d3d071a4c2c	276	}
fabiombed	4:1d3d071a4c2c	277
fabiombed	4:1d3d071a4c2c	278	void updateEnvAccGyroMag (AxesRaw_TypeDef Acc, AxesRaw_TypeDef Gyro, AxesRaw_TypeDef *Magn, uint16_t TimeStamp, osxMFX_calibFactor magOffset) {
fabiombed	4:1d3d071a4c2c	279	if (isAccGyroMagNotificationEn())sendEnvAccGyroMag (Acc, Gyro, Magn, TimeStamp, magOffset);
fabiombed	5:76fb6b783487	280	}
fabiombed	5:76fb6b783487	281
fabiombed	5:76fb6b783487	282	*/
fabiombed	8:144855fe02bd	283
fabiombed	4:1d3d071a4c2c	284	void enNotify (Gap::Handle_t handle) {
fabiombed	15:019b8d60c89d	285	printf("\n\r\n\renNotify (handle %d)", handle);
fabiombed	14:644f9e7278e9	286	if (isDifferenceHandle(handle)) { isEnabledDifferenceNotify = true; memset(envDifference,0,DIFFERENCE_DATA_LEN); return; }
fabiombed	5:76fb6b783487	287	if (isPositionHandle(handle)) { isEnabledPositionNotify = true; memset(envPosition,0,POSITION_DATA_LEN); return; }
fabiombed	5:76fb6b783487	288	if (isSunpanelHandle(handle)) { isEnabledSunpanelNotify = true; memset(envSunpanel,0,SUNPANEL_DATA_LEN); return; }
fabiombed	4:1d3d071a4c2c	289	}
fabiombed	4:1d3d071a4c2c	290
fabiombed	4:1d3d071a4c2c	291	void disNotify (Gap::Handle_t handle) {
fabiombed	15:019b8d60c89d	292	printf("\n\r\n\rdisNotify (handle %d)", handle);
fabiombed	14:644f9e7278e9	293	if (isDifferenceHandle(handle)) { isEnabledDifferenceNotify = false; memset(envDifference,0,DIFFERENCE_DATA_LEN); return; }
fabiombed	5:76fb6b783487	294	if (isPositionHandle(handle)) { isEnabledPositionNotify = false; memset(envPosition,0,POSITION_DATA_LEN); return; }
fabiombed	5:76fb6b783487	295	if (isSunpanelHandle(handle)) { isEnabledSunpanelNotify = false; memset(envSunpanel,0,SUNPANEL_DATA_LEN); return; }
fabiombed	4:1d3d071a4c2c	296	}
fabiombed	4:1d3d071a4c2c	297
fabiombed	14:644f9e7278e9	298	bool isDifferenceNotificationEn (void) {
fabiombed	14:644f9e7278e9	299	return isEnabledDifferenceNotify;
fabiombed	14:644f9e7278e9	300	}
fabiombed	14:644f9e7278e9	301
fabiombed	5:76fb6b783487	302	bool isPositionNotificationEn (void) {
fabiombed	5:76fb6b783487	303	return isEnabledPositionNotify;
fabiombed	4:1d3d071a4c2c	304	}
fabiombed	4:1d3d071a4c2c	305
fabiombed	5:76fb6b783487	306	bool isSunpanelNotificationEn (void) {
fabiombed	5:76fb6b783487	307	return isEnabledSunpanelNotify;
fabiombed	5:76fb6b783487	308	}
fabiombed	5:76fb6b783487	309
fabiombed	14:644f9e7278e9	310	bool isDifferenceHandle (Gap::Handle_t handle) {
fabiombed	14:644f9e7278e9	311	if (handle == differenceCharacteristic.getValueAttribute().getHandle()) return true;
fabiombed	14:644f9e7278e9	312	return false;
fabiombed	14:644f9e7278e9	313	}
fabiombed	14:644f9e7278e9	314
fabiombed	5:76fb6b783487	315	bool isPositionHandle (Gap::Handle_t handle) {
fabiombed	5:76fb6b783487	316	if (handle == positionCharacteristic.getValueAttribute().getHandle()) return true;
fabiombed	4:1d3d071a4c2c	317	return false;
fabiombed	4:1d3d071a4c2c	318	}
fabiombed	4:1d3d071a4c2c	319
fabiombed	5:76fb6b783487	320	bool isSunpanelHandle (Gap::Handle_t handle) {
fabiombed	5:76fb6b783487	321	if (handle == sunpanelCharacteristic.getValueAttribute().getHandle()) return true;
fabiombed	4:1d3d071a4c2c	322	return false;
fabiombed	4:1d3d071a4c2c	323	}
fabiombed	4:1d3d071a4c2c	324
fabiombed	4:1d3d071a4c2c	325	void updateConnectionStatus(ConnectionStatus_t status) {
fabiombed	14:644f9e7278e9	326	isEnabledDifferenceNotify = false;
fabiombed	5:76fb6b783487	327	isEnabledPositionNotify = false;
fabiombed	5:76fb6b783487	328	isEnabledSunpanelNotify = false;
fabiombed	14:644f9e7278e9	329	memset (envDifference, 0, DIFFERENCE_DATA_LEN);
fabiombed	5:76fb6b783487	330	memset (envPosition, 0, POSITION_DATA_LEN);
fabiombed	5:76fb6b783487	331	memset (envSunpanel, 0, SUNPANEL_DATA_LEN);
fabiombed	4:1d3d071a4c2c	332	isBTLEConnected = status;
fabiombed	4:1d3d071a4c2c	333	}
fabiombed	4:1d3d071a4c2c	334
fabiombed	5:76fb6b783487	335	// Variables Initialization
fabiombed	4:1d3d071a4c2c	336	private:
fabiombed	4:1d3d071a4c2c	337
fabiombed	4:1d3d071a4c2c	338	BLEDevice &ble;
fabiombed	14:644f9e7278e9	339	uint8_t envDifference [DIFFERENCE_DATA_LEN];
fabiombed	5:76fb6b783487	340	uint8_t envPosition [POSITION_DATA_LEN];
fabiombed	5:76fb6b783487	341	uint8_t envSunpanel [SUNPANEL_DATA_LEN];
fabiombed	14:644f9e7278e9	342	uint8_t pastenvDifference [POSITION_DATA_LEN];
fabiombed	7:54984d031243	343	uint8_t pastenvPosition [POSITION_DATA_LEN];
fabiombed	7:54984d031243	344	uint8_t pastenvSunpanel [SUNPANEL_DATA_LEN];
fabiombed	7:54984d031243	345
fabiombed	14:644f9e7278e9	346	GattCharacteristic differenceCharacteristic;
fabiombed	5:76fb6b783487	347	GattCharacteristic positionCharacteristic;
fabiombed	5:76fb6b783487	348	GattCharacteristic sunpanelCharacteristic;
fabiombed	14:644f9e7278e9	349
fabiombed	4:1d3d071a4c2c	350	ConnectionStatus_t isBTLEConnected;
fabiombed	4:1d3d071a4c2c	351
fabiombed	14:644f9e7278e9	352	bool isEnabledDifferenceNotify;
fabiombed	5:76fb6b783487	353	bool isEnabledPositionNotify;
fabiombed	5:76fb6b783487	354	bool isEnabledSunpanelNotify;
fabiombed	4:1d3d071a4c2c	355
fabiombed	4:1d3d071a4c2c	356	};

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	16 May 2016
Imports:	42
Forks:	0
Commits:	26
Dependents:	0
Dependencies:	6
Followers:	403

The code in this repository is Apache licensed.