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
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
|
/*
* 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
#if defined(__unix__) || defined(__APPLE__)
#include <termios.h>
#include <limits.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <string.h>
#if defined(__APPLE__)
#include <CoreFoundation/CoreFoundation.h>
#include <IOKit/IOKitLib.h>
#include <IOKit/serial/IOSerialKeys.h>
#include <IOKit/serial/ioss.h>
#include <IOKit/IOBSD.h>
#endif
smint32 serialPortOpen(const char * port_device_name, smint32 baudrate_bps)
{
int port_handle;
int err;
int baudrateEnumValue;
struct termios new_port_settings;
int customBaudRate = 0;
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);
}
switch(baudrate_bps)
{
#if defined(B9600)
case 9600 : baudrateEnumValue = B9600; break;
#endif
#if defined(B19200)
case 19200 : baudrateEnumValue = B19200; break;
#endif
#if defined(B38400)
case 38400 : baudrateEnumValue = B38400; break;
#endif
#if defined(B57600)
case 57600 : baudrateEnumValue = B57600; break;
#endif
#if defined(B115200)
case 115200 : baudrateEnumValue = B115200; break;
#endif
#if defined(B230400)
case 230400 : baudrateEnumValue = B230400; break;
#endif
#if defined(B460800)
case 460800 : baudrateEnumValue = B460800; break;
#endif
#if defined(B500000)
case 500000 : baudrateEnumValue = B500000; break;
#endif
#if defined(B576000)
case 576000 : baudrateEnumValue = B576000; break;
#endif
#if defined(B921600)
case 921600 : baudrateEnumValue = B921600; break;
#endif
#if defined(B1000000)
case 1000000 : baudrateEnumValue = B1000000; break;
#endif
#if defined(B1152000)
case 1115200 : baudrateEnumValue = B1152000; break;
#endif
#if defined(B1500000)
case 1500000 : baudrateEnumValue = B1500000; break;
#endif
#if defined(B2000000)
case 2000000 : baudrateEnumValue = B2000000; break;
#endif
#if defined(B2500000)
case 2500000 : baudrateEnumValue = B2500000; break;
#endif
#if defined(B3000000)
case 3000000 : baudrateEnumValue = B3000000; break;
#endif
#if defined(B3500000)
case 3500000 : baudrateEnumValue = B3500000; break;
#endif
#if defined(B4000000)
case 4000000 : baudrateEnumValue = B4000000; break;
#endif
default:
customBaudRate = 1;
#if defined(__APPLE__)
if (ioctl(port_handle, IOSSIOSPEED, &baudrate_bps) == -1)
{
smDebug(-1, Low, "Serial port error: unsupported baudrate\n");
close(port_handle);
return -1;
}
#else
smDebug(-1,Low,"Serial port error: unsupported baudrate\n");
close(port_handle);
return(-1);
break;
#endif
}
memset(&new_port_settings, 0, sizeof(new_port_settings)); //reset struct
new_port_settings.c_cflag = 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 */
if (!customBaudRate)
{
#if defined(_BSD_SOURCE)
cfsetspeed(&new_port_settings, baudrateEnumValue);
#else
cfsetispeed(&new_port_settings, baudrateEnumValue);
cfsetospeed(&new_port_settings, baudrateEnumValue);
#endif
}
// Activate settings
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
|
