forked from JanekOstendorf/THOMAS
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathRS232.cpp
115 lines (88 loc) · 2.32 KB
/
RS232.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
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
/*
-- RS232-KLASSE :: IMPLEMENTIERUNG --
*/
/* INCLUDES */
// Klassenheader
#include "RS232.h"
using namespace THOMAS;
// THOMASException-Klasse
#include "THOMASException.h"
// C++-IO-Stream-Klasse
#include <iostream>
// Terminal-IO-Definitionen [Non-Standard]
// In diesem Header wird u.a. die termios-Struktur definiert.
#include <termios.h>
// POSIX-Definitionen [Non-Standard]
// Dieser Header enthält u.a. Definitionen für viele POSIX-Systemaufrufe.
#include <unistd.h>
// File-Control-Definitionen [Non-Standard]
// Dieser Header erhält u.a. die Definition des open()-Systemaufrufs.
#include <fcntl.h>
/* FUNKTIONEN */
RS232::RS232()
{
// Anschlusshandle erstellen, RS232-Anschluss (ttyS0) laden
_handle = open("/dev/ttyS0", O_RDWR | O_NOCTTY | O_NDELAY);
// Fehler abfangen
if(_handle == -1)
{
// Fehler
throw THOMASException("Fehler: Es konnte keine Verbindung zum RS232-Port hergestellt werden!");
}
// Anschluss-Flags leeren
fcntl(_handle, F_SETFL, 0);
// Anschluss-Optionen erstellen
termios fOpt;
// Aktuelle Anschluss-Optionen abrufen
tcgetattr(_handle, &fOpt);
// Baudrate setzen (9600); TODO: Zu Testzwecken auf 1200
cfsetispeed(&fOpt, B9600); // Input
cfsetospeed(&fOpt, B9600); // Output
// TODO: Daten empfangen?
/*
// Flags setzen
fOpt.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);
fOpt.c_cflag &= ~PARENB;
fOpt.c_cflag &= ~CSTOPB;
fOpt.c_cflag &= ~CSIZE;
fOpt.c_cflag |= CS8;
fOpt.c_cc[VMIN] = 1;
fOpt.c_cc[VTIME] = 0;
fOpt.c_cflag |= (CLOCAL | CREAD);
*/
// Neue Port-Optionen einsetzen
tcsetattr(_handle, TCSANOW, &fOpt);
}
RS232::~RS232()
{
// Verbindung schliessen
close(_handle);
}
void RS232::Send(BYTE com, BYTE *params, int paramCount)
{
// Befehlsarray erstellen (3 Sonderbytes + Kommandobyte + Parameter)
BYTE *data = new BYTE[4 + paramCount];
// Die beiden Steuerbytes setzen
data[0] = 35;
data[1] = 35;
// Laengenbyte setzen
data[2] = (paramCount + 1);
// Kommandobyte setzen
data[3] = com;
// Parameterbytes zuweisen
int i;
for(i = 0; i < paramCount; i++)
{
data[i + 4] = params[i];
}
// Anzahl der gesendeten Daten merken
int n = write(_handle, data, paramCount + 4);
// Anzahl der gesendeten Daten pruefen
if(n < (paramCount + 4))
{
// Mist
throw THOMASException("Fehler beim Senden eines Befehls!");
}
// Speicher freigeben
delete[] data;
}