test/src/FeedVega.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 "DebugPort.hpp"
  25 #include "Device/Port/Port.hpp"
  26 #include "Device/Port/ConfiguredPort.hpp"
  27 #include "Profile/DeviceConfig.hpp"
  28 #include "OS/Args.hpp"
  29 #include "OS/Sleep.h"
  30 #include "Operation/ConsoleOperationEnvironment.hpp"
  31 #include "IO/Async/GlobalIOThread.hpp"
  32 #include "IO/DataHandler.hpp"
  33
  34 #include <stdio.h>
  35 #include <stdlib.h>
  36
  37 class MyHandler : public DataHandler {
  38 public:
  39   virtual void DataReceived(const void *data, size_t length) {
  40     fwrite(data, 1, length, stdout);
  41   }
  42 };
  43
  44 int
  45 main(int argc, char **argv)
  46 {
  47   Args args(argc, argv, "PORT BAUD");
  48   const DeviceConfig config = ParsePortArgs(args);
  49   args.ExpectEnd();
  50
  51   InitialiseIOThread();
  52
  53   MyHandler handler;
  54   Port *port = OpenPort(config, handler);
  55   if (port == NULL) {
  56     fprintf(stderr, "Failed to open COM port\n");
  57     return EXIT_FAILURE;
  58   }
  59
  60   /* turn off output buffering */
  61   setvbuf(stdout, NULL, _IONBF, 0);
  62
  63   if (!port->StartRxThread()) {
  64     delete port;
  65     fprintf(stderr, "Failed to start the port thread\n");
  66     return EXIT_FAILURE;
  67   }
  68
  69   ConsoleOperationEnvironment env;
  70
  71   unsigned long last_stamp = -1;
  72   char line[1024];
  73   while (fgets(line, sizeof(line), stdin) != NULL) {
  74     char *endptr;
  75     unsigned long current_stamp = strtoul(line, &endptr, 10);
  76     if (endptr == line || *endptr != ' ' || endptr[1] != '<')
  77       continue;
  78
  79     char *start = endptr + 2;
  80     char *end = strchr(start, '>');
  81     if (end == NULL)
  82       continue;
  83
  84     *end++ = '\n';
  85     *end = 0;
  86
  87     if (current_stamp > last_stamp) {
  88       unsigned long delta_t = std::min(current_stamp - last_stamp, 1000ul);
  89       Sleep(delta_t);
  90     }
  91
  92     last_stamp = current_stamp;
  93
  94     if (!port->FullWrite(start, end - start, env, 1000)) {
  95       fprintf(stderr, "Failed to write to port\n");
  96       delete port;
  97       return EXIT_FAILURE;
  98
  99     }
 100   }
 101
 102   delete port;
 103   DeinitialiseIOThread();
 104   return EXIT_SUCCESS;
 105 }