namespace gps {
// For a list of dbus services, look in /etc/dbus-1/system.d/
-public class GPS: zavai.Service
+public class GPS: zavai.ScriptService
{
protected libgps.data_t data;
protected IOChannel gpsfd = null;
{
Object(name: "gps");
data = libgps.data_t();
+ started = script_status();
}
public int fix_status() { return old_fix_status; }
protected bool on_input_data(IOChannel source, IOCondition condition)
{
- while (libgps.waiting(ref data))
+ int res = libgps.poll(ref data);
+ if (res != 0)
+ zavai.log.error(libgps.errstr(res));
+
+ if (data.status != old_fix_status)
+ {
+ fix_status_changed(data.status);
+ old_fix_status = data.status;
+ }
+
+ uint cur_time = (uint)data.fix.time;
+ if (data.status != libgps.STATUS_NO_FIX && old_time != cur_time)
{
- int res = libgps.poll(ref data);
- if (res != 0)
- zavai.log.error(libgps.errstr(res));
-
- if (data.status != old_fix_status)
- {
- fix_status_changed(data.status);
- old_fix_status = data.status;
- }
-
- uint cur_time = (uint)data.fix.time;
- if (data.status != libgps.STATUS_NO_FIX && old_time != cur_time)
- {
- time_changed(cur_time);
- old_time = cur_time;
- }
-
- double lat = (data.status == libgps.STATUS_NO_FIX ? 1000 : data.fix.latitude);
- double lon = (data.status == libgps.STATUS_NO_FIX ? 1000 : data.fix.longitude);
- if (lat != old_lat || lon != old_lon)
- pos_changed();
-
- /*
- stderr.printf("GPSMSG %d %d\n", (int)data.set, data.status);
- stderr.printf("SATUSED %d\n", data.satellites_used);
- stderr.printf("SWT %f\n", data.skyview_time);
- stderr.printf("SATVIS %d\n", data.satellites_visible);
- for (int i = 0; i < data.satellites_visible; ++i)
- {
- stderr.printf("PRN %d ELE %d AZI %d SS %f\n",
- data.PRN[i], data.elevation[i], data.azimuth[i], data.ss[i]);
- }
- */
+ time_changed(cur_time);
+ old_time = cur_time;
}
+
+ double lat = (data.status == libgps.STATUS_NO_FIX ? 1000 : data.fix.latitude);
+ double lon = (data.status == libgps.STATUS_NO_FIX ? 1000 : data.fix.longitude);
+ if (lat != old_lat || lon != old_lon)
+ pos_changed();
+
+ /*
+ stderr.printf("GPSMSG %d %d\n", (int)data.set, data.status);
+ stderr.printf("SATUSED %d\n", data.satellites_used);
+ stderr.printf("SWT %f\n", data.skyview_time);
+ stderr.printf("SATVIS %d\n", data.satellites_visible);
+ for (int i = 0; i < data.satellites_visible; ++i)
+ {
+ stderr.printf("PRN %d ELE %d AZI %d SS %f\n",
+ data.PRN[i], data.elevation[i], data.azimuth[i], data.ss[i]);
+ }
+ */
return true;
}
{
if (started) return;
- try {
- // Then run our own script
- zavai.app.run_script(zavai.config.homedir + "/gps start");
- } catch (Error e) {
- zavai.log.error("Running " + zavai.config.homedir + "/gps start: " + e.message);
- return;
- }
+ if (!script_start()) return;
- int res = libgps.open_r("localhost", "gpsd", ref data);
+ zavai.log.info("Connecting to gpsd at " + config.gpsd_host + ":" + config.gpsd_port);
+ int res = libgps.open_r(config.gpsd_host, config.gpsd_port, ref data);
if (res != 0)
{
zavai.log.error(libgps.errstr(res));
return;
}
- res = libgps.send(ref data, "?SKY;");
+ //res = libgps.send(ref data, "?SKY;");
//res = libgps.send(ref data, "?WATCH;");
//if (res != 0) zavai.log.error(libgps.errstr(res));
if (res != 0)
zavai.log.error(libgps.errstr(res));
- try {
- zavai.app.run_script(zavai.config.homedir + "/gps stop");
- } catch (Error e) {
- zavai.log.error("Running device stop gps: " + e.message);
- }
+ script_stop();
if (old_fix_status != libgps.STATUS_NO_FIX)
{
}
}
-public class Position : zavai.Service
-{
- dynamic DBus.Object position;
-
- public signal void position_changed(int fields, int tstamp, double lat, double lon, double alt);
-
- public Position()
- {
- Object(name: "gps.position");
- position = zavai.registry.sbus.get_object(
- "org.freesmartphone.ogpsd",
- "/org/freedesktop/Gypsy",
- "org.freedesktop.Gypsy.Position");
- }
-
- public void on_position_changed(dynamic DBus.Object pos, int fields, int tstamp, double lat, double lon, double alt)
- {
- zavai.log.info("gps position: position changed");
- position_changed(fields, tstamp, lat, lon, alt);
- }
-
- public override void start()
- {
- if (started) return;
- zavai.log.info("Starting GPS position tracking");
- gps.request("gps.position");
- position.PositionChanged += on_position_changed;
- base.start();
- }
-
- public override void stop()
- {
- if (!started) return;
- zavai.log.info("Stopping GPS position tracking");
- position.PositionChanged -= on_position_changed;
- gps.release("gps.position");
- base.stop();
- }
-}
-
-// # def wait_for_fix(self, callback):
-// # status = self.gps.GetFixStatus()
-// # if status in [2, 3]:
-// # zavai.info("We already have a fix, good.")
-// # callback()
-// # return True
-// # else:
-// # zavai.info("Waiting for a fix...")
-// # self.waiting_for_fix = callback
-// # self.bus.add_signal_receiver(
-// # self.on_fix_status_changed, 'FixStatusChanged', 'org.freedesktop.Gypsy.Device',
-// # 'org.freesmartphone.ogpsd', '/org/freedesktop/Gypsy')
-// # return False
-// #
// # def start_recording(self):
// # if self.gps_monitor:
// # self.gps_monitor.stop()
// Write GPX track and waypoint files
public class GPX : Service
{
- public bool tracking {
- get { return trk != null; }
- set {}
- }
- public signal void tracking_changed(bool tracking);
-
- FileStream trk = null;
- FileStream wpt = null;
- int wpt_seq = 1;
- bool last_valid = false;
- int last_fields;
- time_t last_tstamp;
- double last_lat;
- double last_lon;
- double last_alt;
-
- public GPX()
- {
- Object(name: "gps.gpx");
- }
-
- public override void start()
- {
- if (!started)
- {
- log.info("Starting GPX trace subsystem");
- position.request("gps.gpx");
- position.position_changed += on_position_changed;
- base.start();
- }
- }
-
- public override void stop()
- {
- if (started)
- {
- log.info("Stopping GPX trace subsystem");
- position.release("gps.gpx");
- position.position_changed -= on_position_changed;
- stop_track();
- base.stop();
- }
- }
-
- public void on_position_changed(Position pos, int fields, int tstamp, double lat, double lon, double alt)
- {
- last_fields = fields;
- last_tstamp = tstamp;
- last_lat = lat;
- last_lon = lon;
- last_alt = alt;
- last_valid = true;
- trackpoint();
- }
-
- public void start_track(time_t tstamp = 0, string? basename = null)
- {
- string fname;
- if (basename != null)
- fname = basename;
- else
- {
- time_t now = tstamp == 0 ? time_t() : tstamp;
-
- // Compute basename for output files
- var t = Time.local(now);
- char[] res = new char[25];
- t.strftime(res, "%Y-%m-%d-%H-%M-%S");
- fname = zavai.config.homedir + "/" + (string)res;
- }
-
- trk = FileStream.open(fname + "-trk.gpx", "wt");
- trk.puts("<?xml version=\"1.0\" encoding=\"UTF-8\"?>");
- trk.puts(" <gpx");
- trk.puts(" version=\"1.0\"");
- trk.printf(" creator=\"zavai %s\"\n", zavai.config.version);
- trk.puts(" xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\"");
- trk.puts(" xmlns=\"http://www.topografix.com/GPX/1/0\"");
- trk.puts(" xsi:schemaLocation=\"http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd\">");
- trk.puts(" <trk>");
- trk.puts(" <trkseg>");
-
- wpt = FileStream.open(fname + "-wpt.gpx", "wt");
- wpt.puts("<?xml version=\"1.0\" encoding=\"UTF-8\"?>");
- wpt.puts(" <gpx");
- wpt.puts(" version=\"1.0\"");
- wpt.printf(" creator=\"zavai %s\"", zavai.config.version);
- wpt.puts(" xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\"");
- wpt.puts(" xmlns=\"http://www.topografix.com/GPX/1/0\"");
- wpt.puts(" xsi:schemaLocation=\"http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd\">");
-
- wpt_seq = 1;
- tracking_changed(true);
- }
-
- public void stop_track()
- {
- if (trk != null)
- {
- trk.puts("</trkseg></trk></gpx>");
- trk.flush();
- trk = null;
- }
- if (wpt != null)
- {
- wpt.puts("</gpx>");
- wpt.flush();
- wpt = null;
- }
- last_valid = false;
- tracking_changed(false);
- }
-
- // Mark a track point
- public void trackpoint()
- {
- if (!last_valid) return;
- if (trk == null)
- start_track(last_tstamp);
-
- trk.printf("<trkpt lat=\"%f\" lon=\"%f\">\n", last_lat, last_lon);
- var t = Time.local(last_tstamp);
- char[] ts = new char[25];
- t.strftime(ts, "%Y-%m-%dT%H:%M:%SZ");
- trk.printf(" <time>%s</time>\n", (string)ts);
- trk.printf(" <ele>%f</ele>\n", last_alt);
- // if course is not None: print >>self.trk, " <course>%f</course>" % course
- // if speed is not None: print >>self.trk, " <speed>%f</speed>" % speed
- // if fix is not None: print >>self.trk, " <fix>%f</fix>" % fix
- // if hdop is not None: print >>self.trk, " <hdop>%f</hdop>" % hdop
- trk.puts("</trkpt>");
- }
-
- // Mark a waypoint
- public void waypoint(string? name = null)
- {
- if (!last_valid) return;
- if (wpt == null)
- start_track(last_tstamp);
-
- string wptname;
- if (name == null)
- {
- wptname = "wpt_%d".printf(wpt_seq);
- wpt_seq += 1;
- } else {
- wptname = name;
- }
-
- wpt.printf("<wpt lat=\"%f\" lon=\"%f\">\n", last_lat, last_lon);
- wpt.printf(" <name>%s</name>\n", wptname);
- var t = Time.local(last_tstamp);
- char[] ts = new char[25];
- t.strftime(ts, "%Y-%m-%dT%H:%M:%SZ");
- wpt.printf(" <time>%s</time>\n", (string)ts);
- wpt.printf(" <ele>%f</ele>\n", last_alt);
- wpt.puts("</wpt>");
- }
+ protected uint wpt_seq = 0;
+ protected zavai.log.Log log = null;
+
+ public GPX()
+ {
+ Object(name: "gps.gpx");
+ }
+
+ public override void start()
+ {
+ if (!started)
+ {
+ log = zavai.log.log.start("track", "GPS track");
+ base.start();
+ }
+ }
+
+ public override void stop()
+ {
+ if (started)
+ {
+ zavai.log.log.end(log);
+ log = null;
+ base.stop();
+ }
+ }
+
+ // Mark a waypoint
+ public void waypoint(string? name = null)
+ {
+ if (log == null) return;
+
+ string wptname;
+ if (name == null)
+ {
+ wptname = "wpt_%u".printf(wpt_seq);
+ wpt_seq += 1;
+ } else {
+ wptname = name;
+ }
+
+ log.add(wptname);
+ }
}
public zavai.gps.GPS gps = null;
-public zavai.gps.Position position = null;
public zavai.gps.GPX gpx = null;
public void init()
{
gps = new GPS();
- position = new Position();
gpx = new GPX();
}
ToastFreeware / gregoa / zavai.git / blobdiff