/* * Copyright © 2010 Keith Packard * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; version 2 of the License. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * General Public License for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. */ package altosui; import java.lang.*; import java.text.*; import altosui.AltosParse; public class AltosGPS { public class AltosGPSSat { int svid; int c_n0; } int nsat; boolean locked; boolean connected; boolean date_valid; double lat; /* degrees (+N -S) */ double lon; /* degrees (+E -W) */ int alt; /* m */ int year; int month; int day; int hour; int minute; int second; int gps_extended; /* has extra data */ double ground_speed; /* m/s */ int course; /* degrees */ double climb_rate; /* m/s */ double hdop; /* unitless? */ int h_error; /* m */ int v_error; /* m */ AltosGPSSat[] cc_gps_sat; /* tracking data */ void ParseGPSTime(String date, String time) throws ParseException { String[] ymd = date.split("-"); if (ymd.length != 3) throw new ParseException("error parsing GPS date " + date + " got " + ymd.length, 0); year = AltosParse.parse_int(ymd[0]); month = AltosParse.parse_int(ymd[1]); day = AltosParse.parse_int(ymd[2]); String[] hms = time.split(":"); if (hms.length != 3) throw new ParseException("Error parsing GPS time " + time + " got " + hms.length, 0); hour = AltosParse.parse_int(hms[0]); minute = AltosParse.parse_int(hms[1]); second = AltosParse.parse_int(hms[2]); } void ClearGPSTime() { year = month = day = 0; hour = minute = second = 0; } public AltosGPS(String[] words, int i) throws ParseException { AltosParse.word(words[i++], "GPS"); nsat = AltosParse.parse_int(words[i++]); AltosParse.word(words[i++], "sat"); connected = false; locked = false; lat = lon = 0; alt = 0; ClearGPSTime(); if ((words[i]).equals("unlocked")) { connected = true; i++; } else if ((words[i]).equals("not-connected")) { i++; } else if (words.length >= 40) { locked = true; connected = true; ParseGPSTime(words[i], words[i+1]); i += 2; lat = AltosParse.parse_coord(words[i++]); lon = AltosParse.parse_coord(words[i++]); alt = AltosParse.parse_int(AltosParse.strip_suffix(words[i++], "m")); ground_speed = AltosParse.parse_double(AltosParse.strip_suffix(words[i++], "m/s(H)")); course = AltosParse.parse_int(AltosParse.strip_suffix(words[i++], "°")); climb_rate = AltosParse.parse_double(AltosParse.strip_suffix(words[i++], "m/s(V)")); hdop = AltosParse.parse_double(AltosParse.strip_suffix(words[i++], "(hdop)")); h_error = AltosParse.parse_int(AltosParse.strip_suffix(words[i++], "(herr)")); v_error = AltosParse.parse_int(AltosParse.strip_suffix(words[i++], "(verr)")); } else { i++; } AltosParse.word(words[i++], "SAT"); int tracking_channels = 0; if (words[i].equals("not-connected")) tracking_channels = 0; else tracking_channels = AltosParse.parse_int(words[i]); i++; cc_gps_sat = new AltosGPS.AltosGPSSat[tracking_channels]; for (int chan = 0; chan < tracking_channels; chan++) { cc_gps_sat[chan] = new AltosGPS.AltosGPSSat(); cc_gps_sat[chan].svid = AltosParse.parse_int(words[i++]); cc_gps_sat[chan].c_n0 = AltosParse.parse_int(words[i++]); } } public void set_latitude(int in_lat) { lat = in_lat / 10.0e7; } public void set_longitude(int in_lon) { lon = in_lon / 10.0e7; } public void set_time(int hour, int minute, int second) { hour = hour; minute = minute; second = second; } public void set_date(int year, int month, int day) { year = year; month = month; day = day; } public void set_flags(int flags) { flags = flags; } public void set_altitude(int altitude) { altitude = altitude; } public void add_sat(int svid, int c_n0) { if (cc_gps_sat == null) { cc_gps_sat = new AltosGPS.AltosGPSSat[1]; } else { AltosGPSSat[] new_gps_sat = new AltosGPS.AltosGPSSat[cc_gps_sat.length + 1]; for (int i = 0; i < cc_gps_sat.length; i++) new_gps_sat[i] = cc_gps_sat[i]; cc_gps_sat = new_gps_sat; } AltosGPS.AltosGPSSat sat = new AltosGPS.AltosGPSSat(); sat.svid = svid; sat.c_n0 = c_n0; cc_gps_sat[cc_gps_sat.length - 1] = sat; } public AltosGPS() { ClearGPSTime(); cc_gps_sat = null; } public AltosGPS(AltosGPS old) { nsat = old.nsat; locked = old.locked; connected = old.connected; lat = old.lat; /* degrees (+N -S) */ lon = old.lon; /* degrees (+E -W) */ alt = old.alt; /* m */ year = old.year; month = old.month; day = old.day; hour = old.hour; minute = old.minute; second = old.second; gps_extended = old.gps_extended; /* has extra data */ ground_speed = old.ground_speed; /* m/s */ course = old.course; /* degrees */ climb_rate = old.climb_rate; /* m/s */ hdop = old.hdop; /* unitless? */ h_error = old.h_error; /* m */ v_error = old.v_error; /* m */ if (old.cc_gps_sat != null) { cc_gps_sat = new AltosGPSSat[old.cc_gps_sat.length]; for (int i = 0; i < old.cc_gps_sat.length; i++) { cc_gps_sat[i] = new AltosGPSSat(); cc_gps_sat[i].svid = old.cc_gps_sat[i].svid; cc_gps_sat[i].c_n0 = old.cc_gps_sat[i].c_n0; } } } }