1 // fg_serial.cxx -- Serial I/O routines
3 // Written by Curtis Olson, started November 1999.
5 // Copyright (C) 1999 Curtis L. Olson - curt@flightgear.org
7 // This program is free software; you can redistribute it and/or
8 // modify it under the terms of the GNU General Public License as
9 // published by the Free Software Foundation; either version 2 of the
10 // License, or (at your option) any later version.
12 // This program is distributed in the hope that it will be useful, but
13 // WITHOUT ANY WARRANTY; without even the implied warranty of
14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 // General Public License for more details.
17 // You should have received a copy of the GNU General Public License
18 // along with this program; if not, write to the Free Software
19 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24 #include <Include/compiler.h>
28 #include <Debug/logstream.hxx>
29 #include <Aircraft/aircraft.hxx>
30 #include <Serial/serial.hxx>
32 #include "fg_serial.hxx"
37 FGSerial::FGSerial() :
43 FGSerial::~FGSerial() {
47 // open the serial port based on specified direction
48 bool FGSerial::open( FGProtocol::fgProtocolDir dir ) {
49 if ( ! port.open_port( device ) ) {
50 FG_LOG( FG_IO, FG_ALERT, "Error opening device: " << device );
54 // cout << "fd = " << port.fd << endl;
56 if ( ! port.set_baud( atoi( baud.c_str() ) ) ) {
57 FG_LOG( FG_IO, FG_ALERT, "Error setting baud: " << baud );
65 // Read data from port. If we don't get enough data, save what we did
66 // get in the save buffer and return 0. The save buffer will be
67 // prepended to subsequent reads until we get as much as is requested.
69 int FGSerial::read( char *buf, int length ) {
72 // read a chunk, keep in the save buffer until we have the
73 // requested amount read
75 char *buf_ptr = save_buf + save_len;
76 result = port.read_port( buf_ptr, length - save_len );
78 if ( result + save_len == length ) {
79 strncpy( buf, save_buf, length );
89 // read data from port
90 int FGSerial::readline( char *buf, int length ) {
93 // read a chunk, keep in the save buffer until we have the
94 // requested amount read
96 char *buf_ptr = save_buf + save_len;
97 result = port.read_port( buf_ptr, FG_MAX_MSG_SIZE - save_len );
100 // look for the end of line in save_buf
102 for ( i = 0; i < save_len && save_buf[i] != '\n'; ++i );
103 if ( save_buf[i] == '\n' ) {
106 // no end of line yet
110 // we found an end of line
112 // copy to external buffer
113 strncpy( buf, save_buf, result );
115 cout << "fg_serial line = " << buf << endl;
118 for ( i = result; i < save_len; ++i ) {
119 save_buf[ i - result ] = save_buf[i];
127 // write data to port
128 int FGSerial::write( char *buf, int length ) {
129 int result = port.write_port( buf, length );
131 if ( result != length ) {
132 FG_LOG( FG_IO, FG_ALERT, "Error writing data: " << device );
140 bool FGSerial::close() {
141 if ( ! port.close_port() ) {