Initial commit (project based on widgets)
This commit is contained in:
Yury Shuvakin
301
bleuart.cpp
Normal file
301
bleuart.cpp
Normal file
@@ -0,0 +1,301 @@
|
||||
/*
|
||||
Original copyright 2018 Benjamin Vedder benjamin@vedder.se and the VESC Tool project ( https://github.com/vedderb/vesc_tool )
|
||||
|
||||
Forked to:
|
||||
Copyright 2018 Danny Bokma github@diebie.nl (https://github.com/DieBieEngineering/DieBieMS-Tool)
|
||||
|
||||
Now forked to:
|
||||
Copyright 2019 - 2020 Kevin Dionne kevin.dionne@ennoid.me (https://github.com/EnnoidMe/ENNOID-BMS-Tool)
|
||||
|
||||
This file is part of ENNOID-BMS Tool.
|
||||
|
||||
ENNOID-BMS Tool is free software: you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation, either version 3 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
ENNOID-BMS Tool is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include "bleuart.h"
|
||||
#include "utility.h"
|
||||
|
||||
#include <QDebug>
|
||||
#include <QLowEnergyConnectionParameters>
|
||||
|
||||
BleUart::BleUart(QObject *parent) : QObject(parent)
|
||||
{
|
||||
mControl = 0;
|
||||
mService = 0;
|
||||
mUartServiceFound = false;
|
||||
mConnectDone = false;
|
||||
|
||||
mServiceUuid = "6e400001-b5a3-f393-e0a9-e50e24dcca9e";
|
||||
mRxUuid = "6e400002-b5a3-f393-e0a9-e50e24dcca9e";
|
||||
mTxUuid = "6e400003-b5a3-f393-e0a9-e50e24dcca9e";
|
||||
|
||||
mDeviceDiscoveryAgent = new QBluetoothDeviceDiscoveryAgent(this);
|
||||
|
||||
connect(mDeviceDiscoveryAgent, SIGNAL(deviceDiscovered(const QBluetoothDeviceInfo&)),
|
||||
this, SLOT(addDevice(const QBluetoothDeviceInfo&)));
|
||||
connect(mDeviceDiscoveryAgent, SIGNAL(error(QBluetoothDeviceDiscoveryAgent::Error)),
|
||||
this, SLOT(deviceScanError(QBluetoothDeviceDiscoveryAgent::Error)));
|
||||
connect(mDeviceDiscoveryAgent, SIGNAL(finished()), this, SLOT(scanFinished()));
|
||||
}
|
||||
|
||||
void BleUart::startScan()
|
||||
{
|
||||
mDevs.clear();
|
||||
mDeviceDiscoveryAgent->start();
|
||||
}
|
||||
|
||||
void BleUart::startConnect(QString addr)
|
||||
{
|
||||
disconnectBle();
|
||||
|
||||
mUartServiceFound = false;
|
||||
mConnectDone = false;
|
||||
|
||||
#if defined(Q_OS_MACOS) || defined(Q_OS_IOS)
|
||||
// Create BT Controller from unique device UUID stored as addr. Creating
|
||||
// a controller using a devices address is not supported on macOS or iOS.
|
||||
QBluetoothDeviceInfo deviceInfo = QBluetoothDeviceInfo();
|
||||
deviceInfo.setDeviceUuid(QBluetoothUuid(addr));
|
||||
mControl = new QLowEnergyController(deviceInfo);
|
||||
|
||||
#else
|
||||
mControl = new QLowEnergyController(QBluetoothAddress(addr));
|
||||
|
||||
|
||||
|
||||
mControl->setRemoteAddressType(QLowEnergyController::RandomAddress);
|
||||
|
||||
#endif
|
||||
|
||||
connect(mControl, SIGNAL(serviceDiscovered(QBluetoothUuid)),
|
||||
this, SLOT(serviceDiscovered(QBluetoothUuid)));
|
||||
connect(mControl, SIGNAL(discoveryFinished()),
|
||||
this, SLOT(serviceScanDone()));
|
||||
connect(mControl, SIGNAL(error(QLowEnergyController::Error)),
|
||||
this, SLOT(controllerError(QLowEnergyController::Error)));
|
||||
connect(mControl, SIGNAL(connected()),
|
||||
this, SLOT(deviceConnected()));
|
||||
connect(mControl, SIGNAL(disconnected()),
|
||||
this, SLOT(deviceDisconnected()));
|
||||
connect(mControl, SIGNAL(stateChanged(QLowEnergyController::ControllerState)),
|
||||
this, SLOT(controlStateChanged(QLowEnergyController::ControllerState)));
|
||||
connect(mControl, SIGNAL(connectionUpdated(QLowEnergyConnectionParameters)),
|
||||
this, SLOT(connectionUpdated(QLowEnergyConnectionParameters)));
|
||||
|
||||
mControl->connectToDevice();
|
||||
}
|
||||
|
||||
void BleUart::disconnectBle()
|
||||
{
|
||||
if (mService) {
|
||||
delete mService;
|
||||
mService = 0;
|
||||
}
|
||||
|
||||
if (mControl) {
|
||||
mControl->disconnectFromDevice();
|
||||
delete mControl;
|
||||
mControl = 0;
|
||||
}
|
||||
}
|
||||
|
||||
bool BleUart::isConnected()
|
||||
{
|
||||
return mControl != 0 && mConnectDone;
|
||||
}
|
||||
|
||||
bool BleUart::isConnecting()
|
||||
{
|
||||
return mControl && !mConnectDone;
|
||||
}
|
||||
|
||||
void BleUart::writeData(QByteArray data)
|
||||
{
|
||||
if (isConnected()) {
|
||||
const QLowEnergyCharacteristic rxChar = mService->characteristic(QBluetoothUuid(QUuid(mRxUuid)));
|
||||
if (rxChar.isValid()) {
|
||||
while(data.size() > 20) {
|
||||
mService->writeCharacteristic(rxChar, data.mid(0, 20),
|
||||
QLowEnergyService::WriteWithoutResponse);
|
||||
data.remove(0, 20);
|
||||
}
|
||||
|
||||
mService->writeCharacteristic(rxChar, data, QLowEnergyService::WriteWithoutResponse);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void BleUart::addDevice(const QBluetoothDeviceInfo &dev)
|
||||
{
|
||||
if (dev.coreConfigurations() & QBluetoothDeviceInfo::LowEnergyCoreConfiguration) {
|
||||
qDebug() << "BLE scan found device:" << dev.name();
|
||||
|
||||
#if defined(Q_OS_MACOS) || defined(Q_OS_IOS)
|
||||
// macOS and iOS do not expose the hardware address of BLTE devices, must use
|
||||
// the OS generated UUID.
|
||||
mDevs.insert(dev.deviceUuid().toString(), dev.name());
|
||||
#else
|
||||
mDevs.insert(dev.address().toString(), dev.name());
|
||||
|
||||
#endif
|
||||
|
||||
emit scanDone(mDevs, false);
|
||||
}
|
||||
}
|
||||
|
||||
void BleUart::scanFinished()
|
||||
{
|
||||
qDebug() << "BLE scan finished";
|
||||
emit scanDone(mDevs, true);
|
||||
}
|
||||
|
||||
void BleUart::deviceScanError(QBluetoothDeviceDiscoveryAgent::Error e)
|
||||
{
|
||||
qWarning() << "BLE Scan error:" << e;
|
||||
|
||||
mDevs.clear();
|
||||
emit scanDone(mDevs, true);
|
||||
//emit bleError(tr("BLE Scan error: ") + Utility::QEnumToQString(e));
|
||||
}
|
||||
|
||||
void BleUart::serviceDiscovered(const QBluetoothUuid &gatt)
|
||||
{
|
||||
if (gatt==QBluetoothUuid(QUuid(mServiceUuid))){
|
||||
qDebug() << "BLE UART service found!";
|
||||
mUartServiceFound = true;
|
||||
}
|
||||
}
|
||||
|
||||
void BleUart::serviceScanDone()
|
||||
{
|
||||
if (mService) {
|
||||
delete mService;
|
||||
mService = 0;
|
||||
}
|
||||
|
||||
if (mUartServiceFound) {
|
||||
qDebug() << "Connecting to BLE UART service";
|
||||
mService = mControl->createServiceObject(QBluetoothUuid(QUuid(mServiceUuid)), this);
|
||||
|
||||
connect(mService, SIGNAL(stateChanged(QLowEnergyService::ServiceState)),
|
||||
this, SLOT(serviceStateChanged(QLowEnergyService::ServiceState)));
|
||||
connect(mService, SIGNAL(characteristicChanged(QLowEnergyCharacteristic,QByteArray)),
|
||||
this, SLOT(updateData(QLowEnergyCharacteristic,QByteArray)));
|
||||
connect(mService, SIGNAL(descriptorWritten(QLowEnergyDescriptor,QByteArray)),
|
||||
this, SLOT(confirmedDescriptorWrite(QLowEnergyDescriptor,QByteArray)));
|
||||
|
||||
mService->discoverDetails();
|
||||
} else {
|
||||
qWarning() << "BLE UART service not found";
|
||||
disconnectBle();
|
||||
}
|
||||
}
|
||||
|
||||
void BleUart::controllerError(QLowEnergyController::Error e)
|
||||
{
|
||||
qWarning() << "BLE error:" << e;
|
||||
//disconnectBle();
|
||||
//emit bleError(tr("BLE error: ") + Utility::QEnumToQString(e));
|
||||
}
|
||||
|
||||
void BleUart::deviceConnected()
|
||||
{
|
||||
qDebug() << "BLE device connected";
|
||||
mControl->discoverServices();
|
||||
}
|
||||
|
||||
void BleUart::deviceDisconnected()
|
||||
{
|
||||
qDebug() << "BLE service disconnected";
|
||||
disconnectBle();
|
||||
}
|
||||
|
||||
void BleUart::serviceStateChanged(QLowEnergyService::ServiceState s)
|
||||
{
|
||||
// A descriptor can only be written if the service is in the ServiceDiscovered state
|
||||
switch (s) {
|
||||
case QLowEnergyService::ServiceDiscovered: {
|
||||
//looking for the TX characteristic
|
||||
const QLowEnergyCharacteristic txChar = mService->characteristic(
|
||||
QBluetoothUuid(QUuid(mTxUuid)));
|
||||
|
||||
if (!txChar.isValid()){
|
||||
qDebug() << "BLE Tx characteristic not found";
|
||||
break;
|
||||
}
|
||||
|
||||
//looking for the RX characteristic
|
||||
const QLowEnergyCharacteristic rxChar = mService->characteristic(QBluetoothUuid(QUuid(mRxUuid)));
|
||||
|
||||
if (!rxChar.isValid()) {
|
||||
qDebug() << "BLE Rx characteristic not found";
|
||||
break;
|
||||
}
|
||||
|
||||
// Bluetooth LE spec Where a characteristic can be notified, a Client Characteristic Configuration descriptor
|
||||
// shall be included in that characteristic as required by the Bluetooth Core Specification
|
||||
// Tx notify is enabled
|
||||
mNotificationDescTx = txChar.descriptor(QBluetoothUuid::ClientCharacteristicConfiguration);
|
||||
|
||||
if (mNotificationDescTx.isValid()) {
|
||||
// enable notification
|
||||
mService->writeDescriptor(mNotificationDescTx, QByteArray::fromHex("0100"));
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
void BleUart::updateData(const QLowEnergyCharacteristic &c, const QByteArray &value)
|
||||
{
|
||||
if (c.uuid() == QBluetoothUuid(QUuid(mTxUuid))) {
|
||||
emit dataRx(value);
|
||||
}
|
||||
}
|
||||
|
||||
void BleUart::confirmedDescriptorWrite(const QLowEnergyDescriptor &d, const QByteArray &value)
|
||||
{
|
||||
if (d.isValid() && d == mNotificationDescTx && value == QByteArray("0000")) {
|
||||
//disabled notifications -> assume disconnect intent
|
||||
disconnectBle();
|
||||
} else {
|
||||
mConnectDone = true;
|
||||
// emit connected();
|
||||
}
|
||||
}
|
||||
|
||||
void BleUart::controlStateChanged(QLowEnergyController::ControllerState state)
|
||||
{
|
||||
(void)state;
|
||||
|
||||
// qDebug() << state;
|
||||
|
||||
// if (state == QLowEnergyController::ConnectedState) {
|
||||
// QLowEnergyConnectionParameters param;
|
||||
// param.setIntervalRange(7.5, 7.5);
|
||||
// param.setSupervisionTimeout(10000);
|
||||
// param.setLatency(0);
|
||||
// mControl->requestConnectionUpdate(param);
|
||||
// }
|
||||
}
|
||||
|
||||
void BleUart::connectionUpdated(const QLowEnergyConnectionParameters &newParameters)
|
||||
{
|
||||
(void)newParameters;
|
||||
qDebug() << "BLE connection parameters updated";
|
||||
}
|
||||
Reference in New Issue
Block a user