Diff: main.cpp

Revision:

6:68a02e91836e

Parent:

5:4bc41267a03a

Child:

7:9a474d182e4b

--- a/main.cpp	Tue Sep 02 16:32:58 2014 +0000
+++ b/main.cpp	Thu Sep 04 21:19:18 2014 +0000
@@ -16,43 +16,44 @@
 
 #include "mbed.h"
 #include "BLEDevice.h"
-
-#define BLE_UUID_NUS_SERVICE            0x0001 /**< The UUID of the Nordic UART Service. */
-#define BLE_UUID_NUS_TX_CHARACTERISTIC  0x0002 /**< The UUID of the TX Characteristic. */
-#define BLE_UUID_NUS_RX_CHARACTERISTIC  0x0003 /**< The UUID of the RX Characteristic. */
+#include "TCS3472_I2C.h"
 
-#define NEED_CONSOLE_OUTPUT 1 /* Set this if you need debug messages on the console;
-                               * it will have an impact on code-size and power consumption. */
-
-#if NEED_CONSOLE_OUTPUT
-Serial  pc(USBTX, USBRX);
-#define DEBUG(...) { pc.printf(__VA_ARGS__); }
-#else
-#define DEBUG(...) /* nothing */
-#endif /* #if NEED_CONSOLE_OUTPUT */
+I2C i2c(p7, p6);
+TCS3472_I2C rgb_sensor( &i2c );
 
 BLEDevice  ble;
-DigitalOut led1(LED1);
+DigitalOut led1(p27);
+PwmOut     led2(p28);
+DigitalOut LDOOn(p5);
+DigitalOut SoundOn(p2);
+AnalogIn   SoundIn(p1);
+
+static volatile bool  triggerSensorPolling = false;
 
 // The Nordic UART Service
-static const uint8_t uart_base_uuid[] = {0x6e, 0x40, 0x00, 0x01, 0xb5, 0xa3, 0xf3, 0x93, 0xe0, 0xa9, 0xe5,0x0e, 0x24, 0xdc, 0xca, 0x9e};
+static const uint8_t uart_service_uuid[] = {0x6e, 0x40, 0x00, 0x01, 0xb5, 0xa3, 0xf3, 0x93, 0xe0, 0xa9, 0xe5,0x0e, 0x24, 0xdc, 0xca, 0x9e};
 static const uint8_t uart_tx_uuid[]   = {0x6e, 0x40, 0x00, 0x02, 0xb5, 0xa3, 0xf3, 0x93, 0xe0, 0xa9, 0xe5,0x0e, 0x24, 0xdc, 0xca, 0x9e};
 static const uint8_t uart_rx_uuid[]   = {0x6e, 0x40, 0x00, 0x03, 0xb5, 0xa3, 0xf3, 0x93, 0xe0, 0xa9, 0xe5,0x0e, 0x24, 0xdc, 0xca, 0x9e};
-static const uint8_t uart_base_uuid_rev[] = {0x9e, 0xca, 0xdc, 0x24, 0x0e, 0xe5, 0xa9, 0xe0, 0x93, 0xf3, 0xa3, 0xb5, 0x01, 0x00, 0x40, 0x6e};
+static const uint8_t uart_service_uuid_rev[] = {0x9e, 0xca, 0xdc, 0x24, 0x0e, 0xe5, 0xa9, 0xe0, 0x93, 0xf3, 0xa3, 0xb5, 0x01, 0x00, 0x40, 0x6e};
+static const uint16_t uuid16_list[]        = {GattService::UUID_DEVICE_INFORMATION_SERVICE};
 
 static const uint8_t SIZEOF_TX_RX_BUFFER = 128;
 uint8_t rxPayload[SIZEOF_TX_RX_BUFFER] = {0,};
 uint8_t txPayload[SIZEOF_TX_RX_BUFFER] = {0,};
