App2Fac.cpp

Go to the documentation of this file.

#include "include/App2Fac.h"

App2Fac::App2Fac(QBluetoothServer *server, QBluetoothSocket *bt, ParameterDENM *denm)
{
    rfcommServer = server;
    btSocket = bt;
    udpSocket = new QUdpSocket;

    udpSocket->open(QIODevice::WriteOnly);
//    port = denm->reqPort();
//    indicationAddress = QHostAddress(denm->eventIndicationAddress());
//    indicationPort = denm->eventIndicationPort();

    QObject::connect(rfcommServer, SIGNAL(newConnection()), this, SLOT(clientConnected()));

}

void App2Fac::sendMessageToDENBasicService()
{
    QBluetoothSocket *socket = qobject_cast<QBluetoothSocket *>(sender());
    if (!socket)
    {
        qWarning() << "Can't read bluetooth message";
        return;
    }
    QNetworkDatagram datagram;

    datagram.setDestination(QHostAddress::LocalHost, port);

    qInfo() << "Reading data";
    datagram.setData(socket->readAll());
    qInfo() << datagram.data().toHex() << "received";
    udpSocket->writeDatagram(datagram);

    int msgLen = -1;
    char msgRep[MSG_LENGTH];
    QElapsedTimer timer;
    ActionID_t defaultAID;

    defaultAID.originatingStationID = 0;
    defaultAID.sequenceNumber = 0;

    timer.start();

    while(msgLen == -1 && timer.elapsed() < 10000)
        msgLen = udpSocket->readDatagram(msgRep, MSG_LENGTH);

    if(msgLen != -1)
    {
        AppDenmResultData result(QByteArray(msgRep, msgLen));

        if(result.failureNotification())
            denmTriggerResult(false, result.actionID());
        else
            denmTriggerResult(true, result.actionID());
    }
    else
        denmTriggerResult(false, defaultAID);
}

void App2Fac::clientConnected()
{
//    printf("New client connected\n");
    btSocket = rfcommServer->nextPendingConnection();
    if (!btSocket)
    {
//        qWarning() << "Can't get next connection";
        return;
    }

    qInfo() << "Bluetooth socket initialized";

    QObject::connect(btSocket, SIGNAL(readyRead()), this, SLOT(sendMessageToDENBasicService()));
    QObject::connect(btSocket, SIGNAL(disconnected()), this, SLOT(clientDisconnected()));

    emit newBTSocket(btSocket);
}

void App2Fac::clientDisconnected()
{
    QBluetoothSocket *socket = qobject_cast<QBluetoothSocket *>(sender());
    if (!socket)
        return;
    qDebug() << socket->peerAddress().toString() << "disconnect :(";

    if(btSocket)
    {
        if(btSocket->isOpen())
            btSocket->close();
    }

    socket->deleteLater();
}

void App2Fac::denmTriggerResult(bool success, ActionID_t actionID)
{
    quint8 mt = 0x11;
    quint8 result = success;
    QByteArray res;
    QDataStream ds(&res, QIODevice::WriteOnly);

    ds << mt << result << (quint32)actionID.originatingStationID << (quint16)actionID.sequenceNumber;

    udpSocket->writeDatagram(QNetworkDatagram(res, indicationAddress, indicationPort));
}