adding abstract class BLEAdafruitSensor

Author: hathach

libraries/Bluefruit52Lib/src/BLECharacteristic.cpp

@@ -545,6 +545,11 @@ uint16_t BLECharacteristic::write32(int num)
   return write32( (uint32_t) num );
 }
 
+uint16_t BLECharacteristic::write32(int32_t num)
+{
+  return write32( (uint32_t) num );
+}
+
 /*------------------------------------------------------------------*/
 /* READ
  *------------------------------------------------------------------*/

libraries/Bluefruit52Lib/src/BLECharacteristic.h

@@ -125,6 +125,7 @@ class BLECharacteristic
     uint16_t write16 (uint16_t num);
     uint16_t write32 (uint32_t num);
     uint16_t write32 (int      num);
+    uint16_t write32 (int32_t  num);
 
     /*------------- Read -------------*/
     uint16_t read  (void* buffer, uint16_t bufsize, uint16_t offset = 0);

libraries/Bluefruit52Lib/src/services/BLEAdafruitSensor.cpp

@@ -0,0 +1,88 @@
+/* 
+ * The MIT License (MIT)
+ *
+ * Copyright (c) 2019 Ha Thach (tinyusb.org) for Adafruit Industries
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+
+#include "bluefruit.h"
+#include "BLEAdafruitSensor.h"
+
+//--------------------------------------------------------------------+
+// MACRO TYPEDEF CONSTANT ENUM DECLARATION
+//--------------------------------------------------------------------+
+
+BLEAdafruitSensor::BLEAdafruitSensor(void) :
+  Period(UUID128_CHR_ADAFRUIT_MEASUREMENT_PERIOD)
+{
+  _measure_cb = NULL;
+}
+
+void BLEAdafruitSensor::setMeasureCallback(measure_callback_t fp)
+{
+  _measure_cb = fp;
+}
+
+bool BLEAdafruitSensor::begin(int32_t ms)
+{
+  // Invoke base class begin()
+  VERIFY_STATUS( BLEService::begin() );
+
+  Period.setProperties(CHR_PROPS_READ | CHR_PROPS_WRITE);
+  Period.setPermission(SECMODE_OPEN, SECMODE_OPEN);
+  Period.setFixedLen(4);
+  VERIFY_STATUS( Period.begin() );
+  Period.write32(ms);
+
+  Period.setWriteCallback(sensor_period_write_cb, true);
+
+  // setup timer
+  _timer.begin(ms, sensor_timer_cb, this, true);
+
+  return true;
+}
+
+
+void BLEAdafruitSensor::sensor_timer_cb(TimerHandle_t xTimer)
+{
+  BLEAdafruitSensor* svc = (BLEAdafruitSensor*) pvTimerGetTimerID(xTimer);
+
+  // invoke measure callback
+  if (svc->_measure_cb) svc->_measure_cb();
+}
+
+// Client update period, adjust timer accordingly
+void BLEAdafruitSensor::sensor_period_write_cb(uint16_t conn_hdl, BLECharacteristic* chr, uint8_t* data, uint16_t len)
+{
+  BLEAdafruitSensor& svc = (BLEAdafruitSensor&) chr->parentService();
+
+  int32_t ms = 0;
+  memcpy(&ms, data, len);
+
+  // TODO handle period = 0 which notify on changes ASAP
+  if ( ms < 0 )
+  {
+    svc._timer.stop();
+  }else
+  {
+    svc._timer.setPeriod(ms);
+  }
+}
+

libraries/Bluefruit52Lib/src/services/BLEAdafruitSensor.h

@@ -0,0 +1,53 @@
+/* 
+ * The MIT License (MIT)
+ *
+ * Copyright (c) 2019 Ha Thach (tinyusb.org) for Adafruit Industries
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+
+#ifndef BLE_ADAFRUIT_SENSOR_H_
+#define BLE_ADAFRUIT_SENSOR_H_
+
+#include "bluefruit_common.h"
+
+#include "BLECharacteristic.h"
+#include "BLEService.h"
+
+class BLEAdafruitSensor : public BLEService
+{
+  public:
+    typedef void (*measure_callback_t )(void);
+
+    BLEAdafruitSensor(void);
+    virtual bool begin(int32_t ms);
+
+    void setMeasureCallback(measure_callback_t fp);
+
+  protected:
+    measure_callback_t _measure_cb;
+    SoftwareTimer _timer;
+
+    BLECharacteristic Period;
+
+    static void sensor_timer_cb(TimerHandle_t xTimer);
+    static void sensor_period_write_cb(uint16_t conn_hdl, BLECharacteristic* chr, uint8_t* data, uint16_t len);
+};
+
+#endif /* BLE_ADAFRUIT_SENSOR_H_ */