| @@ -0,0 +1,60 | |||||
|
|
1 | #include "tcpackettosend.h" | |||
|
|
2 | ||||
|
|
3 | TCPacketToSend::TCPacketToSend(QObject *parent) : | |||
|
|
4 | QObject(parent) | |||
|
|
5 | { | |||
|
|
6 | initLookUpTableForCRC(); | |||
|
|
7 | } | |||
|
|
8 | ||||
|
|
9 | void TCPacketToSend::initLookUpTableForCRC( void ) | |||
|
|
10 | { | |||
|
|
11 | unsigned int i; | |||
|
|
12 | unsigned int tmp; | |||
|
|
13 | ||||
|
|
14 | for (i=0; i<256; i++) | |||
|
|
15 | { | |||
|
|
16 | tmp = 0; | |||
|
|
17 | if((i & 1) != 0) { | |||
|
|
18 | tmp = tmp ^ 0x1021; | |||
|
|
19 | } | |||
|
|
20 | if((i & 2) != 0) { | |||
|
|
21 | tmp = tmp ^ 0x2042; | |||
|
|
22 | } | |||
|
|
23 | if((i & 4) != 0) { | |||
|
|
24 | tmp = tmp ^ 0x4084; | |||
|
|
25 | } | |||
|
|
26 | if((i & 8) != 0) { | |||
|
|
27 | tmp = tmp ^ 0x8108; | |||
|
|
28 | } | |||
|
|
29 | if((i & 16) != 0) { | |||
|
|
30 | tmp = tmp ^ 0x1231; | |||
|
|
31 | } | |||
|
|
32 | if((i & 32) != 0) { | |||
|
|
33 | tmp = tmp ^ 0x2462; | |||
|
|
34 | } | |||
|
|
35 | if((i & 64) != 0) { | |||
|
|
36 | tmp = tmp ^ 0x48c4; | |||
|
|
37 | } | |||
|
|
38 | if((i & 128) != 0) { | |||
|
|
39 | tmp = tmp ^ 0x9188; | |||
|
|
40 | } | |||
|
|
41 | lookUpTableForCRC[i] = tmp; | |||
|
|
42 | } | |||
|
|
43 | } | |||
|
|
44 | ||||
|
|
45 | void TCPacketToSend::GetCRCAsTwoBytes(unsigned char* data, unsigned char* crcAsTwoBytes, unsigned int sizeOfData) | |||
|
|
46 | { | |||
|
|
47 | unsigned int Chk; | |||
|
|
48 | unsigned int j; | |||
|
|
49 | Chk = 0xffff; // reset the syndrom to all ones | |||
|
|
50 | for (j=0; j<sizeOfData; j++) { | |||
|
|
51 | Chk = Crc_opt(data[j], Chk); | |||
|
|
52 | } | |||
|
|
53 | crcAsTwoBytes[0] = (unsigned char) (Chk >> 8); | |||
|
|
54 | crcAsTwoBytes[1] = (unsigned char) (Chk & 0x00ff); | |||
|
|
55 | } | |||
|
|
56 | ||||
|
|
57 | unsigned int TCPacketToSend::Crc_opt( unsigned char D, unsigned int Chk) | |||
|
|
58 | { | |||
|
|
59 | return(((Chk << 8) & 0xff00)^lookUpTableForCRC [(((Chk >> 8)^D) & 0x00ff)]); | |||
|
|
60 | } | |||
| @@ -0,0 +1,27 | |||||
|
|
1 | #ifndef TCPACKETTOSEND_H | |||
|
|
2 | #define TCPACKETTOSEND_H | |||
|
|
3 | ||||
|
|
4 | #include <QObject> | |||
|
|
5 | ||||
|
|
6 | #include <TC_types.h> | |||
|
|
7 | ||||
|
|
8 | class TCPacketToSend : public QObject | |||
|
|
9 | { | |||
|
|
10 | Q_OBJECT | |||
|
|
11 | public: | |||
|
|
12 | explicit TCPacketToSend(QObject *parent = 0); | |||
|
|
13 | ||||
|
|
14 | unsigned char calculateDataCRC(char *data, int nbBytes); | |||
|
|
15 | void initLookUpTableForCRC( void ); | |||
|
|
16 | ||||
|
|
17 | void GetCRCAsTwoBytes(unsigned char* data, unsigned char* crcAsTwoBytes, unsigned int sizeOfData); | |||
|
|
18 | unsigned int Crc_opt( unsigned char D, unsigned int Chk); | |||
|
|
19 | unsigned int lookUpTableForCRC[256]; | |||
|
|
20 | ||||
|
|
21 | signals: | |||
|
|
22 | ||||
|
|
23 | public slots: | |||
|
|
24 | ||||
|
|
25 | }; | |||
|
|
26 | ||||
|
|
27 | #endif // TCPACKETTOSEND_H | |||
General Comments 0
You need to be logged in to leave comments.
Login now