src/Device/Internal.cpp

   1 /*
   2 Copyright_License {
   3
   4   XCSoar Glide Computer - http://www.xcsoar.org/
   5   Copyright (C) 2000-2013 The XCSoar Project
   6   A detailed list of copyright holders can be found in the file "AUTHORS".
   7
   8   This program is free software; you can redistribute it and/or
   9   modify it under the terms of the GNU General Public License
  10   as published by the Free Software Foundation; either version 2
  11   of the License, or (at your option) any later version.
  12
  13   This program is distributed in the hope that it will be useful,
  14   but WITHOUT ANY WARRANTY; without even the implied warranty of
  15   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16   GNU General Public License for more details.
  17
  18   You should have received a copy of the GNU General Public License
  19   along with this program; if not, write to the Free Software
  20   Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  21 }
  22 */
  23
  24 #include "Device/Internal.hpp"
  25
  26 #include "Port/Port.hpp"
  27 #include "NMEA/Checksum.hpp"
  28
  29 #include <assert.h>
  30 #include <stdio.h>
  31 #include <string.h>
  32
  33 bool
  34 PortWriteNMEA(Port &port, const char *line, OperationEnvironment &env)
  35 {
  36   assert(line != NULL);
  37
  38   /* reasonable hard-coded timeout; do we need to make this a
  39      parameter? */
  40   const unsigned timeout_ms = 1000;
  41
  42   if (!port.Write('$') ||
  43       !port.FullWrite(line, strlen(line), env, timeout_ms))
  44     return false;
  45
  46   char checksum[16];
  47   sprintf(checksum, "*%02X\r\n", NMEAChecksum(line));
  48   return port.FullWrite(checksum, strlen(checksum), env, timeout_ms);
  49 }