test/src/FeedNMEA.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 /*
  25  * This program creates a pseudo-TTY symlinked to /tmp/nmea, and feeds
  26  * NMEA data read from stdin to it.  It is useful to feed WINE with
  27  * it: symlink ~/.wine/dosdevices/com1 to /tmp/nmea, and configure
  28  * "COM1" in XCSoar.
  29  */
  30
  31 #include "DebugPort.hpp"
  32 #include "Device/Port/Port.hpp"
  33 #include "Device/Port/ConfiguredPort.hpp"
  34 #include "Profile/DeviceConfig.hpp"
  35 #include "OS/Args.hpp"
  36 #include "OS/Sleep.h"
  37 #include "Operation/ConsoleOperationEnvironment.hpp"
  38 #include "IO/Async/GlobalIOThread.hpp"
  39 #include "IO/DataHandler.hpp"
  40
  41 #include <stdio.h>
  42 #include <stdlib.h>
  43
  44 class MyHandler : public DataHandler {
  45 public:
  46   virtual void DataReceived(const void *data, size_t length) {
  47     fwrite(data, 1, length, stdout);
  48   }
  49 };
  50
  51 int
  52 main(int argc, char **argv)
  53 {
  54   Args args(argc, argv, "PORT BAUD");
  55   const DeviceConfig config = ParsePortArgs(args);
  56   args.ExpectEnd();
  57
  58   InitialiseIOThread();
  59
  60   MyHandler handler;
  61   Port *port = OpenPort(config, handler);
  62   if (port == NULL) {
  63     fprintf(stderr, "Failed to open COM port\n");
  64     return EXIT_FAILURE;
  65   }
  66
  67   /* turn off output buffering */
  68   setvbuf(stdout, NULL, _IONBF, 0);
  69
  70   if (!port->StartRxThread()) {
  71     delete port;
  72     fprintf(stderr, "Failed to start the port thread\n");
  73     return EXIT_FAILURE;
  74   }
  75
  76   ConsoleOperationEnvironment env;
  77
  78   char stamp[6] = "";
  79
  80   char line[1024];
  81   while (fgets(line, sizeof(line), stdin) != NULL) {
  82     if (memcmp(line, "$GP", 3) == 0 &&
  83         (memcmp(line + 3, "GGA", 3) == 0 ||
  84          memcmp(line + 3, "RMC", 3) == 0) &&
  85         line[6] == ',' &&
  86         strncmp(stamp, line + 7, sizeof(stamp)) != 0) {
  87       /* the time stamp has changed - sleep for one second */
  88       Sleep(1000);
  89       strncpy(stamp, line + 7, sizeof(stamp));
  90     }
  91
  92     if (!port->FullWriteString(line, env, 1000)) {
  93       fprintf(stderr, "Failed to write to port\n");
  94       delete port;
  95       return EXIT_FAILURE;
  96     }
  97   }
  98
  99   delete port;
 100   DeinitialiseIOThread();
 101   return EXIT_SUCCESS;
 102 }