1 // sg_serial.cxx -- Serial I/O routines
3 // Written by Curtis Olson, started November 1999.
5 // Copyright (C) 1999 Curtis L. Olson - http://www.flightgear.org/~curt
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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
26 #include <simgear/compiler.h>
30 #include <simgear/debug/logstream.hxx>
31 #include <simgear/serial/serial.hxx>
33 #include "sg_serial.hxx"
38 SGSerial::SGSerial( const string& device_name, const string& baud_rate ) :
41 set_type( sgSerialType );
47 SGSerial::~SGSerial() {
51 // open the serial port based on specified direction
52 bool SGSerial::open( const SGProtocolDir d ) {
55 if ( ! port.open_port( device ) ) {
56 SG_LOG( SG_IO, SG_ALERT, "Error opening device: " << device );
60 // cout << "fd = " << port.fd << endl;
62 if ( ! port.set_baud( std::atoi( baud.c_str() ) ) ) {
63 SG_LOG( SG_IO, SG_ALERT, "Error setting baud: " << baud );
71 // Read data from port. If we don't get enough data, save what we did
72 // get in the save buffer and return 0. The save buffer will be
73 // prepended to subsequent reads until we get as much as is requested.
75 int SGSerial::read( char *buf, int length ) {
78 // read a chunk, keep in the save buffer until we have the
79 // requested amount read
81 char *buf_ptr = save_buf + save_len;
82 result = port.read_port( buf_ptr, length - save_len );
84 if ( result + save_len == length ) {
85 std::strncpy( buf, save_buf, length );
95 // read data from port
96 int SGSerial::readline( char *buf, int length ) {
99 // read a chunk, keep in the save buffer until we have the
100 // requested amount read
102 char *buf_ptr = save_buf + save_len;
103 result = port.read_port( buf_ptr, SG_IO_MAX_MSG_SIZE - save_len );
106 // look for the end of line in save_buf
108 for ( i = 0; i < save_len && save_buf[i] != '\n'; ++i );
109 if ( save_buf[i] == '\n' ) {
112 // no end of line yet
116 // we found an end of line
118 // copy to external buffer
119 std::strncpy( buf, save_buf, result );
121 SG_LOG( SG_IO, SG_INFO, "fg_serial line = " << buf );
124 for ( i = result; i < save_len; ++i ) {
125 save_buf[ i - result ] = save_buf[i];
133 // write data to port
134 int SGSerial::write( const char *buf, const int length ) {
135 int result = port.write_port( buf, length );
137 if ( result != length ) {
138 SG_LOG( SG_IO, SG_WARN, "Error writing data: " << device );
145 // write null terminated string to port
146 int SGSerial::writestring( const char *str ) {
147 int length = std::strlen( str );
148 return write( str, length );
153 bool SGSerial::close() {
154 if ( ! port.close_port() ) {