git.gag.com Git - fw/altos/blob - src/test/ao_aprs_test.c

   1 /*
   2  * Copyright © 2012 Keith Packard <keithp@keithp.com>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along
  15  * with this program; if not, write to the Free Software Foundation, Inc.,
  16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  17  */
  18
  19 #include <stdio.h>
  20 #include <stdlib.h>
  21 #include <string.h>
  22 #include <stdint.h>
  23 #include <stdarg.h>
  24
  25 #define HAS_GPS 1
  26
  27 #include <ao_telemetry.h>
  28
  29 #define AO_GPS_NUM_SAT_MASK     (0xf << 0)
  30 #define AO_GPS_NUM_SAT_SHIFT    (0)
  31
  32 #define AO_GPS_VALID            (1 << 4)
  33 #define AO_GPS_RUNNING          (1 << 5)
  34 #define AO_GPS_DATE_VALID       (1 << 6)
  35 #define AO_GPS_COURSE_VALID     (1 << 7)
  36
  37 struct ao_telemetry_location ao_gps_data;
  38 struct ao_telemetry_satellite ao_gps_tracking_data;
  39
  40 #define AO_APRS_TEST
  41
  42 typedef int16_t (*ao_radio_fill_func)(uint8_t *buffer, int16_t len);
  43
  44 #define DEBUG 0
  45 #if DEBUG
  46 void
  47 ao_aprs_bit(uint8_t bit)
  48 {
  49         static int      seq = 0;
  50         printf ("%6d %d\n", seq++, bit ? 1 : 0);
  51 }
  52 #else
  53 void
  54 ao_aprs_bit(uint8_t bit)
  55 {
  56         putchar (bit ? 0xc0 : 0x40);
  57 }
  58 #endif
  59
  60 void
  61 ao_radio_send_aprs(ao_radio_fill_func fill);
  62
  63 #include <ao_aprs.c>
  64
  65 /*
  66  * @section copyright_sec Copyright
  67  *
  68  * Copyright (c) 2001-2009 Michael Gray, KD7LMO
  69
  70
  71  *
  72  *
  73  * @section gpl_sec GNU General Public License
  74  *
  75  *  This program is free software; you can redistribute it and/or modify
  76  *  it under the terms of the GNU General Public License as published by
  77  *  the Free Software Foundation; either version 2 of the License, or
  78  *  (at your option) any later version.
  79  *
  80  *  This program is distributed in the hope that it will be useful,
  81  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  82  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  83  *  GNU General Public License for more details.
  84  *
  85  *  You should have received a copy of the GNU General Public License
  86  *  along with this program; if not, write to the Free Software
  87  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  88  *
  89
  90  */
  91
  92 static void
  93 audio_gap(int secs)
  94 {
  95 #if !DEBUG
  96         int     samples = secs * 9600;
  97
  98         while (samples--)
  99                 ao_aprs_bit(0);
 100 #endif
 101 }
 102
 103 // This is where we go after reset.
 104 int main(int argc, char **argv)
 105 {
 106     audio_gap(1);
 107
 108     ao_gps_data.latitude = (45.0 + 28.25 / 60.0) * 10000000;
 109     ao_gps_data.longitude = (-(122 + 44.2649 / 60.0)) * 10000000;
 110     AO_TELEMETRY_LOCATION_SET_ALTITUDE(&ao_gps_data, 84);
 111     ao_gps_data.flags = (AO_GPS_VALID|AO_GPS_RUNNING);
 112
 113     /* Transmit one packet */
 114     ao_aprs_send();
 115
 116     tncBuffer[strlen((char *) tncBuffer) - 2] = '\0';
 117     fprintf(stderr, "packet: %s\n", tncBuffer);
 118
 119     exit(0);
 120 }
 121
 122 void
 123 ao_radio_send_aprs(ao_radio_fill_func fill)
 124 {
 125         int16_t len;
 126         uint8_t done = 0;
 127         uint8_t buf[16], *b, c;
 128         uint8_t bit;
 129
 130         while (!done) {
 131                 len = (*fill)(buf, sizeof (buf));
 132                 if (len < 0) {
 133                         done = 1;
 134                         len = -len;
 135                 }
 136                 b = buf;
 137                 while (len--) {
 138                         c = *b++;
 139                         for (bit = 0; bit < 8; bit++) {
 140                                 ao_aprs_bit(c & 0x80);
 141                                 c <<= 1;
 142                         }
 143                 }
 144         }
 145 }