From 7c9f266cdb37e215279208198dfe009dc66c5daa Mon Sep 17 00:00:00 2001 From: Trygve Laugstøl Date: Sat, 21 Feb 2015 10:28:00 +0100 Subject: o Creating a class to access GATT. --- ble/Bluetooth.cpp | 10 ++++++ ble/Bluetooth.h | 39 ++++++++++++++------ ble/BluetoothImpl.h | 57 ++++++++++++++++++++++++++---- ble/LinuxBluetooth.cpp | 96 +++++++++++++++++++++++++++++++++----------------- 4 files changed, 152 insertions(+), 50 deletions(-) (limited to 'ble') diff --git a/ble/Bluetooth.cpp b/ble/Bluetooth.cpp index 4ceb3b6..31f82e3 100644 --- a/ble/Bluetooth.cpp +++ b/ble/Bluetooth.cpp @@ -145,6 +145,16 @@ AttributeData::AttributeData(uint16_t handle, ByteBuffer value) : AttributeData::~AttributeData() { } +// ----------------------------------------------------------------------- +// Gatt +// ----------------------------------------------------------------------- + +BluetoothGatt::BluetoothGatt() { +} + +BluetoothGatt::~BluetoothGatt() { +} + // ----------------------------------------------------------------------- // Device // ----------------------------------------------------------------------- diff --git a/ble/Bluetooth.h b/ble/Bluetooth.h index e7b163b..1dd5022 100644 --- a/ble/Bluetooth.h +++ b/ble/Bluetooth.h @@ -15,7 +15,9 @@ using namespace std; struct SpecUuid { public: - SpecUuid(uint16_t value) : value(value) {} + SpecUuid(uint16_t value) : value(value) { + } + uint16_t value; }; @@ -109,18 +111,18 @@ public: virtual const vector getCharacteristics() const = 0; - virtual void addCharacteristic(BluetoothGattCharacteristic* characteristic) = 0; + virtual void addCharacteristic(BluetoothGattCharacteristic *characteristic) = 0; + + virtual const boost::optional findCharacteristic(boost::uuids::uuid uuid) const = 0; }; -class BluetoothDevice { +class BluetoothGatt { public: - BluetoothDevice(); + BluetoothGatt(); - virtual ~BluetoothDevice(); - - virtual Mac const &mac() = 0; + virtual ~BluetoothGatt(); - virtual BluetoothAdapter &adapter() = 0; +// virtual BluetoothDevice &getDevice() = 0; virtual void connect() = 0; @@ -130,7 +132,20 @@ public: virtual const vector getServices() const = 0; - virtual const boost::optional findService(boost::uuids::uuid uuid) const = 0; + virtual const boost::optional findService(boost::uuids::uuid uuid) const = 0; +}; + +class BluetoothDevice { +public: + BluetoothDevice(); + + virtual ~BluetoothDevice(); + + virtual Mac const &getMac() = 0; + + virtual BluetoothAdapter &getAdapter() = 0; + + virtual BluetoothGatt &connectGatt() = 0; }; class BluetoothAdapter { @@ -150,11 +165,12 @@ protected: }; /** - * RAII support. - */ +* RAII support. +*/ class BluetoothSystem { public: BluetoothSystem(); + ~BluetoothSystem(); }; @@ -187,6 +203,7 @@ public: private: static void checkType(ByteBuffer &bytes, AttPduType type); + static vector parse(ByteBuffer &bytes, AttPduType type); ByteBuffer &bytes; diff --git a/ble/BluetoothImpl.h b/ble/BluetoothImpl.h index 69fac6e..7801771 100644 --- a/ble/BluetoothImpl.h +++ b/ble/BluetoothImpl.h @@ -18,7 +18,7 @@ namespace trygvis { namespace bluetooth { typedef boost::uuids::uuid uuid_t; -template +template using o = boost::optional; class DefaultBluetoothGattCharacteristic : public BluetoothGattCharacteristic { @@ -94,6 +94,16 @@ public: characteristics.push_back(characteristic); } + virtual const o findCharacteristic(uuid_t uuid) const { + for (auto c: characteristics) { + if (memcmp(c->getUuid().data, uuid.data, 16) == 0) { + return o(c); + } + } + + return o(); + } + protected: BluetoothDevice &device; const uuid_t uuid; @@ -110,20 +120,55 @@ protected: } }; +template class DefaultBluetoothDevice : public BluetoothDevice { +public: + + virtual Mac const &getMac() override { + return mac; + } + + virtual A &getAdapter() override { + return adapter; + } + +protected: + DefaultBluetoothDevice(A adapter, Mac &mac) : + adapter(adapter), mac(mac) { + DF; + } + + virtual ~DefaultBluetoothDevice() { + DF; + removeServices(); + } + + void removeServices() { + for (auto s: services) { + delete s; + } + services.clear(); + } + + A adapter; + Mac &mac; + vector services; +}; + +class DefaultBluetoothGatt : public BluetoothGatt { public: virtual const vector getServices() const { return services; }; - virtual const o findService(boost::uuids::uuid uuid) const { + virtual const o findService(uuid_t uuid) const { for (auto s: services) { if (memcmp(s->getUuid().data, uuid.data, 16) == 0) { - return o(s); + return o(s); } } - return o(); + return o(); } virtual void addService(BluetoothGattService *service) { @@ -131,11 +176,11 @@ public: } protected: - DefaultBluetoothDevice() { + DefaultBluetoothGatt() { DF; } - virtual ~DefaultBluetoothDevice() { + virtual ~DefaultBluetoothGatt() { DF; removeServices(); } diff --git a/ble/LinuxBluetooth.cpp b/ble/LinuxBluetooth.cpp index b687807..a5d092b 100644 --- a/ble/LinuxBluetooth.cpp +++ b/ble/LinuxBluetooth.cpp @@ -21,6 +21,8 @@ namespace linux { using namespace uuids; +class LinuxBluetoothGatt; + class LinuxBluetoothDevice; class LinuxBluetoothAdapter; @@ -50,13 +52,24 @@ private: map devices; }; -class LinuxBluetoothDevice : public DefaultBluetoothDevice { +class LinuxBluetoothDevice : public DefaultBluetoothDevice { public: - LinuxBluetoothDevice(LinuxBluetoothAdapter &adapter, Mac mac); + LinuxBluetoothDevice(LinuxBluetoothAdapter &adapter, Mac &mac); + ~LinuxBluetoothDevice(); + + BluetoothGatt &connectGatt() override; + +private: + LinuxBluetoothGatt* gatt; + int l2cap; +}; - Mac const &mac() override; +class LinuxBluetoothGatt : public DefaultBluetoothGatt { +public: + LinuxBluetoothGatt(LinuxBluetoothDevice &device, int l2cap); + ~LinuxBluetoothGatt(); - LinuxBluetoothAdapter &adapter() override; +// LinuxBluetoothDevice &getDevice() override; void connect() override; @@ -71,10 +84,7 @@ private: ByteBuffer writeAndRead(ByteBuffer &out, shared_ptr buffer, size_t size); - uuid_t readUuid(const ByteBuffer &bytes) const; - - LinuxBluetoothAdapter &_adapter; - Mac _mac; + LinuxBluetoothDevice &device; int l2cap; }; @@ -96,26 +106,45 @@ Mac parseMac(bdaddr_t &a) { // Device // ----------------------------------------------------------------------- -LinuxBluetoothDevice::LinuxBluetoothDevice(LinuxBluetoothAdapter &adapter, Mac mac) : - DefaultBluetoothDevice(), _adapter(adapter), _mac(mac) { +LinuxBluetoothDevice::LinuxBluetoothDevice(LinuxBluetoothAdapter &adapter, Mac &mac) : + DefaultBluetoothDevice(adapter, mac), gatt(nullptr) { } -Mac const &LinuxBluetoothDevice::mac() { - return _mac; +LinuxBluetoothDevice::~LinuxBluetoothDevice() { + if (gatt) { + delete gatt; + } +}; + +BluetoothGatt &LinuxBluetoothDevice::connectGatt() { + if (!gatt) { + gatt = new LinuxBluetoothGatt(*this, l2cap); + } + + gatt->connect(); + + return *gatt; +} + +// ----------------------------------------------------------------------- +// Gatt +// ----------------------------------------------------------------------- + +LinuxBluetoothGatt::LinuxBluetoothGatt(LinuxBluetoothDevice &device, int l2cap) : + device(device), l2cap(l2cap) { } -LinuxBluetoothAdapter &LinuxBluetoothDevice::adapter() { - return _adapter; +LinuxBluetoothGatt::~LinuxBluetoothGatt() { } -void LinuxBluetoothDevice::connect() { +void LinuxBluetoothGatt::connect() { struct sockaddr_l2 addr; - D << "connect: mac=" << _mac.str(); + D << "connect: mac=" << device.getMac().str(); l2cap = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP); if (l2cap < 0) { - throw BluetoothException(this, "LinuxBluetoothDevice::connect(): socket(): " + errnoAsString()); + throw BluetoothException(&device, "LinuxBluetoothDevice::connect(): socket(): " + errnoAsString()); } memset(&addr, 0, sizeof(addr)); @@ -126,7 +155,7 @@ void LinuxBluetoothDevice::connect() { if (bind(l2cap, (struct sockaddr *) &addr, sizeof(addr)) < 0) { close(l2cap); - throw BluetoothException(this, "LinuxBluetoothDevice::connect(): bind(): " + errnoAsString()); + throw BluetoothException(&device, "LinuxBluetoothDevice::connect(): bind(): " + errnoAsString()); } struct bt_security btsec; @@ -134,14 +163,15 @@ void LinuxBluetoothDevice::connect() { btsec.level = BT_SECURITY_LOW; if (setsockopt(l2cap, SOL_BLUETOOTH, BT_SECURITY, &btsec, sizeof(btsec)) != 0) { close(l2cap); - throw BluetoothException(this, "LinuxBluetoothDevice::connect(): setsockopt(): " + errnoAsString()); + throw BluetoothException(&device, "LinuxBluetoothDevice::connect(): setsockopt(): " + errnoAsString()); } memset(&addr, 0, sizeof(addr)); addr.l2_family = AF_BLUETOOTH; addr.l2_cid = htobs(ATT_CID); addr.l2_bdaddr_type = BDADDR_LE_RANDOM; - _mac.copy(addr.l2_bdaddr.b[5], + device.getMac().copy( + addr.l2_bdaddr.b[5], addr.l2_bdaddr.b[4], addr.l2_bdaddr.b[3], addr.l2_bdaddr.b[2], @@ -150,16 +180,16 @@ void LinuxBluetoothDevice::connect() { if (::connect(l2cap, (struct sockaddr *) &addr, sizeof(addr)) < 0) { close(l2cap); - throw BluetoothException(this, "LinuxBluetoothDevice::connect(): connect(): " + errnoAsString()); + throw BluetoothException(&device, "LinuxBluetoothDevice::connect(): connect(): " + errnoAsString()); } } -void LinuxBluetoothDevice::disconnect() { - DF << "mac = " << _mac.str(); +void LinuxBluetoothGatt::disconnect() { + DF << "mac = " << device.getMac().str(); close(l2cap); } -uuid_t LinuxBluetoothDevice::readUuid(const ByteBuffer &bytes) const { +uuid_t readUuid(BluetoothDevice *device, const ByteBuffer &bytes) { size_t bytesLeft = bytes.getBytesLeft(); uuid_t u; @@ -189,13 +219,13 @@ uuid_t LinuxBluetoothDevice::readUuid(const ByteBuffer &bytes) const { bs[0] = bytes.get8(15); memcpy(&u, bs, 16); } else { - throw BluetoothException(this, "Unexpected bytes left: " + to_string(bytesLeft)); + throw BluetoothException(device, "Unexpected bytes left: " + to_string(bytesLeft)); } return u; } -void LinuxBluetoothDevice::discoverServices() { +void LinuxBluetoothGatt::discoverServices() { uint16_t startHandle = 0x0001; removeServices(); @@ -217,9 +247,9 @@ void LinuxBluetoothDevice::discoverServices() { // ", endGroupHandle: 0x" << hex << setw(4) << setfill('0') << endGroupHandle << // ", value: " << data.value.toString(); - uuid_t u = readUuid(data.value); + uuid_t u = readUuid(&device, data.value); - addService(new DefaultBluetoothGattService(*this, u, data.handle, endGroupHandle)); + addService(new DefaultBluetoothGattService(device, u, data.handle, endGroupHandle)); } auto last = values.back(); @@ -263,7 +293,7 @@ void LinuxBluetoothDevice::discoverServices() { uint8_t properties = c.value.read8(); uint16_t valueHandle = c.value.read16le(); - uuid_t uuid = readUuid(c.value); + uuid_t uuid = readUuid(&device, c.value); // D << "characteristic: handle: " << setw(2) << setfill('0') << hex << (int) c.handle << // ", properties: " << setw(2) << setfill('0') << hex << (int) properties << @@ -279,7 +309,7 @@ void LinuxBluetoothDevice::discoverServices() { } while (startHandle != 0xffff); } -ByteBuffer LinuxBluetoothDevice::writeAndRead(ByteBuffer &out, shared_ptr buffer, size_t size) { +ByteBuffer LinuxBluetoothGatt::writeAndRead(ByteBuffer &out, shared_ptr buffer, size_t size) { D << "pdu size=" << out.getCursor(); ssize_t written = write(l2cap, buffer.get(), out.getCursor()); @@ -288,7 +318,7 @@ ByteBuffer LinuxBluetoothDevice::writeAndRead(ByteBuffer &out, shared_ptr LinuxBluetoothDevice::discoverServices(uint16_t startHandle) { +vector LinuxBluetoothGatt::discoverServices(uint16_t startHandle) { DF; shared_ptr buffer(new uint8_t[MAX_MTU]); @@ -315,7 +345,7 @@ vector LinuxBluetoothDevice::discoverServices(uint16_t startHandl return values; } -vector LinuxBluetoothDevice::discoverCharacteristics(uint16_t startHandle, uint16_t endHandle) { +vector LinuxBluetoothGatt::discoverCharacteristics(uint16_t startHandle, uint16_t endHandle) { DF; shared_ptr buffer(new uint8_t[MAX_MTU]); -- cgit v1.2.3