ROHMUSDC
/
Nordic_UART_TEMPLATE_ROHM
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: BLE_API mbed nRF51822 Nordic_UART_TEMPLATE_ROHM
Dependents: Nordic_UART_TEMPLATE_ROHM
Fork of
UART_TEMPLATE
by 
daniel veilleux
Revision 6:6860e53dc7ae, committed 2015-09-28
- Comitter:
- kbahar3
- Date:
- Mon Sep 28 19:00:02 2015 +0000
- Parent:
- 5:d39ffc5638a3
- Child:
- 7:71046927a0e9
- Commit message:
- Fixed Periodic Callback to send one sensor point every second. Also, fixed comments sand general formatting to make the code easier to read. Removed miscellaneous content/comments
Changed in this revision
| main.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- a/main.cpp Thu Sep 24 22:23:31 2015 +0000
+++ b/main.cpp Mon Sep 28 19:00:02 2015 +0000
@@ -1,4 +1,5 @@
-/* mbed Microcontroller Library
+/*
+ * mbed Microcontroller Library
* Copyright (c) 2006-2013 ARM Limited
*
* Licensed under the Apache License, Version 2.0 (the "License");
@@ -15,8 +16,10 @@
*/
/*
- * Added Functions for interfacing with ROHM's Multi-Sensor Shield Board
- * Supports the following Sensor Devices
+ * Code Example for ROHM Mutli-Sensor Shield on the Nordic Semiconductor nRF51-DK
+ *
+ * Description: This Applications interfaces ROHM's Multi-Sensor Shield Board with the Nordic nRF51-DK
+ * This Code supports the following sensor devices on the shield:
* > BDE0600G Temperature Sensor
* > BM1383GLV Pressure Sensor
* > BU52014 Hall Sensor
@@ -27,30 +30,27 @@
* > KX122 Accel Sensor
* > KXG03 Gyro (Currently Unavailable as IC hasn't docked yet)
*
- *
- * Last Upadtaed: 9/11/15
- *
* New Code:
+ * Added Variable Initialization for utilizing ROHM Sensors
* Added a Section in "Main" to act as initialization
* Added to the "Periodic Callback" to read sensor data and return to Phone/Host
*
* Additional information about the ROHM MultiSensor Shield Board can be found at the following link:
* https://github.com/ROHMUSDC/ROHM_SensorPlatform_Multi-Sensor-Shield
- */
-
+ *
+ * Last Upadtaed: 9/28/15
+ * Author: ROHM USDC
+ * Contact Information: engineering@rohmsemiconductor.com
+ */
-//#define AnalogALS //BH1620 //Change 0: Remove this completely
-#define AnalogTemp //BDE0600
-#define AnalogUV //ML8511
-#define HallSensor //BU52011 //Change 1: Change to use GPIO for BU52014
-#define RPR0521 //RPR0521 //Change 2: Remove This and add in the RPR-0521
-#define KMX62 //Change 3: Add Code For -BH1745-, -KX022, BM1383GLV, -KMX62-
-#define color
-#define KX022
-#define Pressure
-
-
-
+#define AnalogTemp //BDE0600, Analog Temperature Sensor
+#define AnalogUV //ML8511, Analog UV Sensor
+#define HallSensor //BU52011, Hall Switch Sensor
+#define RPR0521 //RPR0521, ALS/PROX Sensor
+#define KMX62 //KMX61, Accel/Mag Sensor
+#define color //BH1745, Color Sensor
+#define KX022 //KX022, Accelerometer Sensor
+#define Pressure //BM1383, Barometric Pressure Sensor
#include "mbed.h"
#include "BLEDevice.h"
@@ -58,18 +58,16 @@
#include "nrf_temp.h"
#include "I2C.h"
-
#define MAX_REPLY_LEN (UARTService::BLE_UART_SERVICE_MAX_DATA_LEN) //Actually equal to 20
-#define SENSOR_READ_INTERVAL_S (5.0F)
+#define SENSOR_READ_INTERVAL_S (1.0F)
#define ADV_INTERVAL_MS (1000UL)
#define UART_BAUD_RATE (19200UL)
#define DEVICE_NAME ("DEMO SENSOR") // This can be read AFTER connecting to the device.
-#define SHORT_NAME ("ROHMKRIS") // Keep this short: max 8 chars if a 128bit UUID is also advertised.
-
+#define SHORT_NAME ("ROHMSHLD") // Keep this short: max 8 chars if a 128bit UUID is also advertised.
#define DEBUG(...) { m_serial_port.printf(__VA_ARGS__); }
// Function Prototypes
-void PBTrigger(); //Interrupt function for PB4
+void PBTrigger(); //Interrupt function for PB4
// Global Variables
BLEDevice m_ble;
@@ -80,36 +78,33 @@
DigitalIn testButton(p20);
InterruptIn sw4Press(p20);
I2C i2c(p30,p7);
+bool RepStart = true;
+bool NoRepStart = false;
+int i = 1;
//Sensor Variables
-/*
-AnalogIn BH1620_ALS(p1); //No Analog ALS on the shield
-uint16_t BH1620_ALS_value;
-float BH1620_output;
-*/
-
-AnalogIn BDE0600_Temp(p3); //p2 on the prior evk, p3 on the shield
+#ifdef AnalogTemp
+AnalogIn BDE0600_Temp(p3);
uint16_t BDE0600_Temp_value;
float BDE0600_output;
+#endif
-AnalogIn ML8511_UV(p5); //p3 on prior EVK, p5 on the shield
+#ifdef AnalogUV
+AnalogIn ML8511_UV(p5);
uint16_t ML8511_UV_value;
float ML8511_output;
+#endif
-DigitalIn Hall_GPIO0(p14); //
-DigitalIn Hall_GPIO1(p15); //
+#ifdef HallSensor
+DigitalIn Hall_GPIO0(p14);
+DigitalIn Hall_GPIO1(p15);
int Hall_Return1;
int Hall_Return0;
-
-bool RepStart = true;
-bool NoRepStart = false;
+#endif
-int i=1;
-
-
-#ifdef RPR0521 //als digital
-int RPR0521_addr_w = 0x70; //7bit addr = 0x38, with write bit 0
-int RPR0521_addr_r = 0x71; //7bit addr = 0x38, with read bit 1
+#ifdef RPR0521
+int RPR0521_addr_w = 0x70;
+int RPR0521_addr_r = 0x71;
char RPR0521_ModeControl[2] = {0x41, 0xE6};
char RPR0521_ALSPSControl[2] = {0x42, 0x03};
@@ -126,8 +121,8 @@
#endif
#ifdef KMX62
-int KMX62_addr_w = 0x1C; //7bit addr = 0x38, with write bit 0
-int KMX62_addr_r = 0x1D; //7bit addr = 0x38, with read bit 1
+int KMX62_addr_w = 0x1C;
+int KMX62_addr_r = 0x1D;
char KMX62_CNTL2[2] = {0x3A, 0x5F};
char KMX62_Addr_Accel_ReadData = 0x0A;
@@ -135,23 +130,23 @@
char KMX62_Addr_Mag_ReadData = 0x10;
char KMX62_Content_Mag_ReadData[6];
-short int MEMS_Accel_Xout = 0;
-short int MEMS_Accel_Yout = 0;
-short int MEMS_Accel_Zout = 0;
-double MEMS_Accel_Conv_Xout = 0;
-double MEMS_Accel_Conv_Yout = 0;
-double MEMS_Accel_Conv_Zout = 0;
-short int MEMS_Mag_Xout = 0;
-short int MEMS_Mag_Yout = 0;
-short int MEMS_Mag_Zout = 0;
+short int MEMS_Accel_Xout = 0;
+short int MEMS_Accel_Yout = 0;
+short int MEMS_Accel_Zout = 0;
+double MEMS_Accel_Conv_Xout = 0;
+double MEMS_Accel_Conv_Yout = 0;
+double MEMS_Accel_Conv_Zout = 0;
+short int MEMS_Mag_Xout = 0;
+short int MEMS_Mag_Yout = 0;
+short int MEMS_Mag_Zout = 0;
float MEMS_Mag_Conv_Xout = 0;
float MEMS_Mag_Conv_Yout = 0;
float MEMS_Mag_Conv_Zout = 0;
#endif
#ifdef color
-int BH1745_addr_w = 0x72; //write
-int BH1745_addr_r = 0x73; //read
+int BH1745_addr_w = 0x72;
+int BH1745_addr_r = 0x73;
char BH1745_persistence[2] = {0x61, 0x03};
char BH1745_mode1[2] = {0x41, 0x00};
@@ -161,15 +156,15 @@
char BH1745_Content_ReadData[6];
char BH1745_Addr_color_ReadData = 0x50;
-int BH1745_Red;
-int BH1745_Blue;
-int BH1745_Green;
+int BH1745_Red;
+int BH1745_Blue;
+int BH1745_Green;
#endif
#ifdef KX022
-int KX022_addr_w = 0x3C; //write
-int KX022_addr_r = 0x3D; //read
+int KX022_addr_w = 0x3C;
+int KX022_addr_r = 0x3D;
char KX022_Accel_CNTL1[2] = {0x18, 0x41};
char KX022_Accel_ODCNTL[2] = {0x1B, 0x02};
@@ -180,26 +175,25 @@
char KX022_Content_ReadData[6];
char KX022_Addr_Accel_ReadData = 0x06;
-float KX022_Accel_X;
-float KX022_Accel_Y;
-float KX022_Accel_Z;
-
-short int KX022_Accel_X_RawOUT = 0;
-short int KX022_Accel_Y_RawOUT = 0;
-short int KX022_Accel_Z_RawOUT = 0;
+float KX022_Accel_X;
+float KX022_Accel_Y;
+float KX022_Accel_Z;
-int KX022_Accel_X_LB = 0;
-int KX022_Accel_X_HB = 0;
-int KX022_Accel_Y_LB = 0;
-int KX022_Accel_Y_HB = 0;
-int KX022_Accel_Z_LB = 0;
-int KX022_Accel_Z_HB = 0;
+short int KX022_Accel_X_RawOUT = 0;
+short int KX022_Accel_Y_RawOUT = 0;
+short int KX022_Accel_Z_RawOUT = 0;
+int KX022_Accel_X_LB = 0;
+int KX022_Accel_X_HB = 0;
+int KX022_Accel_Y_LB = 0;
+int KX022_Accel_Y_HB = 0;
+int KX022_Accel_Z_LB = 0;
+int KX022_Accel_Z_HB = 0;
#endif
#ifdef Pressure
-int Press_addr_w = 0xBA; //write
-int Press_addr_r = 0xBB; //read
+int Press_addr_w = 0xBA;
+int Press_addr_r = 0xBB;
char PWR_DOWN[2] = {0x12, 0x01};
char SLEEP[2] = {0x13, 0x01};
@@ -214,7 +208,7 @@
int BM1383_Pres_lowByte;
int BM1383_Pres_leastByte;
-float BM1383_Temp_Out;
+short int BM1383_Temp_Out;
float BM1383_Temp_Conv_Out;
float BM1383_Pres_Conv_Out;
@@ -243,7 +237,6 @@
m_ble.startAdvertising();
}
-
/**
* This callback is used whenever the host writes data to one of our GATT characteristics.
*/
@@ -253,7 +246,6 @@
if ((m_uart_service_ptr != NULL) && (params->charHandle == m_uart_service_ptr->getTXCharacteristicHandle())) {
uint8_t buf[MAX_REPLY_LEN];
uint32_t len = 0;
-
if (1 == params->len) {
switch (params->data[0]) {
case '0':
@@ -264,12 +256,6 @@
m_cmd_led = m_cmd_led ^ 1;
len = snprintf((char*) buf, MAX_REPLY_LEN, "OK... LED OFF");
break;
- case 'a':
- //len = snprintf((char*) buf, MAX_REPLY_LEN, "ALSRaw = %d", BH1620_ALS_value);
- break;
- case 'b':
- //len = snprintf((char*) buf, MAX_REPLY_LEN, "ALS = %.2f lx", BH1620_output);
- break;
default:
len = snprintf((char*) buf, MAX_REPLY_LEN, "ERROR");
break;
@@ -279,14 +265,11 @@
{
len = snprintf((char*) buf, MAX_REPLY_LEN, "ERROR");
}
-
m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
-
DEBUG("%d bytes received from host\n\r", params->len);
}
}
-
/**
* This callback is used whenever a write to a GATT characteristic causes data to be sent to the host.
*/
@@ -305,288 +288,286 @@
uint8_t buf[MAX_REPLY_LEN];
uint32_t len = 0;
-
-if(i==1)
-{
-/*
-#ifdef AnalogALS
- if (m_ble.getGapState().connected) {
- BH1620_ALS_value = BH1620_ALS.read_u16();
- BH1620_output = (float)BH1620_ALS_value * 1.543;
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Analog ALS = %.2f lx", BH1620_output);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- }
-#endif
-*/
-
-#ifdef color
-if (m_ble.getGapState().connected) {
- //Read color Portion from the IC
- i2c.write(BH1745_addr_w, &BH1745_Addr_color_ReadData, 1, RepStart);
- i2c.read(BH1745_addr_r, &BH1745_Content_ReadData[0], 6, NoRepStart);
-
- //separate all data read into colors
-
- BH1745_Red = (BH1745_Content_ReadData[1]<<8) | (BH1745_Content_ReadData[0]);
- BH1745_Green = (BH1745_Content_ReadData[3]<<8) | (BH1745_Content_ReadData[2]);
- BH1745_Blue = (BH1745_Content_ReadData[5]<<8) | (BH1745_Content_ReadData[4]);
-
-
- //transmit data
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Red= %d", BH1745_Red);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Green= %d", BH1745_Green);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Blue= %d", BH1745_Blue);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
-}
-#endif
-
-#ifdef AnalogTemp
- if (m_ble.getGapState().connected) {
- BDE0600_Temp_value = BDE0600_Temp.read_u16();
- BDE0600_output = (float)BDE0600_Temp_value * 0.00283; //(value * (2.9V/1024))
- BDE0600_output = (BDE0600_output-1.753)/(-0.01068) + 30;
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Temp = %.2f C", BDE0600_output);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- }
-#endif
-
-#ifdef AnalogUV
- if (m_ble.getGapState().connected) {
- ML8511_UV_value = ML8511_UV.read_u16();
- ML8511_output = (float)ML8511_UV_value * 0.0029; //(value * (2.9V/1024)) //Note to self: when playing with this, a negative value is seen... Honestly, I think this has to do with my ADC converstion...
- ML8511_output = (ML8511_output-2.2)/(0.129) + 10; // Added +5 to the offset so when inside (aka, no UV, readings show 0)... this is the wrong approach... and the readings don't make sense... Fix this.
+ if(i == 1) {
+ #ifdef color
+ if (m_ble.getGapState().connected) {
+ //Read color Portion from the IC
+ i2c.write(BH1745_addr_w, &BH1745_Addr_color_ReadData, 1, RepStart);
+ i2c.read(BH1745_addr_r, &BH1745_Content_ReadData[0], 6, NoRepStart);
+
+ //separate all data read into colors
+ BH1745_Red = (BH1745_Content_ReadData[1]<<8) | (BH1745_Content_ReadData[0]);
+ BH1745_Green = (BH1745_Content_ReadData[3]<<8) | (BH1745_Content_ReadData[2]);
+ BH1745_Blue = (BH1745_Content_ReadData[5]<<8) | (BH1745_Content_ReadData[4]);
- len = snprintf((char*) buf, MAX_REPLY_LEN, "UV = %.1f mW/cm2", ML8511_output);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+
+ //transmit data
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "Color Sensor:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " Red= %d ADC", BH1745_Red);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " Green= %d ADC", BH1745_Green);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " Blue= %d ADC", BH1745_Blue);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ }
+ #endif
+ i++;
}
-#endif
-
-#ifdef HallSensor
- if (m_ble.getGapState().connected) {
- Hall_Return0 = Hall_GPIO0;
- Hall_Return1 = Hall_GPIO1;
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "H0 = %d, H1 = %d", Hall_Return0, Hall_Return1);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ else if(i == 2){
+ #ifdef AnalogTemp
+ if (m_ble.getGapState().connected) {
+ BDE0600_Temp_value = BDE0600_Temp.read_u16();
+ BDE0600_output = (float)BDE0600_Temp_value * 0.00283; //(value * (2.9V/1024))
+ BDE0600_output = (BDE0600_output-1.753)/(-0.01068) + 30;
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "Temp Sensor:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " Temp= %.2f C", BDE0600_output);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+ }
+ #endif
+ i++;
+ }
+ else if(i == 3){
+ #ifdef AnalogUV
+ if (m_ble.getGapState().connected) {
+ ML8511_UV_value = ML8511_UV.read_u16();
+ ML8511_output = (float)ML8511_UV_value * 0.0029; //(value * (2.9V/1024)) //Note to self: when playing with this, a negative value is seen... Honestly, I think this has to do with my ADC converstion...
+ ML8511_output = (ML8511_output-2.2)/(0.129) + 10; // Added +5 to the offset so when inside (aka, no UV, readings show 0)... this is the wrong approach... and the readings don't make sense... Fix this.
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "UV Sensor:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " UV= %.1f mW/cm2", ML8511_output);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+ }
+ #endif
+ i++;
}
-#endif
-
-#ifdef DigitalALS
- if (m_ble.getGapState().connected) {
- i2c.read(ALS_addr_r, ALS_ReturnData_raw, 2);
- ALS_Return = (ALS_ReturnData_raw[0]<<8) | ALS_ReturnData_raw[1];
- ALS_Return = ALS_Return/1.2;
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "DAL1= %0.2f lx", ALS_Return);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ else if(i == 4){
+ #ifdef HallSensor
+ if (m_ble.getGapState().connected) {
+ Hall_Return0 = Hall_GPIO0;
+ Hall_Return1 = Hall_GPIO1;
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "Hall Sensor:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " H0 = %d, H1 = %d", Hall_Return0, Hall_Return1);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+ }
+ #endif
+ i++;
}
-#endif
+ else if(i == 5){
+ #ifdef RPR0521 //als digital
+ if (m_ble.getGapState().connected) {
+
+ i2c.write(RPR0521_addr_w, &RPR0521_Addr_ReadData, 1, RepStart);
+ i2c.read(RPR0521_addr_r, &RPR0521_Content_ReadData[0], 6, NoRepStart);
+
+ RPR0521_PS_RAWOUT = (RPR0521_Content_ReadData[1]<<8) | (RPR0521_Content_ReadData[0]);
+ RPR0521_ALS_D0_RAWOUT = (RPR0521_Content_ReadData[3]<<8) | (RPR0521_Content_ReadData[2]);
+ RPR0521_ALS_D1_RAWOUT = (RPR0521_Content_ReadData[5]<<8) | (RPR0521_Content_ReadData[4]);
+ RPR0521_ALS_DataRatio = (float)RPR0521_ALS_D1_RAWOUT / (float)RPR0521_ALS_D0_RAWOUT;
+
+ if(RPR0521_ALS_DataRatio < 0.595){
+ RPR0521_ALS_OUT = (1.682*(float)RPR0521_ALS_D0_RAWOUT - 1.877*(float)RPR0521_ALS_D1_RAWOUT);
+ }
+ else if(RPR0521_ALS_DataRatio < 1.015){
+ RPR0521_ALS_OUT = (0.644*(float)RPR0521_ALS_D0_RAWOUT - 0.132*(float)RPR0521_ALS_D1_RAWOUT);
+ }
+ else if(RPR0521_ALS_DataRatio < 1.352){
+ RPR0521_ALS_OUT = (0.756*(float)RPR0521_ALS_D0_RAWOUT - 0.243*(float)RPR0521_ALS_D1_RAWOUT);
+ }
+ else if(RPR0521_ALS_DataRatio < 3.053){
+ RPR0521_ALS_OUT = (0.766*(float)RPR0521_ALS_D0_RAWOUT - 0.25*(float)RPR0521_ALS_D1_RAWOUT);
+ }
+ else{
+ RPR0521_ALS_OUT = 0;
+ }
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "ALS/PROX:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " ALS= %0.2f lx", RPR0521_ALS_OUT);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " PS= %u ADC", RPR0521_PS_RAWOUT);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+ }
+ #endif
+ i++;
+ }
+ else if(i == 6){
+ #ifdef KMX62
+ if (m_ble.getGapState().connected) {
+ //Read Accel Portion from the IC
+ i2c.write(KMX62_addr_w, &KMX62_Addr_Accel_ReadData, 1, RepStart);
+ i2c.read(KMX62_addr_r, &KMX62_Content_Accel_ReadData[0], 6, NoRepStart);
-#ifdef RPR0521 //als digital
- if (m_ble.getGapState().connected) {
-
- i2c.write(RPR0521_addr_w, &RPR0521_Addr_ReadData, 1, RepStart);
- i2c.read(RPR0521_addr_r, &RPR0521_Content_ReadData[0], 6, NoRepStart);
-
- RPR0521_PS_RAWOUT = (RPR0521_Content_ReadData[1]<<8) | (RPR0521_Content_ReadData[0]);
- RPR0521_ALS_D0_RAWOUT = (RPR0521_Content_ReadData[3]<<8) | (RPR0521_Content_ReadData[2]);
- RPR0521_ALS_D1_RAWOUT = (RPR0521_Content_ReadData[5]<<8) | (RPR0521_Content_ReadData[4]);
- RPR0521_ALS_DataRatio = (float)RPR0521_ALS_D1_RAWOUT / (float)RPR0521_ALS_D0_RAWOUT;
-
- if(RPR0521_ALS_DataRatio < 0.595){
- RPR0521_ALS_OUT = (1.682*(float)RPR0521_ALS_D0_RAWOUT - 1.877*(float)RPR0521_ALS_D1_RAWOUT);
- }
- else if(RPR0521_ALS_DataRatio < 1.015){
- RPR0521_ALS_OUT = (0.644*(float)RPR0521_ALS_D0_RAWOUT - 0.132*(float)RPR0521_ALS_D1_RAWOUT);
+ //Note: The highbyte and low byte return a 14bit value, dropping the two LSB in the Low byte.
+ // However, because we need the signed value, we will adjust the value when converting to "g"
+ MEMS_Accel_Xout = (KMX62_Content_Accel_ReadData[1]<<8) | (KMX62_Content_Accel_ReadData[0]);
+ MEMS_Accel_Yout = (KMX62_Content_Accel_ReadData[3]<<8) | (KMX62_Content_Accel_ReadData[2]);
+ MEMS_Accel_Zout = (KMX62_Content_Accel_ReadData[5]<<8) | (KMX62_Content_Accel_ReadData[4]);
+
+ //Note: Conversion to G is as follows:
+ // Axis_ValueInG = MEMS_Accel_axis / 1024
+ // However, since we did not remove the LSB previously, we need to divide by 4 again
+ // Thus, we will divide the output by 4096 (1024*4) to convert and cancel out the LSB
+ MEMS_Accel_Conv_Xout = ((float)MEMS_Accel_Xout/4096/2);
+ MEMS_Accel_Conv_Yout = ((float)MEMS_Accel_Yout/4096/2);
+ MEMS_Accel_Conv_Zout = ((float)MEMS_Accel_Zout/4096/2);
+
+ //Read MAg portion from the IC
+ i2c.write(KMX62_addr_w, &KMX62_Addr_Mag_ReadData, 1, RepStart);
+ i2c.read(KMX62_addr_r, &KMX62_Content_Mag_ReadData[0], 6, NoRepStart);
+
+ //Note: The highbyte and low byte return a 14bit value, dropping the two LSB in the Low byte.
+ // However, because we need the signed value, we will adjust the value when converting to "g"
+ MEMS_Mag_Xout = (KMX62_Content_Mag_ReadData[1]<<8) | (KMX62_Content_Mag_ReadData[0]);
+ MEMS_Mag_Yout = (KMX62_Content_Mag_ReadData[3]<<8) | (KMX62_Content_Mag_ReadData[2]);
+ MEMS_Mag_Zout = (KMX62_Content_Mag_ReadData[5]<<8) | (KMX62_Content_Mag_ReadData[4]);
+
+ //Note: Conversion to G is as follows:
+ // Axis_ValueInG = MEMS_Accel_axis / 1024
+ // However, since we did not remove the LSB previously, we need to divide by 4 again
+ // Thus, we will divide the output by 4095 (1024*4) to convert and cancel out the LSB
+ MEMS_Mag_Conv_Xout = (float)MEMS_Mag_Xout/4096*0.146;
+ MEMS_Mag_Conv_Yout = (float)MEMS_Mag_Yout/4096*0.146;
+ MEMS_Mag_Conv_Zout = (float)MEMS_Mag_Zout/4096*0.146;
+
+ // transmit data
+
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "KMX61SensorData:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " AccX= %0.2f g", MEMS_Accel_Conv_Xout);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " AccY= %0.2f g", MEMS_Accel_Conv_Yout);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " AccZ= %0.2f g", MEMS_Accel_Conv_Zout);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " MagX= %0.2f uT", MEMS_Mag_Conv_Xout);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " MagY= %0.2f uT", MEMS_Mag_Conv_Yout);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " MagZ= %0.2f uT", MEMS_Mag_Conv_Zout);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
}
- else if(RPR0521_ALS_DataRatio < 1.352){
- RPR0521_ALS_OUT = (0.756*(float)RPR0521_ALS_D0_RAWOUT - 0.243*(float)RPR0521_ALS_D1_RAWOUT);
- }
- else if(RPR0521_ALS_DataRatio < 3.053){
- RPR0521_ALS_OUT = (0.766*(float)RPR0521_ALS_D0_RAWOUT - 0.25*(float)RPR0521_ALS_D1_RAWOUT);
- }
- else{
- RPR0521_ALS_OUT = 0;
- }
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "DALS= %0.2f lx", RPR0521_ALS_OUT);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
-
+ #endif
+ i++;
}
-#endif
+ else if(i==7){
+ #ifdef KX022
+ if (m_ble.getGapState().connected) {
+ //Read KX022 Portion from the IC
+ i2c.write(KX022_addr_w, &KX022_Addr_Accel_ReadData, 1, RepStart);
+ i2c.read(KX022_addr_r, &KX022_Content_ReadData[0], 6, NoRepStart);
+
+
+ //reconfigure the data (taken from arduino code)
+ KX022_Accel_X_RawOUT = (KX022_Content_ReadData[1]<<8) | (KX022_Content_ReadData[0]);
+ KX022_Accel_Y_RawOUT = (KX022_Content_ReadData[3]<<8) | (KX022_Content_ReadData[2]);
+ KX022_Accel_Z_RawOUT = (KX022_Content_ReadData[5]<<8) | (KX022_Content_ReadData[4]);
-i++;
-
+ //apply needed changes (taken from arduino code)
+ KX022_Accel_X = (float)KX022_Accel_X_RawOUT / 16384;
+ KX022_Accel_Y = (float)KX022_Accel_Y_RawOUT / 16384;
+ KX022_Accel_Z = (float)KX022_Accel_Z_RawOUT / 16384;
+
+
+
+ //transmit the data
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "KX022 Sensor:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " ACCX= %0.2f g", KX022_Accel_X);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " ACCY= %0.2f g", KX022_Accel_Y);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " ACCZ= %0.2f g", KX022_Accel_Z);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ }
+ #endif
+ i++;
+ }
+ else if (i == 8){
+ #ifdef Pressure
+ if (m_ble.getGapState().connected) {
+ //Read color Portion from the IC
+ i2c.write(Press_addr_w, &Press_Addr_ReadData, 1, RepStart);
+ i2c.read(Press_addr_r, &Press_Content_ReadData[0], 6, NoRepStart);
+
+ BM1383_Temp_Out = (Press_Content_ReadData[0]<<8) | (Press_Content_ReadData[1]);
+ BM1383_Temp_Conv_Out = (float)BM1383_Temp_Out/32;
+
+ BM1383_Var = (Press_Content_ReadData[2]<<3) | (Press_Content_ReadData[3] >> 5);
+ BM1383_Deci = ((Press_Content_ReadData[3] & 0x1f) << 6 | ((Press_Content_ReadData[4] >> 2)));
+ BM1383_Deci = (float)BM1383_Deci* 0.00048828125; //0.00048828125 = 2^-11
+ BM1383_Pres_Conv_Out = (BM1383_Var + BM1383_Deci); //question pending here...
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "Pressure Sensor:");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " Temp= %0.2f C", BM1383_Temp_Conv_Out);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " Pres= %0.2f hPa", BM1383_Pres_Conv_Out);
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+
+ len = snprintf((char*) buf, MAX_REPLY_LEN, " ");
+ m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
+ wait_ms(20);
+ }
+ #endif
+ i=1;
+ }
}
-else if(i==2)
-{
-
-#ifdef KMX62
- if (m_ble.getGapState().connected) {
- //Read Accel Portion from the IC
- i2c.write(KMX62_addr_w, &KMX62_Addr_Accel_ReadData, 1, RepStart);
- i2c.read(KMX62_addr_r, &KMX62_Content_Accel_ReadData[0], 6, NoRepStart);
-
- //Note: The highbyte and low byte return a 14bit value, dropping the two LSB in the Low byte.
- // However, because we need the signed value, we will adjust the value when converting to "g"
- MEMS_Accel_Xout = (KMX62_Content_Accel_ReadData[1]<<8) | (KMX62_Content_Accel_ReadData[0]);
- MEMS_Accel_Yout = (KMX62_Content_Accel_ReadData[3]<<8) | (KMX62_Content_Accel_ReadData[2]);
- MEMS_Accel_Zout = (KMX62_Content_Accel_ReadData[5]<<8) | (KMX62_Content_Accel_ReadData[4]);
-
- //Note: Conversion to G is as follows:
- // Axis_ValueInG = MEMS_Accel_axis / 1024
- // However, since we did not remove the LSB previously, we need to divide by 4 again
- // Thus, we will divide the output by 4096 (1024*4) to convert and cancel out the LSB
- MEMS_Accel_Conv_Xout = ((float)MEMS_Accel_Xout/4096/2);
- MEMS_Accel_Conv_Yout = ((float)MEMS_Accel_Yout/4096/2);
- MEMS_Accel_Conv_Zout = ((float)MEMS_Accel_Zout/4096/2);
-
- //Read MAg portion from the IC
- i2c.write(KMX62_addr_w, &KMX62_Addr_Mag_ReadData, 1, RepStart);
- i2c.read(KMX62_addr_r, &KMX62_Content_Mag_ReadData[0], 6, NoRepStart);
-
- //Note: The highbyte and low byte return a 14bit value, dropping the two LSB in the Low byte.
- // However, because we need the signed value, we will adjust the value when converting to "g"
- MEMS_Mag_Xout = (KMX62_Content_Mag_ReadData[1]<<8) | (KMX62_Content_Mag_ReadData[0]);
- MEMS_Mag_Yout = (KMX62_Content_Mag_ReadData[3]<<8) | (KMX62_Content_Mag_ReadData[2]);
- MEMS_Mag_Zout = (KMX62_Content_Mag_ReadData[5]<<8) | (KMX62_Content_Mag_ReadData[4]);
-
- //Note: Conversion to G is as follows:
- // Axis_ValueInG = MEMS_Accel_axis / 1024
- // However, since we did not remove the LSB previously, we need to divide by 4 again
- // Thus, we will divide the output by 4095 (1024*4) to convert and cancel out the LSB
- MEMS_Mag_Conv_Xout = (float)MEMS_Mag_Xout/4096*0.146;
- MEMS_Mag_Conv_Yout = (float)MEMS_Mag_Yout/4096*0.146;
- MEMS_Mag_Conv_Zout = (float)MEMS_Mag_Zout/4096*0.146;
-
- // transmit data
-
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "KMX61SensorData:");
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(20);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, " AccX= %0.2f g", MEMS_Accel_Conv_Xout);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(20);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, " AccY= %0.2f g", MEMS_Accel_Conv_Yout);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(20);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, " AccZ= %0.2f g", MEMS_Accel_Conv_Zout);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(20);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, " MagX= %0.2f g", MEMS_Mag_Conv_Xout);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(20);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, " MagY= %0.2f g", MEMS_Mag_Conv_Yout);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(20);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, " MagZ= %0.2f g", MEMS_Mag_Conv_Zout);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(20);
-
- }
-#endif
-
-i++;
-
-}
-
-
-else if(i==3)
-{
-
-
-
-#ifdef KX022
-if (m_ble.getGapState().connected) {
- //Read KX022 Portion from the IC
- i2c.write(KX022_addr_w, &KX022_Addr_Accel_ReadData, 1, RepStart);
- i2c.read(KX022_addr_r, &KX022_Content_ReadData[0], 6, NoRepStart);
-
-
- //reconfigure the data (taken from arduino code)
- KX022_Accel_X_RawOUT = (KX022_Content_ReadData[1]<<8) | (KX022_Content_ReadData[0]);
- KX022_Accel_Y_RawOUT = (KX022_Content_ReadData[3]<<8) | (KX022_Content_ReadData[2]);
- KX022_Accel_Z_RawOUT = (KX022_Content_ReadData[5]<<8) | (KX022_Content_ReadData[4]);
-
- //apply needed changes (taken from arduino code)
- KX022_Accel_X = (float)KX022_Accel_X_RawOUT / 16384;
- KX022_Accel_Y = (float)KX022_Accel_Y_RawOUT / 16384;
- KX022_Accel_Z = (float)KX022_Accel_Z_RawOUT / 16384;
-
-
-
- //transmit the data
- len = snprintf((char*) buf, MAX_REPLY_LEN, "KX022-X= %0.2f", KX022_Accel_X);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "KX022-Y= %0.2f", KX022_Accel_Y);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "KX022-Z= %0.2f", KX022_Accel_Z);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
- }
-#endif
-
-#ifdef Pressure
-if (m_ble.getGapState().connected) {
- //Read color Portion from the IC
- i2c.write(Press_addr_w, &Press_Addr_ReadData, 1, RepStart);
- i2c.read(Press_addr_r, &Press_Content_ReadData[0], 6, NoRepStart);
-
-
-
- BM1383_Temp_Out = (Press_Content_ReadData[1]<<8) | (Press_Content_ReadData[0]);
- BM1383_Temp_Conv_Out = (float)BM1383_Temp_Out/32;
-
- BM1383_Var = (Press_Content_ReadData[2]<<3) | (Press_Content_ReadData[3] >> 5);
- BM1383_Deci = ((Press_Content_ReadData[3] & 0x1f) << 6 | ((Press_Content_ReadData[4] >> 2)));
- BM1383_Deci = (float)BM1383_Deci* 0.00048828125; //0.00048828125 = 2^-11
- BM1383_Pres_Conv_Out = (BM1383_Var + BM1383_Deci); //question pending here...
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Temp_out= %0.2f", BM1383_Temp_Out);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Temp_conv= %0.2f", BM1383_Temp_Conv_Out);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "Press_conv= %0.2f", BM1383_Pres_Conv_Out);
- m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- wait_ms(25);
-}
-#endif
-
-i=1;
-
-}
-
-
-
-}
void error(ble_error_t err, uint32_t line)
{
m_error_led = 1;
@@ -600,15 +581,9 @@
m_cmd_led = !m_cmd_led;
-
if (m_ble.getGapState().connected) {
- /*
- BH1620_ALS_value = BH1620_ALS.read_u16();
- BH1620_output = (float)BH1620_ALS_value * 1.543;
-
- len = snprintf((char*) buf, MAX_REPLY_LEN, "ALS = %.2f lx", BH1620_output);
+ len = snprintf((char*) buf, MAX_REPLY_LEN, "Button Pressed!");
m_ble.updateCharacteristicValue(m_uart_service_ptr->getRXCharacteristicHandle(), buf, len);
- */
}
}
@@ -623,53 +598,48 @@
m_cmd_led = 0;
m_error_led = 0;
- //BH1620_ALS_value = 0;
ticker.attach(periodicCallback, SENSOR_READ_INTERVAL_S);
sw4Press.fall(&PBTrigger);
-#ifdef RPR0521 //als digital
- // 1. Mode Control (0x41), write (0xC6): ALS EN, PS EN, 100ms measurement for ALS and PS, PS_PULSE=1
- // 2. ALS_PS_CONTROL (0x42), write (0x03): LED Current = 200mA
- // 3. PERSIST (0x43), write (0x20): PS Gain x4
+ #ifdef RPR0521
+ // 1. Mode Control (0x41), write (0xC6): ALS EN, PS EN, 100ms measurement for ALS and PS, PS_PULSE=1
+ // 2. ALS_PS_CONTROL (0x42), write (0x03): LED Current = 200mA
+ // 3. PERSIST (0x43), write (0x20): PS Gain x4
i2c.write(RPR0521_addr_w, &RPR0521_ModeControl[0], 2, false);
i2c.write(RPR0521_addr_w, &RPR0521_ALSPSControl[0], 2, false);
i2c.write(RPR0521_addr_w, &RPR0521_Persist[0], 2, false);
-#endif
+ #endif
-#ifdef KMX62
- // 1. CNTL2 (0x3A), write (0x5F): 4g, Max RES, EN temp mag and accel
+ #ifdef KMX62
+ // 1. CNTL2 (0x3A), write (0x5F): 4g, Max RES, EN temp mag and accel
i2c.write(KMX62_addr_w, &KMX62_CNTL2[0], 2, false);
-#endif
+ #endif
-#ifdef color
- // 1. CNTL2 (0x3A), write (0x5F): 4g, Max RES, EN temp mag and accel
+ #ifdef color
+ // 1. CNTL2 (0x3A), write (0x5F): 4g, Max RES, EN temp mag and accel
i2c.write(BH1745_addr_w, &BH1745_persistence[0], 2, false);
i2c.write(BH1745_addr_w, &BH1745_mode1[0], 2, false);
i2c.write(BH1745_addr_w, &BH1745_mode2[0], 2, false);
i2c.write(BH1745_addr_w, &BH1745_mode3[0], 2, false);
-#endif
-
-#ifdef KX022
-
-i2c.write(KX022_addr_w, &KX022_Accel_CNTL1[0], 2, false);
-i2c.write(KX022_addr_w, &KX022_Accel_ODCNTL[0], 2, false);
-i2c.write(KX022_addr_w, &KX022_Accel_CNTL3[0], 2, false);
-i2c.write(KX022_addr_w, &KX022_Accel_TILT_TIMER[0], 2, false);
-i2c.write(KX022_addr_w, &KX022_Accel_CNTL2[0], 2, false);
+ #endif
-#endif
-
-#ifdef Pressure
+ #ifdef KX022
+ i2c.write(KX022_addr_w, &KX022_Accel_CNTL1[0], 2, false);
+ i2c.write(KX022_addr_w, &KX022_Accel_ODCNTL[0], 2, false);
+ i2c.write(KX022_addr_w, &KX022_Accel_CNTL3[0], 2, false);
+ i2c.write(KX022_addr_w, &KX022_Accel_TILT_TIMER[0], 2, false);
+ i2c.write(KX022_addr_w, &KX022_Accel_CNTL2[0], 2, false);
+ #endif
+
+ #ifdef Pressure
+ i2c.write(Press_addr_w, &PWR_DOWN[0], 2, false);
+ i2c.write(Press_addr_w, &SLEEP[0], 2, false);
+ i2c.write(Press_addr_w, &Mode_Control[0], 2, false);
+ #endif
-i2c.write(Press_addr_w, &PWR_DOWN[0], 2, false);
-i2c.write(Press_addr_w, &SLEEP[0], 2, false);
-i2c.write(Press_addr_w, &Mode_Control[0], 2, false);
-
-#endif
-
-//Start BTLE Initialization Section
+ //Start BTLE Initialization Section
m_ble.init();
m_ble.onDisconnection(disconnectionCallback);
m_ble.onDataWritten(dataWrittenCallback);