Htra_console/switcher_processor.cpp at master · Unsainted38/Htra_console · GitHub

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
#include "switcher_processor.h"

SwitcherProcessor::SwitcherProcessor(QString configPath, QString section, QObject *parent)
    : QObject{parent} {
    transport = AbstractNetworkTransportFactory::getInstance(configPath, section);
    connect(transport, SIGNAL(translateData(QByteArray)), this, SLOT(OnGetReply(QByteArray)));
}

void SwitcherProcessor::setRF1() {
    sendCmd(0x01);
}

void SwitcherProcessor::setRF2() {
    sendCmd(0x02);
}

void SwitcherProcessor::setRF3() {
    sendCmd(0x03);
}

void SwitcherProcessor::setRF4() {
    sendCmd(0x04);
}

void SwitcherProcessor::RFoff() {
    sendCmd(0x00);
}

void SwitcherProcessor::sendCmd(quint8 cmdId) {
    QByteArray packet;
    QDataStream out(&packet, QIODevice::WriteOnly);
    out.setByteOrder(QDataStream::BigEndian);
    out.setFloatingPointPrecision(QDataStream::SinglePrecision);
    out << (quint8)0xAA
        << (quint8)0x55
        << cmdId;
    transport->write(packet);
}

void SwitcherProcessor::OnGetReply(QByteArray reply) {
    QByteArray buffer;
    quint8 value;
    //qDebug() << "Reply" << reply.toHex();
    buffer.append(reply);
    QDataStream in(&buffer, QIODevice::ReadOnly);
    in.setByteOrder(QDataStream::LittleEndian);
    in.setFloatingPointPrecision(QDataStream::SinglePrecision);
    in >> value;
    buffer.clear();

    switch(value) {
        case 0x00:
            //qDebug() << "RFoff";
            mode = "RFoff";
            break;

        case 0x01:
            //qDebug() << "RF1 on";
            mode = "RF1 on";
            break;

        case 0x02:
            //qDebug() << "RF2 on";
            mode = "RF2 on";
            break;

        case 0x03:
            //qDebug() << "RF3 on";
            mode = "RF3 on";
            break;

        case 0x04:
            //qDebug() << "RF4 on";
            mode = "RF4 on";
            break;

        default:
            break;
    }

}