ST / Mbed 2 deprecated 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 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

Files at this revision

API Documentation at this revision

Revision 12:1e6a1d3a66b5, committed 2016-03-11

Comitter:
fabiombed
Date:
Fri Mar 11 09:48:15 2016 +0000
Parent:
11:b5e23d64d366
Child:
13:7880b45ceeac
Commit message:
Fixed NC used as InterruptIn

Changed in this revision

CustomControlService_copy.h Show annotated file Show diff for this revision Revisions of this file
CustomSensorsService_copy.h Show annotated file Show diff for this revision Revisions of this file
X_NUCLEO_6180XA1.lib Show annotated file Show diff for this revision Revisions of this file
X_NUCLEO_IHM01A1.lib Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file
main_copy.cpp.h Show annotated file Show diff for this revision Revisions of this file
mbed.bld Show annotated file Show diff for this revision Revisions of this file 
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/CustomControlService_copy.h	Fri Mar 11 09:48:15 2016 +0000
@@ -0,0 +1,129 @@
+/******************************************************************************
+  * @file    CustomControlService.h
+  * @author  Fabio Brembilla
+  * @version V1.0.0
+  * @date    January, 2016
+  * @brief   SunTracker Custom Service for BlueTooth (IDB0XA1 expansion board)
+  *****************************************************************************
+  * @attention
+  *
+  * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
+  *
+  * Redistribution and use in source and binary forms, with or without modification,
+  * are permitted provided that the following conditions are met:
+  *   1. Redistributions of source code must retain the above copyright notice,
+  *      this list of conditions and the following disclaimer.
+  *   2. Redistributions in binary form must reproduce the above copyright notice,
+  *      this list of conditions and the following disclaimer in the documentation
+  *      and/or other materials provided with the distribution.
+  *   3. Neither the name of STMicroelectronics nor the names of its contributors
+  *      may be used to endorse or promote products derived from this software
+  *      without specific prior written permission.
+  *
+  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+  *
+  ******************************************************************************
+*/
+
+#ifndef __CUSTOM_BLE_CONTROL_SERVICE_H__
+#define __CUSTOM_BLE_CONTROL_SERVICE_H__
+#include "BLE.h"
+#include "UUID.h"
+                              
+#define STORE_BE_32(buf, val)    ( ((buf)[3] =  (uint8_t) (val)     ) , \
+                                   ((buf)[2] =  (uint8_t) (val>>8)  ) , \
+                                   ((buf)[1] =  (uint8_t) (val>>16) ) , \
+                                   ((buf)[0] =  (uint8_t) (val>>24) ) )                         
+                            
+#define SIZEOF_CONTROL_DATA_LEN  2+4+1+1
+
+/* BLE Services: Primary + 1 Secondary (Char Desk) */
+const LongUUIDBytes_t CONTROL_SERVICE_UUID_128 = {0x00,0x00,0x00,0x00,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A}; //Primary
+const LongUUIDBytes_t USER_BUTTON_CHAR_UUID    = {0x00,0x00,0x00,0x01,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A}; //User Button Control
+
+/* Custom Control Service */
+class CustomControlService  {
+public:
+    CustomControlService(BLE &_ble) :
+        ble(_ble),
+                userbuttonCharacteristic(USER_BUTTON_CHAR_UUID, controlData, SIZEOF_CONTROL_DATA_LEN, SIZEOF_CONTROL_DATA_LEN,
+                                         GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)
+        {  
+        static bool serviceAdded = false; // To be sure to define just one time
+        if (serviceAdded) {
+            return;
+        }
+
+        GattCharacteristic *charTable[] = {&userbuttonCharacteristic};
+
+        GattService   controlService(CONTROL_SERVICE_UUID_128, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));              
+                
+        ble.gattServer().addService(controlService);                              
+                
+        isEnabledControlNotify = false;
+        memset (controlData, 0, SIZEOF_CONTROL_DATA_LEN); 
+        serviceAdded = true;
+    }
+
+// Tests Method
+
+    void enNotify (Gap::Handle_t handle) {
+            if (isContHandle(handle)) { 
+                PRINTF("enNotify! %d\n\r", handle); isEnabledControlNotify = true; return; }    
+    }
+    
+    void disNotify (Gap::Handle_t handle) {
+            if (isContHandle(handle)) { 
+                            isEnabledControlNotify = false; return; }    
+    }   
+    
+    bool isContHandle (Gap::Handle_t handle) {
+            if (handle == userbuttonCharacteristic.getValueAttribute().getHandle()) return true;
+            return false;
+    }
+    
+    void updateConnectionStatus(ConnectionStatus_t status) {            
+            isEnabledControlNotify = false;
+            memset (controlData, 0, SIZEOF_CONTROL_DATA_LEN);             
+    }      
+
+/*
+  
+    uint32_t sendcontrolState(uint32_t Feature, uint8_t Command, uint8_t val, uint16_t TimeStamp) {      
+            STORE_LE_16(controlData ,TimeStamp); 
+            STORE_BE_32(controlData+2,Feature);          
+            controlData[6] = Command;
+            controlData[7] = (val==0x01) ? 100: val;                     
+            return ble.gattServer().write(userbuttonCharacteristic.getValueAttribute().getHandle(), controlData, SIZEOF_CONTROL_DATA_LEN, 0);
+    }
+    
+    uint32_t updatecontrolState(uint32_t Feature, uint8_t Command, uint8_t val, uint16_t TimeStamp) {
+            if (ble.getGapState().connected && isEnabledControlNotify ) {  
+            return sendcontrolState(Feature, Command, val, TimeStamp);
+            }
+            return 0;
+    }
+
+*/    
+
+// Variables Initialization
+private:
+        BLE                              &ble;
+        uint8_t                          controlData[SIZEOF_CONTROL_DATA_LEN];                
+        uint8_t                          controlState;
+        GattCharacteristic               userbuttonCharacteristic;  
+        bool                             isEnabledControlNotify;
+
+};
+
+#endif /* #ifndef __CUSTOM_BLE_CONTROL_SERVICE_H__*/
+

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/CustomSensorsService_copy.h	Fri Mar 11 09:48:15 2016 +0000
@@ -0,0 +1,129 @@
+/******************************************************************************
+  * @file    CustomControlService.h
+  * @author  Fabio Brembilla
+  * @version V1.0.0
+  * @date    January, 2016
+  * @brief   SunTracker Custom Service for BlueTooth (IDB0XA1 expansion board)
+  *****************************************************************************
+  * @attention
+  *
+  * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
+  *
+  * Redistribution and use in source and binary forms, with or without modification,
+  * are permitted provided that the following conditions are met:
+  *   1. Redistributions of source code must retain the above copyright notice,
+  *      this list of conditions and the following disclaimer.
+  *   2. Redistributions in binary form must reproduce the above copyright notice,
+  *      this list of conditions and the following disclaimer in the documentation
+  *      and/or other materials provided with the distribution.
+  *   3. Neither the name of STMicroelectronics nor the names of its contributors
+  *      may be used to endorse or promote products derived from this software
+  *      without specific prior written permission.
+  *
+  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+  *
+  ******************************************************************************
+*/
+
+#ifndef __CUSTOM_BLE_CONTROL_SERVICE_H__
+#define __CUSTOM_BLE_CONTROL_SERVICE_H__
+#include "BLE.h"
+#include "UUID.h"
+                              
+#define STORE_BE_32(buf, val)    ( ((buf)[3] =  (uint8_t) (val)     ) , \
+                                   ((buf)[2] =  (uint8_t) (val>>8)  ) , \
+                                   ((buf)[1] =  (uint8_t) (val>>16) ) , \
+                                   ((buf)[0] =  (uint8_t) (val>>24) ) )                         
+                            
+#define SIZEOF_CONTROL_DATA_LEN  2+4+1+1
+
+/* BLE Services: Primary + 1 Secondary (Char Desk) */
+const LongUUIDBytes_t CONTROL_SERVICE_UUID_128 = {0x00,0x00,0x00,0x00,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A}; //Primary
+const LongUUIDBytes_t USER_BUTTON_CHAR_UUID    = {0x00,0x00,0x00,0x01,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A}; //User Button Control
+
+/* Custom Control Service */
+class CustomControlService  {
+public:
+    CustomControlService(BLE &_ble) :
+        ble(_ble),
+                userbuttonCharacteristic(USER_BUTTON_CHAR_UUID, controlData, SIZEOF_CONTROL_DATA_LEN, SIZEOF_CONTROL_DATA_LEN,
+                                         GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)
+        {  
+        static bool serviceAdded = false; // To be sure to define just one time
+        if (serviceAdded) {
+            return;
+        }
+
+        GattCharacteristic *charTable[] = {&userbuttonCharacteristic};
+
+        GattService   controlService(CONTROL_SERVICE_UUID_128, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));              
+                
+        ble.gattServer().addService(controlService);                              
+                
+        isEnabledControlNotify = false;
+        memset (controlData, 0, SIZEOF_CONTROL_DATA_LEN); 
+        serviceAdded = true;
+    }
+
+// Tests Method
+
+    void enNotify (Gap::Handle_t handle) {
+            if (isContHandle(handle)) { 
+                PRINTF("enNotify! %d\n\r", handle); isEnabledControlNotify = true; return; }    
+    }
+    
+    void disNotify (Gap::Handle_t handle) {
+            if (isContHandle(handle)) { 
+                            isEnabledControlNotify = false; return; }    
+    }   
+    
+    bool isContHandle (Gap::Handle_t handle) {
+            if (handle == userbuttonCharacteristic.getValueAttribute().getHandle()) return true;
+            return false;
+    }
+    
+    void updateConnectionStatus(ConnectionStatus_t status) {            
+            isEnabledControlNotify = false;
+            memset (controlData, 0, SIZEOF_CONTROL_DATA_LEN);             
+    }      
+
+/*
+  
+    uint32_t sendcontrolState(uint32_t Feature, uint8_t Command, uint8_t val, uint16_t TimeStamp) {      
+            STORE_LE_16(controlData ,TimeStamp); 
+            STORE_BE_32(controlData+2,Feature);          
+            controlData[6] = Command;
+            controlData[7] = (val==0x01) ? 100: val;                     
+            return ble.gattServer().write(userbuttonCharacteristic.getValueAttribute().getHandle(), controlData, SIZEOF_CONTROL_DATA_LEN, 0);
+    }
+    
+    uint32_t updatecontrolState(uint32_t Feature, uint8_t Command, uint8_t val, uint16_t TimeStamp) {
+            if (ble.getGapState().connected && isEnabledControlNotify ) {  
+            return sendcontrolState(Feature, Command, val, TimeStamp);
+            }
+            return 0;
+    }
+
+*/    
+
+// Variables Initialization
+private:
+        BLE                              &ble;
+        uint8_t                          controlData[SIZEOF_CONTROL_DATA_LEN];                
+        uint8_t                          controlState;
+        GattCharacteristic               userbuttonCharacteristic;  
+        bool                             isEnabledControlNotify;
+
+};
+
+#endif /* #ifndef __CUSTOM_BLE_CONTROL_SERVICE_H__*/
+

