ST
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.
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
- 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
Diff: main.cpp
- Revision:
- 14:644f9e7278e9
- Parent:
- 12:1e6a1d3a66b5
- Child:
- 15:019b8d60c89d
diff -r 7880b45ceeac -r 644f9e7278e9 main.cpp
--- a/main.cpp Fri Mar 11 09:53:49 2016 +0000
+++ b/main.cpp Wed Mar 16 19:17:08 2016 +0000
@@ -36,6 +36,13 @@
******************************************************************************
*/
+/* Define --------------------------------------------------------------------*/
+
+#define FlightSense //6180XA1 Main (remove only for debug)
+#define EasySpin //IHM01A1 Main (remove only for debug)
+#define Sensors //IKS01A1 Option
+#define Ble //IDB0XA1 Option
+
/* Includes ------------------------------------------------------------------*/
// Mbed specific header files
@@ -46,9 +53,17 @@
#include "DevI2C.h"
// Component specific header files
-#include "l6474_class.h"
-#include "x_nucleo_6180xa1.h"
-#include "x_nucleo_iks01a1.h"
+#ifdef FlightSense
+ #include "x_nucleo_6180xa1.h"
+#endif
+
+#ifdef EasySpin
+ #include "l6474_class.h"
+#endif
+
+#ifdef Sensors
+ #include "x_nucleo_iks01a1.h"
+#endif
// C header files
#include <string.h>
@@ -58,8 +73,10 @@
/* BlueTooth -----------------------------------------------------------------*/
+#ifdef Ble
+
#include "debug.h" // Need for PRINTF
-#include "Utils.h" // Need for STORE_LE_16 and _32
+#include "Utils.h" // Need for STORE_LE_16 and STORE_LE_32
const unsigned LENGTH_OF_LONG_UUID = 16;
typedef uint16_t ShortUUIDBytes_t;
@@ -77,7 +94,8 @@
} cns_t;
#define BLE_DEV_NAME "SunTracker"
-#define BLE_DEV_MAC 0xAA,0xBB,0xCC,0xDD,0xEE,0xFF
+#define BLE_DEV_MAC 0xAA,0xBB,0xCC,0xDD,0xEE,0xFF // must be the same of BLE_peer_address_BE into CLIENT
+//#define BLE_DEV_MAC 0xFD,0x66,0x05,0x13,0xBE,0xBA // Default ST
#define BLE_ADVERTISING_INTERVAL 1000
#include "CustomControlService.h"
@@ -87,6 +105,8 @@
static CustomControlService *p_customcontrolservice = NULL;
static CustomSensorService *p_customsensorservice = NULL;
+#endif
+
/* Definitions ---------------------------------------------------------------*/
#define SET_ACC 400 // Set Motor Acceleration
@@ -100,18 +120,20 @@
/* Variables -----------------------------------------------------------------*/
-int16_t dir=0; // Motor Rotation Direction: 0 = Stop, 1 = Anticlockwise, 2 = Clockwise
-int16_t changedir=0; // Change Direction: 0 = No, 1 = Yes
-int16_t arrest=0; // Arrest: 0 = No, 1 = Yes
-int16_t babybear=0; // Difference (in Lux) between Left and Right
-int acc_data[3]; // Difference of Accelerometer
-int16_t diff=0; // Abs of Babybear or Accelerometer difference
-int16_t left=0; // Left Command for Rotate Direction
-int16_t right=0; // Right Command for Rotate Direction
-int16_t start=0; // Waiting User Button Push
-int32_t pos=0; // Motor Position
-char DisplayStr[5]; // Status Display
-int16_t Display=0; // Shown on Display: 0 = Motor Speed, 1 = Solar Panel Value, 2 = Manual Control
+int8_t dir=0; // Motor Rotation Direction: 0 = Stop, 1 = Anticlockwise, 2 = Clockwise
+int8_t changedir=0; // Change Direction: 0 = No, 1 = Yes
+int8_t arrest=0; // Arrest: 0 = No, 1 = Yes
+int32_t babybear=0; // Difference (in Lux) between Left and Right
+int32_t acc_data[3]; // Difference of Accelerometer
+int32_t diff=0; // Babybear or Accelerometer difference [--> Send BLE]
+int32_t diff_abs=0; // Abs of Babybear or Accelerometer difference
+int8_t left=0; // Left Command for Rotate Direction
+int8_t right=0; // Right Command for Rotate Direction
+int8_t start=0; // Waiting User Button Push
+int32_t pos=0; // Motor Position [--> Send BLE]
+int32_t measure=0; // ADC Value from SunPanel [--> Send BLE]
+char DisplayStr[5]; // Status Display
+int8_t Display=0; // Shown on Display: 0 = Motor Speed, 1 = Solar Panel Value, 2 = Manual Control [--> Send BLE]
int16_t status, status_t, status_b, status_l, status_r; // Babybear Status
/* Initializations ------------------------------------------------------------*/
@@ -122,34 +144,50 @@
// Initializing I2C bus
DevI2C dev_i2c(D14, D15);
-// Initializing Motor Component IHM01A1
-static L6474 *motor;
-
-// Initializing Babybear Component 6180XA1
+#ifdef FlightSense
+// Initializing FlightSense Component 6180XA1
static X_NUCLEO_6180XA1 *board;
MeasureData_t data_sensor_top, data_sensor_bottom, data_sensor_left, data_sensor_right;
-
-// Initializing MEMS Component IKS01A1
+#endif
+
+#ifdef EasySpin
+// Initializing EasySpin Component IHM01A1
+static L6474 *motor;
+#endif
+
+#ifdef Sensors
+// Initializing Sensors Component IKS01A1
static X_NUCLEO_IKS01A1 *mems;
MotionSensor *accelerometer;
+#endif
InterruptIn mybutton(USER_BUTTON);
-AnalogIn analog_read(PC_3); // A1 Conflict with BLE SPI_CS del BLE --> Changed in Morpho PC_3
+AnalogIn analog_read(PC_3); // A1 Conflict with BLE SPI_CS --> Changed in Morpho PC_3
/* User_Button_Pressed -------------------------------------------------------*/
-void User_Button_Pressed()
+void User_Button_Pressed(void)
{
if (start>0) { Display++; }
+#ifdef Sensors
if (Display>2) { Display=0; }
+#else
+ if (Display>1) { Display=0; }
+#endif
if (start==0) { start=1; }
-
- printf("PUSH Display %d\r\n", Display+1);
+
+ char State[12]; // Characters into State must be <12 and never =>12 or it crash!!!
+ if (Display==0) strcpy(State,"FlightSense");
+ if (Display==1) strcpy(State,"ADCSunPanel");
+ if (Display==2) strcpy(State,"Sensors");
+ printf("\r\n\r\nPUSH Display: %s", State);
}
+#ifdef Ble
+
/* Bluetooth CallBack ---------------------------------------------------------*/
static void onUpdatesEnabledCallback(GattAttribute::Handle_t handle)
@@ -167,33 +205,44 @@
}
+// This Callback happen when it RECEIVE a WRITE
static void myonDataWriteCallback(const GattWriteCallbackParams *eventDataP)
-{
- printf ("myonDataWriteCallback attr_handle: %x att_data[3]: %x data_length: %d\n\r", eventDataP->handle, eventDataP->data[3], eventDataP->len );
+{
+ //printf ("myonDataWriteCallback attr_handle: %x att_data[3]: %x data_length: %d\n\r", eventDataP->handle, eventDataP->data[3], eventDataP->len );
if (p_customcontrolservice->isContHandle(eventDataP->handle)) // Only if write come from this Service
{
- uint8_t Command = eventDataP->data[3]; // Riceve 8 byte: data[0] + data[1] + data[2] + data[3]
- printf("myonDataWriteCallback (Command %x)\r\n", Command);
+ // Receive 8 byte: data[0] + data[1] + data[2] + data[3]
+ printf("\r\n\r\nmyonDataWriteCallback (data[0] %x)", eventDataP->data[0]);
+ printf("\r\nmyonDataWriteCallback (data[1] %x)", eventDataP->data[1]);
+ printf("\r\nmyonDataWriteCallback (data[2] %x)", eventDataP->data[2]);
+ printf("\r\nmyonDataWriteCallback (data[3] %x)", eventDataP->data[3]);
+ printf("\r\nmyonDataWriteCallback (data %d)", eventDataP->data[0]+eventDataP->data[1]+eventDataP->data[2]+eventDataP->data[3]);
+
+ User_Button_Pressed(); // Change Display Status
}
}
static void onConnectionCallback(const Gap::ConnectionCallbackParams_t * connectionParams)
{
- printf("onConnectionCallback (Line %d)\r\n", __LINE__);
+ printf("\r\n\r\nonConnectionCallback (Line %d)", __LINE__);
}
static void onDisconnectionCallback(const Gap::DisconnectionCallbackParams_t * disConnectionReason)
{
- printf("onDisconnectionCallback (Line %d)\r\n", __LINE__);
+ printf("\r\n\r\nonDisconnectionCallback (Line %d)", __LINE__);
p_BLEdev->gap().startAdvertising();
}
+#endif
+
/* Bluetooth Initialization ---------------------------------------------------*/
bool BLE_Initialization(void)
{
+#ifdef Ble
+
p_BLEdev = new BLE;
if (!p_BLEdev) { printf("\r\nBLE Device creation failed\r\n"); }
const Gap::Address_t BLE_address_BE = {BLE_DEV_MAC};
@@ -213,7 +262,7 @@
//p_BLEdev->gap().onTimeout(onTimeoutCallback);
// BLE Services
- p_customcontrolservice = new CustomControlService(*p_BLEdev);
+ p_customcontrolservice = new CustomControlService(*p_BLEdev);
p_customsensorservice = new CustomSensorService(*p_BLEdev);
// Setup BLE Advertising
@@ -227,6 +276,10 @@
p_BLEdev->gap().setAdvertisingInterval(BLE_ADVERTISING_INTERVAL);
p_BLEdev->gap().startAdvertising();
+ printf("Initialization Ble OK (Line %d)\r\n", __LINE__);
+
+#endif
+
return true;
}
@@ -236,19 +289,21 @@
bool Initialization(void)
{
- dev_i2c.frequency(100000); // Default 100KHz. At 10KHz, 20KHz, 200KHz and 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, 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
+
+#ifdef FlightSense
+
+ // Initializing FlightSense Component
+ board=X_NUCLEO_6180XA1::Instance(&dev_i2c, NC, NC, NC, NC); // NC as Interrupt fixed from FlightSense library 42
+
status=board->InitBoard();
if(status) VL6180x_ErrLog("Failed to init the board!\n\r");
// Put GPIO not used as Interrupt in Hi-Z
status_t=board->sensor_top->SetGPIOxFunctionality(1, GPIOx_SELECT_OFF);
- //status_b=board->sensor_botton->SetGPIOxFunctionality(1, GPIOx_SELECT_OFF); No Present
+ //status_b=board->sensor_botton->SetGPIOxFunctionality(1, GPIOx_SELECT_OFF); Not Present
status_l=board->sensor_left->SetGPIOxFunctionality(1, GPIOx_SELECT_OFF);
status_r=board->sensor_right->SetGPIOxFunctionality(1, GPIOx_SELECT_OFF);
@@ -258,19 +313,15 @@
status_l=board->sensor_left->StartMeasurement(als_continuous_polling, NULL, NULL, NULL);
status_r=board->sensor_right->StartMeasurement(als_continuous_polling, NULL, NULL, NULL);
- printf("Init Babybear OK\r\n");
+ printf("Init FlightSense OK\r\n");
+
+#endif
//----
- // Initializing MEMS Component
- mems=X_NUCLEO_IKS01A1::Instance(&dev_i2c);
- accelerometer = mems->GetAccelerometer();
-
- printf("Init MEMS OK\r\n");
-
-//----
+#ifdef EasySpin
- // Initializing Motor Component
+ // Initializing EasySpin Component
motor = new L6474(D2, D8, PB_2, D9, D10, dev_spi); // D7 conflict with BNRG_RST (when motor change direction 0-1 reset BLE)
// Used Morpho PB_2 and made HW wiring
if (motor->Init(NULL) != COMPONENT_OK)
@@ -284,8 +335,23 @@
motor->SetMaxSpeed(SET_MAX); // Variable by Light/Mems Sensors
motor->SetMinSpeed(SET_MIN);
- printf("Init Motor OK\r\n");
+ printf("Init EasySpin OK\r\n");
+
+#endif
+
+//----
+
+#ifdef Sensors
+ // Initializing Sensors Component
+ mems=X_NUCLEO_IKS01A1::Instance(&dev_i2c);
+ accelerometer = mems->GetAccelerometer();
+
+ printf("Init Sensors OK\r\n");
+
+#endif
+
+ printf("Initialization OK (Line %d)\r\n", __LINE__);
return true;
}
@@ -295,15 +361,16 @@
void Measure_Babybear(void)
{
+#ifdef FlightSense
+
status_l=board->sensor_left->GetMeasurement(als_continuous_polling, &data_sensor_left);
status_r=board->sensor_right->GetMeasurement(als_continuous_polling, &data_sensor_right);
babybear = data_sensor_right.lux - data_sensor_left.lux;
- diff = abs(babybear);
+ diff = babybear;
- if (babybear>0) { left=0; right=1; }
- if (babybear<0) { left=1; right=0; }
+#endif
}
@@ -312,12 +379,13 @@
void Measure_Accelerometer(void)
{
+#ifdef Sensors
+
accelerometer->Get_X_Axes(acc_data);
- diff = abs(acc_data[0]);
+ diff = acc_data[0];
- if (acc_data[0]>0) { left=0; right=1; }
- if (acc_data[0]<0) { left=1; right=0; }
+#endif
}
@@ -326,21 +394,28 @@
void Control_Motor(void)
{
- //printf("Diff: %d lux/mems\n\r", diff);
- motor->SetMaxSpeed(diff);
+#ifdef EasySpin
+
+ diff_abs = abs(diff);
- if (diff>TOLLERANCE) {
- if (diff <=RANGE_1)
+ //printf("Diff: %d lux/mems\n\r", diff_abs);
+ motor->SetMaxSpeed(diff_abs);
+
+ if (diff>0) { left=0; right=1; }
+ if (diff<0) { left=1; right=0; }
+
+ if (diff_abs>TOLLERANCE) {
+ if (diff_abs <=RANGE_1)
{
if (left) { strcpy(DisplayStr,"E___"); }
if (right) { strcpy(DisplayStr,"___3"); }
}
- else if (diff >RANGE_1 & diff <=RANGE_2)
+ else if (diff_abs >RANGE_1 & diff_abs <=RANGE_2)
{
if (left) { strcpy(DisplayStr,"E==="); }
if (right) { strcpy(DisplayStr,"===3"); }
}
- else if (diff >RANGE_2)
+ else if (diff_abs >RANGE_2)
{
if (left) { strcpy(DisplayStr,"E~~~"); }
if (right) { strcpy(DisplayStr,"~~~3"); }
@@ -351,10 +426,10 @@
if (right & dir==1) { changedir=1; }
// Run only if Stop or Change Direction
- if (diff>TOLLERANCE & (dir==0 | changedir==1)) {
+ if (diff_abs>TOLLERANCE & (dir==0 | changedir==1)) {
if (left) { motor->Run(StepperMotor::FWD); dir=1; changedir=0; }
if (right) { motor->Run(StepperMotor::BWD); dir=2; changedir=0; }
- printf("RUN\n\r");
+ printf("\n\rRUN");
}
}
@@ -363,11 +438,11 @@
if (pos>STOP | pos<-STOP) {
if (pos>0) { motor->GoTo(STOP); }
if (pos<0) { motor->GoTo(-STOP); }
- printf("GOTO\n\r");
+ printf("\n\rGOTO");
}
// Stop Motor
- if (diff<=TOLLERANCE) {
+ if (diff_abs<=TOLLERANCE) {
arrest=1;
if (Display==0) { strcpy(DisplayStr,"----"); }
if (Display==2) { strcpy(DisplayStr,"E 3"); }
@@ -378,9 +453,11 @@
dir=0;
changedir=0;
arrest=0;
- printf("STOP\n\r");
+ printf("\n\rSTOP");
}
+#endif
+
}
/* Measure_SolarPanel --------------------------------------------------------*/
@@ -389,15 +466,12 @@
{
// AnalogIn: 0V return 0.0 , 3.3V return 1.0
- float measure = analog_read.read() * 3300;
+ measure = analog_read.read() * 3300;
//printf("Measure = %.0f mV\r\n", measure);
//board->display->DisplayDigit("A", 0);
- if (Display==1) { sprintf(DisplayStr, "%.0f", measure); }
-
- board->display->DisplayString(DisplayStr, 4);
- //printf("%s\n\r", DisplayStr);
-
+ if (Display==1) { sprintf(DisplayStr, "%d", measure); }
+
}
/* Main ----------------------------------------------------------------------*/
@@ -406,30 +480,33 @@
{
// Printing to the console
- printf("SunTracker by Fabio Brembilla\r\n\n");
+ printf("\r\n\r\nSunTracker by Fabio Brembilla\r\n\r\n");
Initialization();
- printf("Initialization OK (Line %d)\r\n", __LINE__);
+ BLE_Initialization();
- BLE_Initialization();
- printf("BLE_Initialization OK (Line %d)\r\n", __LINE__);
-
mybutton.fall(&User_Button_Pressed);
- printf("Wait Push Button\r\n");
// Loop until push User Button to Set 0 Point
+ printf("\r\nWait PUSH Button");
strcpy(DisplayStr,"pusH");
while(start<1) {
+ #ifdef FlightSense
board->display->DisplayString(DisplayStr, 4);
- //p_BLEdev->waitForEvent();
+ p_BLEdev->waitForEvent();
//printf("%s\n\r", DisplayStr);
+ #endif
}
- printf("Start Main Loop\r\n");
+ printf("\r\n\r\nStart Main Loop");
- motor->Enable(); // To put the motor on hold execute CmdEnable
+ #ifdef EasySpin
+ motor->Enable(); // To put the motor on hold by execute CmdEnable
+ #endif
+ #ifdef Ble
static int INTLOOP=0;
+ #endif
// Main Loop
while(true)
@@ -439,14 +516,41 @@
Control_Motor();
Measure_SolarPanel();
-
+
+ #ifdef FlightSense
+ board->display->DisplayString(DisplayStr, 4);
+ //printf("%s\n\r", DisplayStr);
+ #endif
+
+ #ifdef Ble
INTLOOP++;
- if (INTLOOP==100) { p_customsensorservice->sendEnvPosition(rand(),0); printf("Read BLE\n\r"); INTLOOP=0; }
-
+ //if (INTLOOP==100) { p_customsensorservice->sendEnvPosition(rand(),0); printf("Read BLE\n\r"); INTLOOP=0; }
+ if (INTLOOP==100)
+ {
+ printf("\n\r\n\rSend BLE Display %d", Display);
+ //p_customcontrolservice->sendControlState(Display);
+ p_customcontrolservice->updateControlState(Display);
+
+ printf("\n\rSend BLE Difference %d lux/mems", diff); // Send BLE diff, no diff_abs
+ //p_customsensorservice->sendEnvDifference(diff);
+ p_customsensorservice->updateEnvDifference(diff);
+
+ printf("\n\rSend BLE Position %d", pos);
+ //p_customsensorservice->sendEnvPosition(pos);
+ p_customsensorservice->updateEnvPosition(pos);
+
+ printf("\n\rSend BLE Sunpanel %d mV", measure);
+ //p_customsensorservice->sendEnvSunpanel(measure);
+ p_customsensorservice->updateEnvSunpanel(measure);
+
+ INTLOOP=0;
+ }
+
p_BLEdev->waitForEvent();
+ #endif
}
//status_l=board->sensor_left->StopMeasurement(als_continuous_polling);
//status_r=board->sensor_right->StopMeasurement(als_continuous_polling);
-}
+}
\ No newline at end of file