summaryrefslogtreecommitdiff
path: root/altoslib/AltosLink.java
diff options
context:
space:
mode:
authorBdale Garbee <bdale@gag.com>2012-09-12 20:01:22 -0600
committerBdale Garbee <bdale@gag.com>2012-09-12 20:01:22 -0600
commit3b612efcd1dddc6a3d59012f7ed57754b1f798c2 (patch)
tree18d50713491ef96c5c127a309f870efb6c33f98d /altoslib/AltosLink.java
parente076773c1693e2a62bb828dee71c04c20dbab0a5 (diff)
parent01eb36408d7e0e826b431fcc1d3b2deb23607e0b (diff)
Merge branch 'new-debian' into debian
Conflicts: ChangeLog debian/altos.install debian/changelog debian/control debian/copyright debian/dirs debian/docs debian/menu debian/rules src/Makefile
Diffstat (limited to 'altoslib/AltosLink.java')
-rw-r--r--altoslib/AltosLink.java367
1 files changed, 367 insertions, 0 deletions
diff --git a/altoslib/AltosLink.java b/altoslib/AltosLink.java
new file mode 100644
index 00000000..6d510563
--- /dev/null
+++ b/altoslib/AltosLink.java
@@ -0,0 +1,367 @@
+/*
+ * Copyright © 2011 Keith Packard <keithp@keithp.com>
+ *
+ * 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 org.altusmetrum.AltosLib;
+
+import java.io.*;
+import java.util.concurrent.*;
+import java.util.*;
+
+public abstract class AltosLink implements Runnable {
+
+ public final static int ERROR = -1;
+ public final static int TIMEOUT = -2;
+
+ public abstract int getchar();
+ public abstract void print(String data);
+ public abstract void close();
+
+ public static boolean debug = false;
+ public static void set_debug(boolean in_debug) { debug = in_debug; }
+ LinkedList<String> pending_output = new LinkedList<String>();
+
+ public LinkedList<LinkedBlockingQueue<AltosLine>> monitors = new LinkedList<LinkedBlockingQueue<AltosLine>> ();;
+ public LinkedBlockingQueue<AltosLine> reply_queue = new LinkedBlockingQueue<AltosLine>();
+
+ public void add_monitor(LinkedBlockingQueue<AltosLine> q) {
+ set_monitor(true);
+ monitors.add(q);
+ }
+
+ public void remove_monitor(LinkedBlockingQueue<AltosLine> q) {
+ monitors.remove(q);
+ if (monitors.isEmpty())
+ set_monitor(false);
+ }
+
+ public void printf(String format, Object ... arguments) {
+ String line = String.format(format, arguments);
+ if (debug)
+ pending_output.add(line);
+ print(line);
+ }
+
+ public String get_reply_no_dialog(int timeout) throws InterruptedException, TimeoutException {
+ flush_output();
+ AltosLine line = reply_queue.poll(timeout, TimeUnit.MILLISECONDS);
+ if (line != null)
+ return line.line;
+ return null;
+ }
+
+ public String get_reply() throws InterruptedException {
+ return get_reply(5000);
+ }
+
+
+ public abstract boolean can_cancel_reply();
+ public abstract boolean show_reply_timeout();
+ public abstract void hide_reply_timeout();
+
+ public boolean reply_abort;
+ public int in_reply;
+
+ boolean reply_timeout_shown = false;
+
+ private boolean check_reply_timeout() {
+ if (!reply_timeout_shown)
+ reply_timeout_shown = show_reply_timeout();
+ return reply_abort;
+ }
+
+ private void cleanup_reply_timeout() {
+ if (reply_timeout_shown) {
+ reply_timeout_shown = false;
+ hide_reply_timeout();
+ }
+ }
+
+
+ public void run () {
+ int c;
+ byte[] line_bytes = null;
+ int line_count = 0;
+
+ try {
+ for (;;) {
+ c = getchar();
+ if (Thread.interrupted()) {
+ if (debug)
+ System.out.printf("INTERRUPTED\n");
+ break;
+ }
+ if (c == ERROR) {
+ if (debug)
+ System.out.printf("ERROR\n");
+ add_telem (new AltosLine());
+ add_reply (new AltosLine());
+ break;
+ }
+ if (c == TIMEOUT) {
+ if (debug)
+ System.out.printf("TIMEOUT\n");
+ continue;
+ }
+ if (c == '\r')
+ continue;
+ synchronized(this) {
+ if (c == '\n') {
+ if (line_count != 0) {
+ add_bytes(line_bytes, line_count);
+ line_count = 0;
+ }
+ } else {
+ if (line_bytes == null) {
+ line_bytes = new byte[256];
+ } else if (line_count == line_bytes.length) {
+ byte[] new_line_bytes = new byte[line_count * 2];
+ System.arraycopy(line_bytes, 0, new_line_bytes, 0, line_count);
+ line_bytes = new_line_bytes;
+ }
+ line_bytes[line_count] = (byte) c;
+ line_count++;
+ }
+ }
+ }
+ } catch (InterruptedException e) {
+ }
+ }
+
+ public String get_reply(int timeout) throws InterruptedException {
+ boolean can_cancel = can_cancel_reply();
+ String reply = null;
+
+ if (!can_cancel && remote)
+ System.out.printf("Uh-oh, reading remote serial device from swing thread\n");
+
+ if (remote && can_cancel)
+ timeout = 500;
+ try {
+ ++in_reply;
+
+ flush_output();
+
+ reply_abort = false;
+ reply_timeout_shown = false;
+ for (;;) {
+ AltosLine line = reply_queue.poll(timeout, TimeUnit.MILLISECONDS);
+ if (line != null) {
+ cleanup_reply_timeout();
+ reply = line.line;
+ break;
+ }
+ if (!remote || !can_cancel || check_reply_timeout()) {
+ reply = null;
+ break;
+ }
+ }
+ } finally {
+ --in_reply;
+ }
+ return reply;
+ }
+
+ public void add_telem(AltosLine line) throws InterruptedException {
+ for (int e = 0; e < monitors.size(); e++) {
+ LinkedBlockingQueue<AltosLine> q = monitors.get(e);
+ q.put(line);
+ }
+ }
+
+ public void add_reply(AltosLine line) throws InterruptedException {
+ reply_queue.put (line);
+ }
+
+ public void abort_reply() {
+ try {
+ add_telem (new AltosLine());
+ add_reply (new AltosLine());
+ } catch (InterruptedException e) {
+ }
+ }
+
+ public void add_string(String line) throws InterruptedException {
+ if (line.startsWith("TELEM") || line.startsWith("VERSION") || line.startsWith("CRC")) {
+ add_telem(new AltosLine(line));
+ } else {
+ add_reply(new AltosLine(line));
+ }
+ }
+
+ public void add_bytes(byte[] bytes, int len) throws InterruptedException {
+ String line;
+ try {
+ line = new String(bytes, 0, len, "UTF-8");
+ } catch (UnsupportedEncodingException ue) {
+ line = "";
+ for (int i = 0; i < len; i++)
+ line = line + bytes[i];
+ }
+ if (debug)
+ System.out.printf("\t\t\t\t\t%s\n", line);
+ add_string(line);
+ }
+
+ public void flush_output() {
+ for (String s : pending_output)
+ System.out.print(s);
+ pending_output.clear();
+ }
+
+ public void flush_input(int timeout) throws InterruptedException {
+ flush_output();
+ boolean got_some;
+
+ do {
+ Thread.sleep(timeout);
+ got_some = !reply_queue.isEmpty();
+ reply_queue.clear();
+ } while (got_some);
+ }
+
+
+ public void flush_input() throws InterruptedException {
+ if (remote)
+ flush_input(500);
+ else
+ flush_input(100);
+ }
+
+
+ /*
+ * Various command-level operations on
+ * the link
+ */
+ public boolean monitor_mode = false;
+ public int telemetry = AltosLib.ao_telemetry_standard;
+ public double frequency;
+ AltosConfigData config_data;
+
+ private int telemetry_len() {
+ return AltosLib.telemetry_len(telemetry);
+ }
+
+ private void set_radio_freq(int frequency) {
+ if (monitor_mode)
+ printf("m 0\nc F %d\nm %x\n",
+ frequency, telemetry_len());
+ else
+ printf("c F %d\n", frequency);
+ flush_output();
+ }
+
+ public void set_radio_frequency(double frequency,
+ boolean has_frequency,
+ boolean has_setting,
+ int cal) {
+ if (debug)
+ System.out.printf("set_radio_frequency %7.3f (freq %b) (set %b) %d\n", frequency, has_frequency, has_setting, cal);
+ if (frequency == 0)
+ return;
+ if (has_frequency)
+ set_radio_freq((int) Math.floor (frequency * 1000));
+ else if (has_setting)
+ set_radio_setting(AltosConvert.radio_frequency_to_setting(frequency, cal));
+ else
+ set_channel(AltosConvert.radio_frequency_to_channel(frequency));
+ }
+
+ public void set_radio_frequency(double in_frequency) throws InterruptedException, TimeoutException {
+ frequency = in_frequency;
+ config_data();
+ set_radio_frequency(frequency,
+ config_data.radio_frequency != 0,
+ config_data.radio_setting != 0,
+ config_data.radio_calibration);
+ }
+
+ public void set_telemetry(int in_telemetry) {
+ telemetry = in_telemetry;
+ if (monitor_mode)
+ printf("m 0\nm %x\n", telemetry_len());
+ flush_output();
+ }
+
+ public void set_monitor(boolean monitor) {
+ monitor_mode = monitor;
+ if (monitor)
+ printf("m %x\n", telemetry_len());
+ else
+ printf("m 0\n");
+ flush_output();
+ }
+
+ private void set_channel(int channel) {
+ if (monitor_mode)
+ printf("m 0\nc r %d\nm %x\n",
+ channel, telemetry_len());
+ else
+ printf("c r %d\n", channel);
+ flush_output();
+ }
+
+ private void set_radio_setting(int setting) {
+ if (monitor_mode)
+ printf("m 0\nc R %d\nm %x\n",
+ setting, telemetry_len());
+ else
+ printf("c R %d\n", setting);
+ flush_output();
+ }
+
+ public AltosConfigData config_data() throws InterruptedException, TimeoutException {
+ if (config_data == null)
+ config_data = new AltosConfigData(this);
+ return config_data;
+ }
+
+ public void set_callsign(String callsign) {
+ printf ("c c %s\n", callsign);
+ flush_output();
+ }
+
+ public boolean remote;
+ public int serial;
+ public String name;
+
+ public void start_remote() throws TimeoutException, InterruptedException {
+ if (debug)
+ System.out.printf("start remote %7.3f\n", frequency);
+ if (frequency == 0.0)
+ frequency = AltosPreferences.frequency(serial);
+ set_radio_frequency(frequency);
+ set_callsign(AltosPreferences.callsign());
+ printf("p\nE 0\n");
+ flush_input();
+ remote = true;
+ }
+
+ public void stop_remote() throws InterruptedException {
+ if (debug)
+ System.out.printf("stop remote\n");
+ try {
+ flush_input();
+ } finally {
+ printf ("~\n");
+ flush_output();
+ }
+ remote = false;
+ }
+
+ public AltosLink() {
+ }
+}