--- a/X_NUCLEO_6180XA1.lib	Thu Mar 03 16:32:10 2016 +0000
+++ b/X_NUCLEO_6180XA1.lib	Fri Mar 11 09:48:15 2016 +0000
@@ -1,1 +1,1 @@
-http://developer.mbed.org/teams/ST-Expansion-SW-Team/code/X_NUCLEO_6180XA1/#b4d20279e312
+http://developer.mbed.org/teams/ST/code/X_NUCLEO_6180XA1/#692c6223dc24

--- a/X_NUCLEO_IHM01A1.lib	Thu Mar 03 16:32:10 2016 +0000
+++ b/X_NUCLEO_IHM01A1.lib	Fri Mar 11 09:48:15 2016 +0000
@@ -1,1 +1,1 @@
-https://developer.mbed.org/teams/ST-Expansion-SW-Team/code/X_NUCLEO_IHM01A1/#58264db10a17
+http://developer.mbed.org/teams/ST/code/X_NUCLEO_IHM01A1/#58264db10a17

--- a/main.cpp	Thu Mar 03 16:32:10 2016 +0000
+++ b/main.cpp	Fri Mar 11 09:48:15 2016 +0000
@@ -3,8 +3,8 @@
  * @file    main.cpp
  * @author  Fabio Brembilla
  * @version V2.0.0
