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
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
|
/*
* pcserialport.h
*
* Header for PC serial port access library (win/linux)
*
* Created on: 28.12.2016
* Author: Tero
*
* Inspired by RS232 library by Teunis van Beelen
*/
#include "pcserialport.h"
#include "simplemotion_private.h" //needed for timeout variable
#ifdef __unix__
#include <termios.h>
#include <limits.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <sys/types.h>
smint32 serialPortOpen(const char * port_device_name, smint32 baudrate_bps)
{
int port_handle;
int err;
int baudrateEnumValue;
struct termios new_port_settings;
switch(baudrate_bps)
{
case 9600 : baudrateEnumValue = B9600; break;
case 19200 : baudrateEnumValue = B19200; break;
case 38400 : baudrateEnumValue = B38400; break;
case 57600 : baudrateEnumValue = B57600; break;
case 115200 : baudrateEnumValue = B115200; break;
case 230400 : baudrateEnumValue = B230400; break;
case 460800 : baudrateEnumValue = B460800; break;
case 500000 : baudrateEnumValue = B500000; break;
case 576000 : baudrateEnumValue = B576000; break;
case 921600 : baudrateEnumValue = B921600; break;
case 1000000 : baudrateEnumValue = B1000000; break;
case 1115200 : baudrateEnumValue = B1152000; break;
case 1500000 : baudrateEnumValue = B1500000; break;
case 2000000 : baudrateEnumValue = B2000000; break;
case 2500000 : baudrateEnumValue = B2500000; break;
case 3000000 : baudrateEnumValue = B3000000; break;
case 3500000 : baudrateEnumValue = B3500000; break;
case 4000000 : baudrateEnumValue = B4000000; break;
default : smDebug(-1,Low,"Serial port error: unsupported baudrate\n");
return(1);
break;
}
port_handle = open(port_device_name, O_RDWR | O_NOCTTY );
if(port_handle==-1)
{
smDebug(-1, Low, "Serial port error: port open failed");
return(port_handle);
}
memset(&new_port_settings, 0, sizeof(new_port_settings)); //reset struct
new_port_settings.c_cflag = baudrateEnumValue | CS8 | CLOCAL | CREAD;
new_port_settings.c_iflag = IGNPAR;
new_port_settings.c_oflag = 0;
new_port_settings.c_lflag = 0;
new_port_settings.c_cc[VMIN] = 0; /* non blocking mode */
new_port_settings.c_cc[VTIME] = readTimeoutMs/100; /* timeout 100 ms steps */
err = tcsetattr(port_handle, TCSANOW, &new_port_settings);
if(err==-1)
{
close(port_handle);
smDebug(-1, Low, "Serial port error: failed to set port parameters");
return -1;
}
//flush any stray bytes from device receive buffer that may reside in it
//note: according to following page, delay before this may be necessary http://stackoverflow.com/questions/13013387/clearing-the-serial-ports-buffer
usleep(100000);
tcflush(port_handle,TCIOFLUSH);
return port_handle;
}
smint32 serialPortRead(smint32 serialport_handle, smuint8 *buf, smint32 size)
{
smint32 n;
if(size>4096) size = 4096;
n = read(serialport_handle, buf, size);
return n;
}
smint32 serialPortWrite(smint32 serialport_handle, unsigned char byte)
{
smint32 n;
n = write(serialport_handle, &byte, 1);
if(n<0)
return 1;
return 0;
}
smint32 serialPortWriteBuffer(smint32 serialport_handle, unsigned char *buf, smint32 size)
{
return(write(serialport_handle, buf, size));
}
void serialPortClose(smint32 serialport_handle)
{
close(serialport_handle);
}
#else //windows: for API, see https://msdn.microsoft.com/en-us/library/ff802693.aspx
#include <windows.h>
#include <string.h>
smint32 serialPortOpen(const char *port_device_name, smint32 baudrate_bps)
{
char port_def_string[64], port_name[32];
HANDLE port_handle;
sprintf(port_def_string,"baud=%d data=8 parity=N stop=1", (int)baudrate_bps);
sprintf(port_name,"\\\\.\\%s",port_device_name);
port_handle = CreateFileA(port_name,GENERIC_READ|GENERIC_WRITE,0,NULL,OPEN_EXISTING,0,NULL);
if(port_handle==INVALID_HANDLE_VALUE)
{
smDebug( -1, Low, "Serial port error: Unable to create serial port handle");
return -1;
}
//fill DCB settings struct
DCB dcb;
FillMemory(&dcb, sizeof(dcb), 0);
dcb.DCBlength = sizeof(dcb);
if(!BuildCommDCBA(port_def_string, &dcb))
{
smDebug( -1, Low, "Serial port error: Unable to build DCB settings\n");
CloseHandle(port_handle);
return -1;
}
if(!SetCommState(port_handle, &dcb))
{
smDebug( -1, Low, "Serial port error: Unable to set port settings\n");
CloseHandle(port_handle);
return -1;
}
//set timeout
COMMTIMEOUTS port_timeouts;
port_timeouts.ReadTotalTimeoutConstant = readTimeoutMs;
port_timeouts.ReadIntervalTimeout = 0;
port_timeouts.ReadTotalTimeoutMultiplier = 0;
port_timeouts.WriteTotalTimeoutMultiplier = 50;
port_timeouts.WriteTotalTimeoutConstant = 50;
if(!SetCommTimeouts(port_handle, &port_timeouts))
{
smDebug( -1, Low, "Serial port error: Failed to set port timeout settings\n");
CloseHandle(port_handle);
return(-1);
}
//flush any stray bytes from device receive buffer that may reside in it
PurgeComm((HANDLE)port_handle,PURGE_RXABORT|PURGE_RXCLEAR|PURGE_TXABORT|PURGE_TXCLEAR);
return( (smint32)port_handle);
}
smint32 serialPortRead(smint32 serialport_handle, unsigned char *buf, smint32 size)
{
smint32 n;
if(size>4096)
size = 4096;
ReadFile((HANDLE)serialport_handle, buf, size, (LPDWORD)((void *)&n), NULL);
return n;
}
smint32 serialPortWriteByte(smint32 serialport_handle, unsigned char byte)
{
smint32 n;
WriteFile((HANDLE)serialport_handle, &byte, 1, (LPDWORD)((void *)&n), NULL);
if(n<0)
return 1;
return 0;
}
smint32 serialPortWriteBuffer(smint32 serialport_handle, unsigned char *buf, smint32 size)
{
smint32 n;
if(WriteFile((HANDLE)serialport_handle, buf, size, (LPDWORD)((void *)&n), NULL))
return n;
return -1;
}
void serialPortClose(smint32 serialport_number)
{
CloseHandle((HANDLE)serialport_number);
}
#endif//windows
|
