SerialPort_Assistant/dataframe.cpp at master · Berserker-v/SerialPort_Assistant · 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
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
#include <QDebug>

#include "dataframe.h"
#include "cstring"

DataFrame::DataFrame()
{

}

void DataFrame::setFrame(QList<int> &list, QList<int> &h_list, QByteArray &h_data)
{
    framelength = 0;
    datacnt = 0;
    framelist = list;
    headlist = h_list;
    headdata = h_data;
    QListIterator<int> frame(list);
    while (frame.hasNext()) {
        switch (frame.next()) {
        case 0: framelength++; break;     //unsigned char
        case 1: framelength++; break;     //signed char
        case 2: framelength += 2; break;  //unsigned short
        case 3: framelength += 2; break;  //signed short
        case 4: framelength += 4; break;  //unsigned int
        case 5: framelength += 4; break;  //signed int
        case 6: framelength += 4; break;  //float
        case 7: framelength += 8; break;  //double
        case 8: framelength += 8; break;  //unsigned long int
        case 9: framelength += 8; break;  //signed long int
        case 10: framelength +=2; break;  //half word
        case 11: framelength +=4; break;  //full word
        }
    }
}


DataFrame::~DataFrame()
{
}

void DataFrame::SplitTail()
{
    for (int i=0; i<headlist.size()-1; ++i) {
        //假如帧头列表不连续则视为帧尾
        if (headlist.at(i+1) > (headlist.at(i)+1)) {
            //移除headlist/headdata中帧尾列表和数据
            for (int j=headlist.size()-1; j>i; --j) {
                taillist.prepend(headlist.takeAt(j));
                taildata.append(headdata.at(j));
            }
            headdata.remove(i+1,taillist.size());
            break;
        }
    }
}

void DataFrame::ReadData(const QByteArray *buf)
{
    if (!datacnt)  {
        p_data = new uchar[framelength];
    }

//    for (char i : *buf)  {
//        *(p_data+datacnt) = static_cast<uchar>(i);
//    }

    for (int i=0; i<buf->size(); ++i) {
        *(p_data+datacnt)= static_cast<uchar>(buf->at(i));

        //判断帧头
        if (datacnt < headlen)  {
            if (*(p_data+datacnt) == static_cast<uchar>(headdata.at(datacnt)))  {
                ++datacnt;
            }
            else {
                datacnt = 0;
            }
            continue;
        }

        //判断帧尾
        if(datacnt>(framelength-taillen-1)) {
            if (*(p_data+datacnt) != static_cast<uchar>(taildata.at(taillen-(framelength-datacnt)))) {
                datacnt = 0;
                continue;
            }
        }
        ++datacnt;

        //数据帧接收完整发出信号
        if(datacnt == framelength) {
            datacnt = 0;
            send();
            break;
        }
    }
}

void DataFrame::send()
{
    emit frame_ok(p_data);
}

void DataFrame::clear()
{
    framelist.clear();
    headlist.clear();
    taillist.clear();
    headdata.clear();
    taildata.clear();
}