-
Notifications
You must be signed in to change notification settings - Fork 1
/
r2_serial_port.h
216 lines (176 loc) · 5.09 KB
/
r2_serial_port.h
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
// r2_serial_port.h
//
#ifndef R2_SERIAL_PORT_H
#define R2_SERIAL_PORT_H
#include <fcntl.h> // for open, O_RDWR, O_NOCTTY, O_NDELAY, O_NONBLOCK
#include <stdio.h> // for fprintf, stderr
#include <termios.h> // for serial port
#include <sys/select.h> // to select on the file descriptor for a serial port
#include "r2_buffer.h"
struct r2_serial_port {
int fd;
struct r2_buffer * buffer;
};
const struct termios R2_SERIAL_DEFAULT_OPTIONS = {
.c_iflag = 0,
.c_oflag = 0,
.c_cflag = B9600 | CS8 | CLOCAL | CREAD,
.c_lflag = 0,
.c_cc[VMIN] = 0,
.c_cc[VTIME] = 0
};
/*
*
*/
struct r2_serial_port * r2_serial_port_create( const char * device,
const speed_t baud_rate, const size_t buffer_size );
/*
*
*/
void r2_serial_port_destroy( struct r2_serial_port * self );
/* Sets the termios options for the serial port.
*
* Any options not explicitly specified are set according to
* R2_SERIAL_DEFAULT_OPTIONS.
*/
int r2_serial_port_set_options( struct r2_serial_port * self,
const struct termios * options );
/*
*
*/
int r2_serial_port_set_baud_rate( struct r2_serial_port * self,
speed_t baud_rate );
/*
*
*/
int r2_serial_port_set_vmin_vtime(struct r2_serial_port * self, int vmin,
int vtime);
/*
*
*/
int r2_serial_port_set_nonblocking(struct r2_serial_port * self);
#endif // R2_SERIAL_PORT_H
#ifndef R2_SERIAL_PORT_I
#define R2_SERIAL_PORT_I
struct r2_serial_port * r2_serial_port_create( const char * device,
const speed_t baud_rate, const size_t buffer_size )
{
struct r2_serial_port * self = calloc( 1, sizeof( struct r2_serial_port ) );
self->fd = open( device, O_RDWR | O_NOCTTY );
if( -1 == self->fd ) {
perror( "open()" );
fprintf( stderr, "could not open device: %s\n", device );
return NULL;
#ifdef DEBUG
} else {
fprintf( stderr, "opened serial device: %s\nat descriptor: %d\n",
device, self->fd );
#endif
}
if( -1 == r2_serial_port_set_options( self, NULL ) ) {
fprintf(stderr, "could not set termios options\n");
return NULL;
}
if( -1 != baud_rate ) {
if( -1 == r2_serial_port_set_baud_rate( self, baud_rate ) ) {
fprintf(stderr, "could not set baudrate\n");
return NULL;
}
}
self->buffer = r2_buffer_create( buffer_size );
if( !self->buffer ) {
fprintf( stderr, "could not create %zub buffer\n", buffer_size );
return NULL;
#ifdef DEBUG
} else {
fprintf( stderr, "created %zub buffer at %p\n", buffer_size,
self->buffer );
#endif
}
return self;
}
void r2_serial_port_destroy( struct r2_serial_port * self )
{
if (self) {
printf("Closing serial port file descriptor.\n");
close(self->fd);
printf("Closed serial port file descriptor.\n");
printf("Destroying r2_buffer.\n");
r2_buffer_destroy(self->buffer);
printf("Destroyed r2_buffer.\n");
printf("Freeing r2_serial_port.\n");
free(self);
printf("Freed r2_serial_port.\n");
}
}
int r2_serial_port_set_options( struct r2_serial_port * self,
const struct termios * options )
{
int retval = -1;
if( NULL == options ) {
#ifdef DEBUG
fprintf(stderr, "setting default serial port options\n" );
#endif
retval = tcsetattr( self->fd, TCSAFLUSH, &R2_SERIAL_DEFAULT_OPTIONS );
} else {
#ifdef DEBUG
fprintf(stderr, "termios options: i=%lu, o=%lu\n", options->c_iflag,
options->c_oflag );
#endif
// TODO: Optionally set defaults, then only overwrite specified options.
retval = tcsetattr( self->fd, TCSAFLUSH, options );
}
if( -1 == retval ) {
perror( "tcsetattr()" );
fprintf( stderr, "trouble setting termios attributes\n" );
fprintf( stderr, "...attempting to continue\n" );
}
return retval;
}
int r2_serial_port_set_baud_rate( struct r2_serial_port * self,
speed_t baud_rate )
{
struct termios options;
if( -1 == tcgetattr( self->fd, &options ) ) {
perror("tcgetattr()");
return -1;
}
if( baud_rate != cfgetispeed( &options ) ) {
if( -1 == cfsetispeed( &options, baud_rate ) ) {
perror("cfsetispeed()");
return -1;
}
}
if( baud_rate != cfgetospeed( &options ) ) {
if( -1 == cfsetospeed( &options, baud_rate ) ) {
perror("cfsetospeed()");
return -1;
}
}
if( -1 == tcsetattr( self->fd, TCSAFLUSH, &options ) ) {
perror("tcsetattr()");
return -1;
}
return 0;
}
int r2_serial_port_set_vmin_vtime(struct r2_serial_port * self, int vmin,
int vtime)
{
struct termios tio;
if (-1 == tcgetattr(self->fd, &tio)) {
perror("tcgetattr");
return -1;
}
tio.c_cc[VMIN] = vmin;
tio.c_cc[VTIME] = vtime;
if (-1 == tcsetattr(self->fd, TCSANOW, &tio)) {
perror("tcgetattr");
return -1;
}
return 1;
}
int r2_serial_port_set_nonblocking(struct r2_serial_port * self)
{
return r2_serial_port_set_vmin_vtime(self, 0, 0);
}
#endif // R2_SERIAL_PORT_I