+
+uint8_t hardwareRevision[] = "0.1";
 GattCharacteristic  rxCharacteristic (uart_tx_uuid, rxPayload, 1, SIZEOF_TX_RX_BUFFER,
                                       GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE);
 GattCharacteristic  txCharacteristic (uart_rx_uuid, txPayload, 1, SIZEOF_TX_RX_BUFFER, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
 GattCharacteristic *uartChars[] = {&rxCharacteristic, &txCharacteristic};
-GattService         uartService(uart_base_uuid, uartChars, sizeof(uartChars) / sizeof(GattCharacteristic *));
+GattService         uartService(uart_service_uuid, uartChars, sizeof(uartChars) / sizeof(GattCharacteristic *));
+
+GattCharacteristic  hardwareRevCharacteristic(GattCharacteristic::UUID_HARDWARE_REVISION_STRING_CHAR, hardwareRevision, sizeof(hardwareRevision), sizeof(hardwareRevision), GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ); 
+GattCharacteristic  *deviceInfoChars[] = {&hardwareRevCharacteristic};
+GattService         deviceInfoService(GattService::UUID_DEVICE_INFORMATION_SERVICE, deviceInfoChars, sizeof(deviceInfoChars) / sizeof(GattCharacteristic *));
 
 void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
 {
-    DEBUG("Disconnected!\n\r");
-    DEBUG("Restarting the advertising process\n\r");
     ble.startAdvertising();
 }
 
@@ -60,29 +61,34 @@
 {
     if (charHandle == rxCharacteristic.getValueAttribute().getHandle()) {
         uint16_t bytesRead = params->len;
-        DEBUG("received %u bytes\n\r", bytesRead);
         if (bytesRead < sizeof(rxPayload)) {
             memcpy(rxPayload, params->data, bytesRead);
             rxPayload[bytesRead] = 0;
         }
-        DEBUG("ECHO: %s\n\r", (char *)rxPayload);
         ble.updateCharacteristicValue(txCharacteristic.getValueAttribute().getHandle(), rxPayload, bytesRead);
     }
 }
 
 void periodicCallback(void)
 {
-    led1 = !led1; /* Do blinky on LED1 while we're waiting for BLE events */
+    triggerSensorPolling = true;
 }
 
 int main(void)
 {
     led1 = 1;
+    led2 = 1.0;
+    LDOOn = 1;
+    SoundOn = 1;
     Ticker ticker;
-    ticker.attach(periodicCallback, 1);
+    i2c.frequency(400000);
+    ticker.attach(periodicCallback, 4);
 
-    DEBUG("Initialising the nRF51822\n\r");
     ble.init();
+    rgb_sensor.enablePowerAndRGBC();
+    rgb_sensor.setIntegrationTime( 100 );
+    rgb_sensor.setWaitTime(900);
+    //rgb_sensor.enableWait();
     ble.onDisconnection(disconnectionCallback);
     ble.onDataWritten(onDataWritten);
 
@@ -92,14 +98,63 @@
     ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,
                                     (const uint8_t *)"BLE UART", sizeof("BLE UART") - 1);
     ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS,
-                                    (const uint8_t *)uart_base_uuid_rev, sizeof(uart_base_uuid));
+                                    (const uint8_t *)uart_service_uuid_rev, sizeof(uart_service_uuid_rev));
+    ble.accumulateScanResponse(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
+    //ble.accumulateAdvertisingPayload(GapAdvertisingData::HEART_RATE_SENSOR_HEART_RATE_BELT);
 
     ble.setAdvertisingInterval(160); /* 100ms; in multiples of 0.625ms. */
+    ble.addService(uartService);
+    ble.addService(deviceInfoService);
     ble.startAdvertising();
 
-    ble.addService(uartService);
 
     while (true) {
-        ble.waitForEvent();
+        if (triggerSensorPolling) {
+            triggerSensorPolling = false;
+            //led1 = !led1; /* Do blinky on LED1 while we're waiting for BLE events */
+            char reading[20];
+            int rgb_readings[4];
+            int len;
+            rgb_sensor.getAllColors( rgb_readings );
+            rgb_sensor.clearInterrupt();
+            char whoami;
+            float max = 0.0;
+            float min = 1.0;
+            float current = 0.0;
+            for (int i = 0; i < 20; i++) {
+                current = SoundIn;
+                if (current > max) max = current;
+                if (current < min) min = current;
+            }
+            len = sprintf((char *)reading, "%d,%d,%d,%d", rgb_readings[0], rgb_readings[1], rgb_readings[2], rgb_readings[3]);
+            ble.updateCharacteristicValue(txCharacteristic.getValueAttribute().getHandle(),(uint8_t *) reading, len);
+            len = sprintf((char *)reading, "%1.4f", (max - min) * 10.0);
+            ble.updateCharacteristicValue(txCharacteristic.getValueAttribute().getHandle(),(uint8_t *) reading, len);
+            whoami = readByte(MPU9250_ADDRESS, WHO_AM_I_MPU9250);
+            len = sprintf((char *)reading, "%d", whoami);
+            ble.updateCharacteristicValue(txCharacteristic.getValueAttribute().getHandle(),(uint8_t *) reading, len);
+
+        } else {
+            //ble.waitForEvent();
+            float max = 0.0;
+            float min = 1.0;
+            float current = 0.0;
+            for (int i = 0; i < 100; i++) {
+                current = SoundIn;
+                if (current > max) max = current;
+                if (current < min) min = current;
+            }
+            if ((max - min) > 0.005) {
+                led2 = 1.0 - (max - min)*5.0;
+                if ((max - min) > 0.06) {
+                    led1 = 0;
+                } else {
+                    led1 = 1;
+                }
+            } else {
+                led2 = 1.0;
+                led1 = 1;
+            }
+        }
     }
 }