94ee66acd7
* Working on cleaning wifi * Reworked bluetooth handshake based around @presslab-us's work * Forgot to remove a line * QOL: try to reconnect to last phone BT on openauto start * bt autoconnect raspberry pi workaround * Try to connect to last successful bluetooth device * Bad merge fix * pointers * typo * Update SocketInfoResponse.proto * Added a config option to autoconnect to last bt device (defaults off)
75 lines
2.9 KiB
C++
75 lines
2.9 KiB
C++
#include "btservice/btservice.hpp"
|
|
|
|
namespace openauto
|
|
{
|
|
namespace btservice
|
|
{
|
|
|
|
btservice::btservice(openauto::configuration::IConfiguration::Pointer config)
|
|
: androidBluetoothService_(cServicePortNumber)
|
|
, androidBluetoothServer_(config)
|
|
{
|
|
QBluetoothAddress address;
|
|
auto adapters = QBluetoothLocalDevice::allDevices();
|
|
if(adapters.size() > 0)
|
|
{
|
|
address = adapters.at(0).address();
|
|
}
|
|
else
|
|
{
|
|
OPENAUTO_LOG(error) << "[btservice] No adapter found.";
|
|
}
|
|
|
|
if(!androidBluetoothServer_.start(address, cServicePortNumber))
|
|
{
|
|
OPENAUTO_LOG(error) << "[btservice] Server start failed.";
|
|
return;
|
|
}
|
|
|
|
OPENAUTO_LOG(info) << "[btservice] Listening for connections, address: " << address.toString().toStdString()
|
|
<< ", port: " << cServicePortNumber;
|
|
|
|
if(!androidBluetoothService_.registerService(address))
|
|
{
|
|
OPENAUTO_LOG(error) << "[btservice] Service registration failed.";
|
|
}
|
|
else
|
|
{
|
|
OPENAUTO_LOG(info) << "[btservice] Service registered, port: " << cServicePortNumber;
|
|
}
|
|
if(config->getAutoconnectBluetooth())
|
|
connectToBluetooth(QBluetoothAddress(QString::fromStdString(config->getLastBluetoothPair())), address);
|
|
}
|
|
|
|
void btservice::connectToBluetooth(QBluetoothAddress addr, QBluetoothAddress controller)
|
|
{
|
|
// The raspberry pi has a really tough time using bluetoothctl (or really anything) to connect to an Android phone
|
|
// even though phone connecting to the pi is fine.
|
|
// I found a workaround where you can make the pi attempt an rfcomm connection to the phone, and it connects immediately
|
|
// This might require setting u+s on rfcomm though
|
|
// Other computers with more sane bluetooth shouldn't have an issue using bluetoothctl
|
|
|
|
#ifdef RPI
|
|
// tries to open an rfcomm serial on channel 2
|
|
// channel doesn't really matter here, 2 is just "somewhat standard"
|
|
QString program = QString::fromStdString("sudo stdbuf -oL rfcomm connect hci0 ")+addr.toString()+QString::fromStdString(" 2");
|
|
btConnectProcess = new QProcess();
|
|
OPENAUTO_LOG(info)<<"[btservice] Attempting to connect to last bluetooth device, "<<addr.toString().toStdString()<<" with `"<<program.toStdString();
|
|
btConnectProcess->start(program, QProcess::Unbuffered | QProcess::ReadWrite);
|
|
#else
|
|
btConnectProcess = new QProcess();
|
|
btConnectProcess->setProcessChannelMode(QProcess::SeparateChannels);
|
|
OPENAUTO_LOG(info)<<"[btservice] Attempting to connect to last bluetooth device, "<<addr.toString().toStdString()<<" with bluetoothctl";
|
|
btConnectProcess->start("bluetoothctl");
|
|
btConnectProcess->waitForStarted();
|
|
btConnectProcess->write(QString("select %1\n").arg(controller.toString()).toUtf8());
|
|
btConnectProcess->write(QString("connect %1\n").arg(addr.toString()).toUtf8());
|
|
btConnectProcess->closeWriteChannel();
|
|
btConnectProcess->waitForFinished();
|
|
#endif
|
|
}
|
|
|
|
|
|
}
|
|
}
|