git.gag.com Git - fw/altos/blob - ao-tools/altosui/Altos.java

   1 /*
   2  * Copyright © 2010 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; version 2 of the License.
   7  *
   8  * This program is distributed in the hope that it will be useful, but
   9  * WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11  * General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License along
  14  * with this program; if not, write to the Free Software Foundation, Inc.,
  15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  16  */
  17
  18 package altosui;
  19
  20 import java.awt.*;
  21 import java.util.*;
  22 import java.text.*;
  23
  24 public class Altos {
  25         /* EEProm command letters */
  26         static final int AO_LOG_FLIGHT = 'F';
  27         static final int AO_LOG_SENSOR = 'A';
  28         static final int AO_LOG_TEMP_VOLT = 'T';
  29         static final int AO_LOG_DEPLOY = 'D';
  30         static final int AO_LOG_STATE = 'S';
  31         static final int AO_LOG_GPS_TIME = 'G';
  32         static final int AO_LOG_GPS_LAT = 'N';
  33         static final int AO_LOG_GPS_LON = 'W';
  34         static final int AO_LOG_GPS_ALT = 'H';
  35         static final int AO_LOG_GPS_SAT = 'V';
  36         static final int AO_LOG_GPS_DATE = 'Y';
  37
  38         /* Added for header fields in eeprom files */
  39         static final int AO_LOG_CONFIG_VERSION = 1000;
  40         static final int AO_LOG_MAIN_DEPLOY = 1001;
  41         static final int AO_LOG_APOGEE_DELAY = 1002;
  42         static final int AO_LOG_RADIO_CHANNEL = 1003;
  43         static final int AO_LOG_CALLSIGN = 1004;
  44         static final int AO_LOG_ACCEL_CAL = 1005;
  45         static final int AO_LOG_RADIO_CAL = 1006;
  46         static final int AO_LOG_MANUFACTURER = 1007;
  47         static final int AO_LOG_PRODUCT = 1008;
  48         static final int AO_LOG_SERIAL_NUMBER = 1009;
  49         static final int AO_LOG_SOFTWARE_VERSION = 1010;
  50
  51         /* Added to flag invalid records */
  52         static final int AO_LOG_INVALID = -1;
  53
  54         /* Flight state numbers and names */
  55         static final int ao_flight_startup = 0;
  56         static final int ao_flight_idle = 1;
  57         static final int ao_flight_pad = 2;
  58         static final int ao_flight_boost = 3;
  59         static final int ao_flight_fast = 4;
  60         static final int ao_flight_coast = 5;
  61         static final int ao_flight_drogue = 6;
  62         static final int ao_flight_main = 7;
  63         static final int ao_flight_landed = 8;
  64         static final int ao_flight_invalid = 9;
  65
  66         static HashMap<String,Integer>  string_to_state = new HashMap<String,Integer>();
  67
  68         static boolean map_initialized = false;
  69
  70         static void initialize_map()
  71         {
  72                 string_to_state.put("startup", ao_flight_startup);
  73                 string_to_state.put("idle", ao_flight_idle);
  74                 string_to_state.put("pad", ao_flight_pad);
  75                 string_to_state.put("boost", ao_flight_boost);
  76                 string_to_state.put("fast", ao_flight_fast);
  77                 string_to_state.put("coast", ao_flight_coast);
  78                 string_to_state.put("drogue", ao_flight_drogue);
  79                 string_to_state.put("main", ao_flight_main);
  80                 string_to_state.put("landed", ao_flight_landed);
  81                 string_to_state.put("invalid", ao_flight_invalid);
  82                 map_initialized = true;
  83         }
  84
  85         static String[] state_to_string = {
  86                 "startup",
  87                 "idle",
  88                 "pad",
  89                 "boost",
  90                 "fast",
  91                 "coast",
  92                 "drogue",
  93                 "main",
  94                 "landed",
  95                 "invalid",
  96         };
  97
  98         static public int state(String state) {
  99                 if (!map_initialized)
 100                         initialize_map();
 101                 if (string_to_state.containsKey(state))
 102                         return string_to_state.get(state);
 103                 return ao_flight_invalid;
 104         }
 105
 106         static public String state_name(int state) {
 107                 if (state < 0 || state_to_string.length <= state)
 108                         return "invalid";
 109                 return state_to_string[state];
 110         }
 111
 112         static final int AO_GPS_VALID = (1 << 4);
 113         static final int AO_GPS_RUNNING = (1 << 5);
 114         static final int AO_GPS_DATE_VALID = (1 << 6);
 115         static final int AO_GPS_NUM_SAT_SHIFT = 0;
 116         static final int AO_GPS_NUM_SAT_MASK = 0xf;
 117
 118         static boolean isspace(int c) {
 119                 switch (c) {
 120                 case ' ':
 121                 case '\t':
 122                         return true;
 123                 }
 124                 return false;
 125         }
 126
 127         static boolean ishex(int c) {
 128                 if ('0' <= c && c <= '9')
 129                         return true;
 130                 if ('a' <= c && c <= 'f')
 131                         return true;
 132                 if ('A' <= c && c <= 'F')
 133                         return true;
 134                 return false;
 135         }
 136
 137         static boolean ishex(String s) {
 138                 for (int i = 0; i < s.length(); i++)
 139                         if (!ishex(s.charAt(i)))
 140                                 return false;
 141                 return true;
 142         }
 143
 144         static int fromhex(int c) {
 145                 if ('0' <= c && c <= '9')
 146                         return c - '0';
 147                 if ('a' <= c && c <= 'f')
 148                         return c - 'a' + 10;
 149                 if ('A' <= c && c <= 'F')
 150                         return c - 'A' + 10;
 151                 return -1;
 152         }
 153
 154         static int fromhex(String s) throws NumberFormatException {
 155                 int c, v = 0;
 156                 for (int i = 0; i < s.length(); i++) {
 157                         c = s.charAt(i);
 158                         if (!ishex(c)) {
 159                                 if (i == 0)
 160                                         throw new NumberFormatException(String.format("invalid hex \"%s\"", s));
 161                                 return v;
 162                         }
 163                         v = v * 16 + fromhex(c);
 164                 }
 165                 return v;
 166         }
 167
 168         static boolean isdec(int c) {
 169                 if ('0' <= c && c <= '9')
 170                         return true;
 171                 return false;
 172         }
 173
 174         static boolean isdec(String s) {
 175                 for (int i = 0; i < s.length(); i++)
 176                         if (!isdec(s.charAt(i)))
 177                                 return false;
 178                 return true;
 179         }
 180
 181         static int fromdec(int c) {
 182                 if ('0' <= c && c <= '9')
 183                         return c - '0';
 184                 return -1;
 185         }
 186
 187         static int fromdec(String s) throws NumberFormatException {
 188                 int c, v = 0;
 189                 int sign = 1;
 190                 for (int i = 0; i < s.length(); i++) {
 191                         c = s.charAt(i);
 192                         if (i == 0 && c == '-') {
 193                                 sign = -1;
 194                         } else if (!isdec(c)) {
 195                                 if (i == 0)
 196                                         throw new NumberFormatException(String.format("invalid number \"%s\"", s));
 197                                 return v;
 198                         } else
 199                                 v = v * 10 + fromdec(c);
 200                 }
 201                 return v * sign;
 202         }
 203 }