src/Network/fg_serial.cxx

   1 // fg_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 <Include/compiler.h>
  25
  26 #include STL_STRING
  27
  28 #include <Debug/logstream.hxx>
  29 #include <Aircraft/aircraft.hxx>
  30 #include <Serial/serial.hxx>
  31
  32 #include "fg_serial.hxx"
  33
  34 FG_USING_STD(string);
  35
  36
  37 FGSerial::FGSerial() :
  38     save_len(0)
  39 {
  40 }
  41
  42
  43 FGSerial::~FGSerial() {
  44 }
  45
  46
  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 );
  51         return false;
  52     }
  53
  54     // cout << "fd = " << port.fd << endl;
  55
  56     if ( ! port.set_baud( atoi( baud.c_str() ) ) ) {
  57         FG_LOG( FG_IO, FG_ALERT, "Error setting baud: " << baud );
  58         return false;
  59     }
  60
  61     return true;
  62 }
  63
  64
  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.
  68
  69 int FGSerial::read( char *buf, int length ) {
  70     int result;
  71
  72     // read a chunk, keep in the save buffer until we have the
  73     // requested amount read
  74
  75     char *buf_ptr = save_buf + save_len;
  76     result = port.read_port( buf_ptr, length - save_len );
  77
  78     if ( result + save_len == length ) {
  79         strncpy( buf, save_buf, length );
  80         save_len = 0;
  81
  82         return length;
  83     }
  84
  85     return 0;
  86 }
  87
  88
  89 // read data from port
  90 int FGSerial::readline( char *buf, int length ) {
  91     int result;
  92
  93     // read a chunk, keep in the save buffer until we have the
  94     // requested amount read
  95
  96     char *buf_ptr = save_buf + save_len;
  97     result = port.read_port( buf_ptr, FG_MAX_MSG_SIZE - save_len );
  98     save_len += result;
  99
 100     // look for the end of line in save_buf
 101     int i;
 102     for ( i = 0; i < save_len && save_buf[i] != '\n'; ++i );
 103     if ( save_buf[i] == '\n' ) {
 104         result = i + 1;
 105     } else {
 106         // no end of line yet
 107         return 0;
 108     }
 109
 110     // we found an end of line
 111
 112     // copy to external buffer
 113     strncpy( buf, save_buf, result );
 114     buf[result] = '\0';
 115     cout << "fg_serial line = " << buf << endl;
 116
 117     // shift save buffer
 118     for ( i = result; i < save_len; ++i ) {
 119         save_buf[ i - result ] = save_buf[i];
 120     }
 121     save_len -= result;
 122
 123     return result;
 124 }
 125
 126
 127 // write data to port
 128 int FGSerial::write( char *buf, int length ) {
 129     int result = port.write_port( buf, length );
 130
 131     if ( result != length ) {
 132         FG_LOG( FG_IO, FG_ALERT, "Error writing data: " << device );
 133     }
 134
 135     return result;
 136 }
 137
 138
 139 // close the port
 140 bool FGSerial::close() {
 141     if ( ! port.close_port() ) {
 142         return false;
 143     }
 144
 145     return true;
 146 }