simgear/io/sg_serial.cxx

   1 // sg_serial.cxx -- Serial I/O routines
   2 //
   3 // Written by Curtis Olson, started November 1999.
   4 //
   5 // Copyright (C) 1999  Curtis L. Olson - curt@flightgear.org
   6 //
   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.
  11 //
  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.
  16 //
  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.
  20 //
  21 // $Id$
  22
  23
  24 #include <simgear/compiler.h>
  25
  26 #include STL_STRING
  27
  28 #include <simgear/debug/logstream.hxx>
  29 #include <simgear/serial/serial.hxx>
  30
  31 #include "sg_serial.hxx"
  32
  33 SG_USING_STD(string);
  34
  35
  36 SGSerial::SGSerial( const string& device_name, const string& baud_rate ) :
  37     save_len(0)
  38 {
  39     set_type( sgSerialType );
  40     device = device_name;
  41     baud = baud_rate;
  42 }
  43
  44
  45 SGSerial::~SGSerial() {
  46 }
  47
  48
  49 // open the serial port based on specified direction
  50 bool SGSerial::open( const SGProtocolDir d ) {
  51     set_dir( d );
  52
  53     if ( ! port.open_port( device ) ) {
  54         SG_LOG( SG_IO, SG_ALERT, "Error opening device: " << device );
  55         return false;
  56     }
  57
  58     // cout << "fd = " << port.fd << endl;
  59
  60     if ( ! port.set_baud( atoi( baud.c_str() ) ) ) {
  61         SG_LOG( SG_IO, SG_ALERT, "Error setting baud: " << baud );
  62         return false;
  63     }
  64
  65     return true;
  66 }
  67
  68
  69 // Read data from port.  If we don't get enough data, save what we did
  70 // get in the save buffer and return 0.  The save buffer will be
  71 // prepended to subsequent reads until we get as much as is requested.
  72
  73 int SGSerial::read( char *buf, int length ) {
  74     int result;
  75
  76     // read a chunk, keep in the save buffer until we have the
  77     // requested amount read
  78
  79     char *buf_ptr = save_buf + save_len;
  80     result = port.read_port( buf_ptr, length - save_len );
  81
  82     if ( result + save_len == length ) {
  83         strncpy( buf, save_buf, length );
  84         save_len = 0;
  85
  86         return length;
  87     }
  88
  89     return 0;
  90 }
  91
  92
  93 // read data from port
  94 int SGSerial::readline( char *buf, int length ) {
  95     int result;
  96
  97     // read a chunk, keep in the save buffer until we have the
  98     // requested amount read
  99
 100     char *buf_ptr = save_buf + save_len;
 101     result = port.read_port( buf_ptr, SG_IO_MAX_MSG_SIZE - save_len );
 102     save_len += result;
 103
 104     // look for the end of line in save_buf
 105     int i;
 106     for ( i = 0; i < save_len && save_buf[i] != '\n'; ++i );
 107     if ( save_buf[i] == '\n' ) {
 108         result = i + 1;
 109     } else {
 110         // no end of line yet
 111         return 0;
 112     }
 113
 114     // we found an end of line
 115
 116     // copy to external buffer
 117     strncpy( buf, save_buf, result );
 118     buf[result] = '\0';
 119     SG_LOG( SG_IO, SG_INFO, "fg_serial line = " << buf );
 120
 121     // shift save buffer
 122     for ( i = result; i < save_len; ++i ) {
 123         save_buf[ i - result ] = save_buf[i];
 124     }
 125     save_len -= result;
 126
 127     return result;
 128 }
 129
 130
 131 // write data to port
 132 int SGSerial::write( const char *buf, const int length ) {
 133     int result = port.write_port( buf, length );
 134
 135     if ( result != length ) {
 136         SG_LOG( SG_IO, SG_WARN, "Error writing data: " << device );
 137     }
 138
 139     return result;
 140 }
 141
 142
 143 // write null terminated string to port
 144 int SGSerial::writestring( const char *str ) {
 145     int length = strlen( str );
 146     return write( str, length );
 147 }
 148
 149
 150 // close the port
 151 bool SGSerial::close() {
 152     if ( ! port.close_port() ) {
 153         return false;
 154     }
 155
 156     return true;
 157 }