- * @date    February, 2016
- * @brief   SunTracker + RemoteControl Vertical Application
+ * @date    March, 2016
+ * @brief   SunTracker + BLE (Server) Vertical Application
  *          This application use IHM01A1, 6180XA1, IKS01A1, IDB0XA1 expansion boards
  ******************************************************************************
  * @attention
@@ -236,13 +236,13 @@
 bool Initialization(void)
 {
     
-    dev_i2c.frequency(100000);     // at 200KHz or 400KHz doesn't work
+    dev_i2c.frequency(100000);     // Default 100KHz. At 10KHz, 20KHz, 200KHz and 400KHz doesn't work
     
 //----    
-    
+   
     // Initializing Babybear Component
-    board=X_NUCLEO_6180XA1::Instance(&dev_i2c, PA_4, PA_4, PA_4, PA_4); // Don't use NC because it doesn't set InterruptIn correctly
-
+    board=X_NUCLEO_6180XA1::Instance(&dev_i2c, NC, NC, NC, NC); // OLD: Don't use NC because it doesn't set InterruptIn correctly. Used PA_4
+                                                                // NEW: Now can use NC, problem solved editing x_nucleo_6180xa1.h and vl6180x_class.h
     status=board->InitBoard();
     if(status) VL6180x_ErrLog("Failed to init the board!\n\r");
 

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main_copy.cpp.h	Fri Mar 11 09:48:15 2016 +0000
@@ -0,0 +1,129 @@
+/******************************************************************************
+  * @file    CustomControlService.h
+  * @author  Fabio Brembilla
+  * @version V1.0.0
+  * @date    January, 2016
+  * @brief   SunTracker Custom Service for BlueTooth (IDB0XA1 expansion board)
+  *****************************************************************************
+  * @attention
+  *
+  * <h2><center>&copy; COPYRIGHT(c) 2016 STMicroelectronics</center></h2>
+  *
+  * Redistribution and use in source and binary forms, with or without modification,
+  * are permitted provided that the following conditions are met:
+  *   1. Redistributions of source code must retain the above copyright notice,
+  *      this list of conditions and the following disclaimer.
+  *   2. Redistributions in binary form must reproduce the above copyright notice,
+  *      this list of conditions and the following disclaimer in the documentation
+  *      and/or other materials provided with the distribution.
+  *   3. Neither the name of STMicroelectronics nor the names of its contributors
+  *      may be used to endorse or promote products derived from this software
+  *      without specific prior written permission.
+  *
+  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+  *
+  ******************************************************************************
+*/
+
+#ifndef __CUSTOM_BLE_CONTROL_SERVICE_H__
+#define __CUSTOM_BLE_CONTROL_SERVICE_H__
+#include "BLE.h"
+#include "UUID.h"
+                              
+#define STORE_BE_32(buf, val)    ( ((buf)[3] =  (uint8_t) (val)     ) , \
+                                   ((buf)[2] =  (uint8_t) (val>>8)  ) , \
+                                   ((buf)[1] =  (uint8_t) (val>>16) ) , \
+                                   ((buf)[0] =  (uint8_t) (val>>24) ) )                         
+                            
+#define SIZEOF_CONTROL_DATA_LEN  2+4+1+1
+
+/* BLE Services: Primary + 1 Secondary (Char Desk) */
+const LongUUIDBytes_t CONTROL_SERVICE_UUID_128 = {0x00,0x00,0x00,0x00,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A}; //Primary
+const LongUUIDBytes_t USER_BUTTON_CHAR_UUID    = {0x00,0x00,0x00,0x01,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A,0x0A}; //User Button Control
+
+/* Custom Control Service */
+class CustomControlService  {
+public:
+    CustomControlService(BLE &_ble) :
+        ble(_ble),
+                userbuttonCharacteristic(USER_BUTTON_CHAR_UUID, controlData, SIZEOF_CONTROL_DATA_LEN, SIZEOF_CONTROL_DATA_LEN,
+                                         GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY)
+        {  
+        static bool serviceAdded = false; // To be sure to define just one time
+        if (serviceAdded) {
+            return;
+        }
+
+        GattCharacteristic *charTable[] = {&userbuttonCharacteristic};
+
+        GattService   controlService(CONTROL_SERVICE_UUID_128, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));              
+                
+        ble.gattServer().addService(controlService);                              
+                
+        isEnabledControlNotify = false;
+        memset (controlData, 0, SIZEOF_CONTROL_DATA_LEN); 
+        serviceAdded = true;
+    }
+
+// Tests Method
+
+    void enNotify (Gap::Handle_t handle) {
+            if (isContHandle(handle)) { 
+                PRINTF("enNotify! %d\n\r", handle); isEnabledControlNotify = true; return; }    
+    }
+    
+    void disNotify (Gap::Handle_t handle) {
+            if (isContHandle(handle)) { 
+                            isEnabledControlNotify = false; return; }    
+    }   
+    
+    bool isContHandle (Gap::Handle_t handle) {
+            if (handle == userbuttonCharacteristic.getValueAttribute().getHandle()) return true;
+            return false;
+    }
+    
+    void updateConnectionStatus(ConnectionStatus_t status) {            
+            isEnabledControlNotify = false;
+            memset (controlData, 0, SIZEOF_CONTROL_DATA_LEN);             
+    }      
+
+/*
+  
+    uint32_t sendcontrolState(uint32_t Feature, uint8_t Command, uint8_t val, uint16_t TimeStamp) {      
+            STORE_LE_16(controlData ,TimeStamp); 
+            STORE_BE_32(controlData+2,Feature);          
+            controlData[6] = Command;
+            controlData[7] = (val==0x01) ? 100: val;                     
+            return ble.gattServer().write(userbuttonCharacteristic.getValueAttribute().getHandle(), controlData, SIZEOF_CONTROL_DATA_LEN, 0);
+    }
+    
+    uint32_t updatecontrolState(uint32_t Feature, uint8_t Command, uint8_t val, uint16_t TimeStamp) {
+            if (ble.getGapState().connected && isEnabledControlNotify ) {  
+            return sendcontrolState(Feature, Command, val, TimeStamp);
+            }
+            return 0;
+    }
+
+*/    
+
+// Variables Initialization
+private:
+        BLE                              &ble;
+        uint8_t                          controlData[SIZEOF_CONTROL_DATA_LEN];                
+        uint8_t                          controlState;
+        GattCharacteristic               userbuttonCharacteristic;  
+        bool                             isEnabledControlNotify;
+
+};
+
+#endif /* #ifndef __CUSTOM_BLE_CONTROL_SERVICE_H__*/
+

--- a/mbed.bld	Thu Mar 03 16:32:10 2016 +0000
+++ b/mbed.bld	Fri Mar 11 09:48:15 2016 +0000
@@ -1,1 +1,1 @@
-http://mbed.org/users/mbed_official/code/mbed/builds/252557024ec3
\ No newline at end of file
+http://mbed.org/users/mbed_official/code/mbed/builds/87f2f5183dfb
\ No newline at end of file