PairingNFC.cc 6.64 KB
Newer Older
Gus Grubba's avatar
Gus Grubba committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146
/****************************************************************************
 *
 *   (c) 2019 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/
#include "PairingManager.h"
#include "PairingNFC.h"
#include "QGCApplication.h"
#include <QSoundEffect>

QGC_LOGGING_CATEGORY(PairingNFCLog, "PairingNFCLog")

extern "C" {
#include <TML/inc/tool.h>
#include <NfcTask/inc/ndef_helper.h>
//-----------------------------------------------------------------------------
void logmsg(char *buf)
{
    QString s = buf;
    s.replace("\n", "");
    qCDebug(PairingNFCLog) << s;
}

//-----------------------------------------------------------------------------
void NdefPull_Cb(unsigned char *pNdefMessage, unsigned short NdefMessageSize)
{
    Q_UNUSED(NdefMessageSize);
    unsigned char *pNdefRecord = pNdefMessage;
    NdefRecord_t NdefRecord;
    unsigned char save;

    if (!pNdefMessage)
    {
        qCDebug(PairingNFCLog) << "Issue during NDEF message reception (check provisioned buffer size)";
        return;
    }

    QSoundEffect _nfcSound;
    _nfcSound.setSource(QUrl::fromUserInput("qrc:/auterion/wav/beep.wav"));
    _nfcSound.setVolume(0.9);
    _nfcSound.play();

    while (pNdefRecord)
    {
        qCDebug(PairingNFCLog) << "NDEF record received";

        NdefRecord = DetectNdefRecordType(pNdefRecord);

        switch(NdefRecord.recordType)
        {
        case MEDIA_VCARD:
            save = NdefRecord.recordPayload[NdefRecord.recordPayloadSize];
            NdefRecord.recordPayload[NdefRecord.recordPayloadSize] = '\0';
            qCDebug(PairingNFCLog) << "   vCard: " << reinterpret_cast<char *>(NdefRecord.recordPayload);
            NdefRecord.recordPayload[NdefRecord.recordPayloadSize] = save;
            break;

        case WELL_KNOWN_SIMPLE_TEXT:
        {
            save = NdefRecord.recordPayload[NdefRecord.recordPayloadSize];
            NdefRecord.recordPayload[NdefRecord.recordPayloadSize] = '\0';
            QString text = reinterpret_cast<char *>(&NdefRecord.recordPayload[NdefRecord.recordPayload[0]+1]);
            qCDebug(PairingNFCLog) << "   Text: " << text;
            qgcApp()->toolbox()->pairingManager()->jsonReceived(text);
            NdefRecord.recordPayload[NdefRecord.recordPayloadSize] = save;
            break;
        }

        default:
            qCDebug(PairingNFCLog) << "   Unsupported NDEF record, cannot parse";
            break;
        }
        pNdefRecord = GetNextRecord(pNdefRecord);
    }
}
//-----------------------------------------------------------------------------
}

// Discovery loop configuration according to the targeted modes of operation
static unsigned char discoveryTechnologies[] = {
    MODE_POLL | TECH_PASSIVE_NFCA,
    MODE_POLL | TECH_PASSIVE_NFCF,
    MODE_POLL | TECH_PASSIVE_NFCB,
    MODE_POLL | TECH_PASSIVE_15693,
};

//-----------------------------------------------------------------------------
PairingNFC::PairingNFC()
{
}

//-----------------------------------------------------------------------------
void PairingNFC::start()
{
    if (!isRunning()) {
        _exitThread = false;
        QThread::start();
    }
}

//-----------------------------------------------------------------------------
void PairingNFC::stop()
{
    if (isRunning()) {
        _exitThread = true;
    }
}

//-----------------------------------------------------------------------------
void PairingNFC::run()
{
    NxpNci_RfIntf_t RfInterface;

    // Register callback for reception of NDEF message from remote cards
    RW_NDEF_RegisterPullCallback(reinterpret_cast<void*>(*NdefPull_Cb));

    // Open connection to NXPNCI device
    if (NxpNci_Connect() == NFC_ERROR) {
        qCDebug(PairingNFCLog) << "Error: cannot connect to NXPNCI device";
        return;
    }

    if (NxpNci_ConfigureSettings() == NFC_ERROR) {
        qCDebug(PairingNFCLog) << "Error: cannot configure NXPNCI settings";
        return;
    }

    if (NxpNci_ConfigureMode(NXPNCI_MODE_RW) == NFC_ERROR)
    {
        qCDebug(PairingNFCLog) << "Error: cannot configure NXPNCI";
        return;
    }

    // Start Discovery
    if (NxpNci_StartDiscovery(discoveryTechnologies,sizeof(discoveryTechnologies)) != NFC_SUCCESS)
    {
        qCDebug(PairingNFCLog) << "Error: cannot start discovery";
        return;
    }

    while(!_exitThread)
    {
        qCDebug(PairingNFCLog) << "Waiting for NFC connection";
Gus Grubba's avatar
Gus Grubba committed
147
        qgcApp()->toolbox()->pairingManager()->setStatusMessage(PairingManager::PairingActive, tr("Waiting for NFC connection"));
Gus Grubba's avatar
Gus Grubba committed
148 149 150 151 152 153 154 155 156 157 158 159 160

        // Wait until a peer is discovered
        while(NxpNci_WaitForDiscoveryNotification(&RfInterface) != NFC_SUCCESS);

        if ((RfInterface.ModeTech & MODE_MASK) == MODE_POLL)
        {
            task_nfc_reader(RfInterface);
        }
        else
        {
            qCDebug(PairingNFCLog) << "Wrong discovery";
        }
    }
Gus Grubba's avatar
Gus Grubba committed
161
    qgcApp()->toolbox()->pairingManager()->setStatusMessage(PairingManager::PairingIdle, "");
Gus Grubba's avatar
Gus Grubba committed
162 163 164 165 166 167
    qCDebug(PairingNFCLog) << "NFC: Stop";
}

//-----------------------------------------------------------------------------
void PairingNFC::task_nfc_reader(NxpNci_RfIntf_t RfIntf)
{
Gus Grubba's avatar
Gus Grubba committed
168
    qgcApp()->toolbox()->pairingManager()->setStatusMessage(PairingManager::PairingActive, tr("Device detected"));
Gus Grubba's avatar
Gus Grubba committed
169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204
    qCDebug(PairingNFCLog) << "NFC: Device detected";
    // For each discovered cards
    while(!_exitThread) {
        // What's the detected card type ?
        switch(RfIntf.Protocol) {
        case PROT_T1T:
        case PROT_T2T:
        case PROT_T3T:
        case PROT_ISODEP:
            // Process NDEF message read
            NxpNci_ProcessReaderMode(RfIntf, READ_NDEF);
            break;

        case PROT_ISO15693:
            break;

        case PROT_MIFARE:
            break;

        default:
            break;
        }

        // If more cards (or multi-protocol card) were discovered (only same technology are supported) select next one
        if (RfIntf.MoreTags) {
            if (NxpNci_ReaderActivateNext(&RfIntf) == NFC_ERROR)
                break;
        }
        // Otherwise leave
        else
            break;
    }

    // Wait for card removal
    NxpNci_ProcessReaderMode(RfIntf, PRESENCE_CHECK);

Gus Grubba's avatar
Gus Grubba committed
205
    qgcApp()->toolbox()->pairingManager()->setStatusMessage(PairingManager::PairingActive, tr("Device removed"));
Gus Grubba's avatar
Gus Grubba committed
206 207 208 209 210 211 212 213 214
    qCDebug(PairingNFCLog) << "NFC device removed";

    // Restart discovery loop
    NxpNci_StopDiscovery();
    NxpNci_StartDiscovery(discoveryTechnologies, sizeof(discoveryTechnologies));
}

//-----------------------------------------------------------------------------