test/src/FeedFlyNetData.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 "Util/StaticString.hpp"
  25 #include "Math/fixed.hpp"
  26 #include "Time/PeriodClock.hpp"
  27 #include "OS/SocketDescriptor.hpp"
  28 #include "OS/SocketAddress.hpp"
  29
  30 #include <fcntl.h>
  31 #include <unistd.h>
  32 #include <stdio.h>
  33 #include <string.h>
  34 #include <errno.h>
  35 #include <stdlib.h>
  36
  37 int main(int argc, char **argv)
  38 {
  39   // Determine on which TCP port to connect to the server
  40   const char *tcp_port;
  41   if (argc < 2) {
  42     fprintf(stderr, "This program opens a TCP connection to a server which is assumed ");
  43     fprintf(stderr, "to be at 127.0.0.1, and sends artificial FlyNet vario data.\n\n");
  44     fprintf(stderr, "Usage: %s PORT\n", argv[0]);
  45     fprintf(stderr, "Defaulting to port 4353\n");
  46     tcp_port = "4353";
  47   } else {
  48     tcp_port = argv[1];
  49   }
  50
  51   // Convert IP address to binary form
  52   SocketAddress server_address;
  53   if (!server_address.Lookup("127.0.0.1", tcp_port, AF_INET)) {
  54     fprintf(stderr, "Failed to look up address\n");
  55     exit(EXIT_FAILURE);
  56   }
  57
  58   // Create socket for the outgoing connection
  59   SocketDescriptor sock;
  60   if (!sock.CreateTCP()) {
  61     perror("Socket");
  62     exit(EXIT_FAILURE);
  63   }
  64
  65   // Connect to the specified server
  66   if (!sock.Connect(server_address))
  67   {
  68     perror("Connect");
  69     exit(EXIT_FAILURE);
  70   }
  71
  72   PeriodClock start_clock;
  73   start_clock.Update();
  74
  75   PeriodClock pressure_clock;
  76   PeriodClock battery_clock;
  77
  78   fixed pressure = fixed(101300);
  79   unsigned battery_level = 11;
  80   while (true) {
  81     if (pressure_clock.CheckUpdate(48)) {
  82       NarrowString<16> sentence;
  83
  84       int elapsed_ms = start_clock.Elapsed();
  85       fixed elapsed = fixed(elapsed_ms) / 1000;
  86       fixed vario = sin(elapsed / 3) * cos(elapsed / 10) *
  87         cos(elapsed / 20 + fixed(2)) * 3;
  88
  89       fixed pressure_vario = -vario * fixed(12.5);
  90       fixed delta_pressure = pressure_vario * 48 / 1000;
  91       pressure += delta_pressure;
  92
  93       sentence = "_PRS ";
  94       sentence.AppendFormat("%08X", uround(pressure));
  95       sentence += "\n";
  96
  97       sock.Write(sentence.c_str(), sentence.length());
  98     }
  99
 100     if (battery_clock.CheckUpdate(11000)) {
 101       NarrowString<16> sentence;
 102
 103       sentence = "_BAT ";
 104       if (battery_level <= 10)
 105         sentence.AppendFormat("%X", battery_level);
 106       else
 107         sentence += "*";
 108
 109       sentence += "\n";
 110       sock.Write(sentence.c_str(), sentence.length());
 111
 112       if (battery_level == 0)
 113         battery_level = 11;
 114       else
 115         battery_level--;
 116     }
 117   }
 118
 119   return EXIT_SUCCESS;
 120 }