mirror of
https://gitlab.com/eql/lqml.git
synced 2025-12-06 02:30:38 -08:00
157 lines
5.1 KiB
C++
157 lines
5.1 KiB
C++
#include "ble_meshtastic.h"
|
|
#include <QMetaEnum>
|
|
#include <QTimer>
|
|
|
|
#ifdef PLUGIN
|
|
#include <ecl_fun_plugin.h>
|
|
#else
|
|
#include <ecl_fun.h>
|
|
#endif
|
|
|
|
// service
|
|
const UID BLE_ME::uuid_service = UID(STR("{6ba1b218-15a8-461f-9fa8-5dcae273eafd}"));
|
|
|
|
// characteristics
|
|
const UID BLE_ME::uuid_toRadio = UID(STR("{f75c76d2-129e-4dad-a1dd-7866124401e7}"));
|
|
const UID BLE_ME::uuid_fromRadio = UID(STR("{2c55e69e-4993-11ed-b878-0242ac120002}"));
|
|
const UID BLE_ME::uuid_fromNum = UID(STR("{ed9da18c-a800-4f66-a670-aa7547e34453}"));
|
|
|
|
BLE_ME::BLE_ME() : BLE(uuid_service) {
|
|
connect(this, &BLE::mainServiceReady, this, &BLE_ME::ini);
|
|
connect(this, &BLE::deviceDisconnecting, this, &BLE_ME::disconnecting);
|
|
|
|
#ifdef PLUGIN
|
|
ini_lisp();
|
|
#endif
|
|
}
|
|
|
|
bool BLE_ME::deviceFilter(const QBluetoothDeviceInfo& info) {
|
|
return info.name().contains("meshtastic", Qt::CaseInsensitive) &&
|
|
(info.coreConfigurations() & QBluetoothDeviceInfo::LowEnergyCoreConfiguration);
|
|
}
|
|
|
|
void BLE_ME::ini() {
|
|
connect(mainService, &QLowEnergyService::stateChanged,
|
|
this, &BLE_ME::serviceStateChanged);
|
|
connect(mainService, &QLowEnergyService::characteristicChanged,
|
|
this, &BLE_ME::characteristicChanged);
|
|
connect(mainService, &QLowEnergyService::characteristicRead,
|
|
this, &BLE_ME::characteristicRead);
|
|
connect(mainService, &QLowEnergyService::characteristicWritten,
|
|
this, &BLE_ME::characteristicWritten);
|
|
connect(mainService, QOverload<QLowEnergyService::ServiceError>::of(&QLowEnergyService::error),
|
|
this, &BLE_ME::serviceError);
|
|
|
|
connect(mainService, &QLowEnergyService::descriptorWritten,
|
|
[](const QLowEnergyDescriptor&, const QByteArray& value) {
|
|
qDebug() << "notifications changed:" << value;
|
|
});
|
|
|
|
if (mainService->state() == QLowEnergyService::DiscoveryRequired) {
|
|
qDebug() << "discovering details...";
|
|
mainService->discoverDetails();
|
|
} else {
|
|
searchCharacteristics();
|
|
}
|
|
}
|
|
|
|
void BLE_ME::serviceStateChanged(QLowEnergyService::ServiceState state) {
|
|
qDebug() << "service state changed:" << state;
|
|
if (state == QLowEnergyService::ServiceDiscovered) {
|
|
searchCharacteristics();
|
|
}
|
|
}
|
|
|
|
void BLE_ME::searchCharacteristics() {
|
|
qDebug() << "searching characteristics...";
|
|
const auto characteristics = mainService->characteristics();
|
|
for (auto ch : characteristics) {
|
|
if (ch.isValid()) {
|
|
if ((ch.properties() & QLowEnergyCharacteristic::Write) &&
|
|
(ch.uuid() == uuid_toRadio)) { // toRadio
|
|
toRadio = ch;
|
|
qDebug() << "...found 'toRadio'";
|
|
}
|
|
if (ch.properties() & QLowEnergyCharacteristic::Read) {
|
|
if (ch.uuid() == uuid_fromRadio) { // fromRadio
|
|
fromRadio = ch;
|
|
qDebug() << "...found 'fromRadio'";
|
|
} else if (ch.uuid() == uuid_fromNum) {
|
|
fromNum = ch;
|
|
qDebug() << "...found 'fromNum'"; // fromNum
|
|
|
|
// enable notifications
|
|
notifications = ch.descriptor(QBluetoothUuid::ClientCharacteristicConfiguration);
|
|
if (notifications.isValid()) {
|
|
qDebug() << "enabling notifications...";
|
|
mainService->writeDescriptor(notifications, QByteArray::fromHex("0100"));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (toRadio.isValid() && fromRadio.isValid() && fromNum.isValid()) {
|
|
ecl_fun("lora:set-ready", currentDevice.name().right(4));
|
|
}
|
|
}
|
|
|
|
void BLE_ME::characteristicChanged(const QLowEnergyCharacteristic&,
|
|
const QByteArray& data) {
|
|
if (!data.isEmpty()) {
|
|
ecl_fun("lora:received-from-radio", data, "notified");
|
|
}
|
|
}
|
|
|
|
void BLE_ME::characteristicRead(const QLowEnergyCharacteristic&,
|
|
const QByteArray& data) {
|
|
if (data.isEmpty()) {
|
|
ecl_fun("lora:receiving-done");
|
|
} else {
|
|
ecl_fun("lora:received-from-radio", data);
|
|
QTimer::singleShot(0, this, &BLE_ME::read);
|
|
}
|
|
}
|
|
|
|
void BLE_ME::characteristicWritten(const QLowEnergyCharacteristic&,
|
|
const QByteArray&) {
|
|
QTimer::singleShot(0, this, &BLE_ME::read);
|
|
}
|
|
|
|
void BLE_ME::serviceError(QLowEnergyService::ServiceError error) {
|
|
static QMetaEnum qme = mainService->metaObject()->enumerator(
|
|
mainService->metaObject()->indexOfEnumerator("ServiceError"));
|
|
qDebug() << "service error:" << QLatin1String(qme.valueToKey(error));
|
|
}
|
|
|
|
// read/write
|
|
|
|
void BLE_ME::read() {
|
|
if ((mainService != nullptr) && fromRadio.isValid()) {
|
|
// will call 'characteristicRead()' on success
|
|
mainService->readCharacteristic(fromRadio);
|
|
} else {
|
|
qDebug() << "not ready to read";
|
|
}
|
|
}
|
|
|
|
void BLE_ME::write(const QByteArray& data) {
|
|
if ((mainService != nullptr) && toRadio.isValid()) {
|
|
// will call 'characteristicWritten()' on success
|
|
mainService->writeCharacteristic(toRadio, data);
|
|
} else {
|
|
qDebug() << "not ready to write";
|
|
}
|
|
}
|
|
|
|
// on device disconnect
|
|
|
|
void BLE_ME::disconnecting() {
|
|
if ((mainService != nullptr) && notifications.isValid()) {
|
|
// disable notifications
|
|
mainService->writeDescriptor(notifications, QByteArray::fromHex("0000"));
|
|
}
|
|
ecl_fun("lora:set-ready", "-", false);
|
|
delete mainService; mainService = nullptr;
|
|
}
|
|
|