-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathRS422_FPA_Message.cpp
86 lines (71 loc) · 1.5 KB
/
RS422_FPA_Message.cpp
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
//Copyright (c) Piet Wauters 2022 <[email protected]>
#include "RS422_FPA_Message.h"
RS422_FPA_Message::RS422_FPA_Message()
{
//ctor
}
RS422_FPA_Message::~RS422_FPA_Message()
{
//dtor
}
RS422_FPA_Message::RS422_FPA_Message(const RS422_FPA_Message& other)
{
//copy ctor
}
void RS422_FPA_Message::Print()
{
int i = 1;
cout << "SOH ";
while(m_message[i] != EOT)
{
switch (m_message[i])
{
case DC3:
cout << "DC3 ";
break;
case DC4:
cout << "DC4 ";
break;
case STX:
cout << "STX ";
break;
default:
cout << m_message[i];
break;
}
i++;
}
cout << " EOT" << endl;
}
size_t RS422_FPA_Message::CalculateSize()
{
size_t i = 0;
while(m_message[i]!= EOT)
i++;
iCurrentSize = i+1;
}
void RS422_FPA_Message::setSingleDigitNumberInAscii(int value, int bytenumber)
{
m_message[bytenumber] = '0' + value;
}
void RS422_FPA_Message::setDoubleDigitNumberInAscii(int value, int bytenumber)
{
int tens = value / 10;
if(tens > 0)
m_message[bytenumber]= '0' + tens;
else
m_message[bytenumber]= ' ';
m_message[bytenumber+1]= '0' + value - 10 * tens;
}
int RS422_FPA_Message::GetEOTIndex()
{
int index = 0;
while(m_message[index] != EOT)
{
if(index < MAX_MESSAGE_LENGTH_RS422)
index++;
else
return -1;
}
return index;
}