X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ao-tools%2Faltosui%2FAltosSerial.java;h=6787e0c82de78026566159eda85a1c51e513c770;hp=e84f5b63e4e21c7ca5cdd0cbb0cb90c863383ced;hb=8463ffcaca6bcd31e645aba71c171f548dce96d8;hpb=8f2f38f2a9fb0c106e2c6b60cdc205292ce329ea

diff --git a/ao-tools/altosui/AltosSerial.java b/ao-tools/altosui/AltosSerial.java
index e84f5b63..6787e0c8 100644
--- a/ao-tools/altosui/AltosSerial.java
+++ b/ao-tools/altosui/AltosSerial.java
@@ -26,11 +26,8 @@ import java.io.*;
 import java.util.concurrent.LinkedBlockingQueue;
 import java.util.LinkedList;
 import java.util.Iterator;
-import altosui.AltosSerialMonitor;
-import libaltosJNI.libaltos;
-import libaltosJNI.altos_device;
-import libaltosJNI.SWIGTYPE_p_altos_file;
-import libaltosJNI.SWIGTYPE_p_altos_list;
+
+import libaltosJNI.*;
 
 /*
  * This class reads from the serial port and places each received
@@ -41,10 +38,13 @@ import libaltosJNI.SWIGTYPE_p_altos_list;
 public class AltosSerial implements Runnable {
 
 	SWIGTYPE_p_altos_file altos;
-	LinkedList<LinkedBlockingQueue<String>> monitors;
-	LinkedBlockingQueue<String> reply_queue;
+	LinkedList<LinkedBlockingQueue<AltosLine>> monitors;
+	LinkedBlockingQueue<AltosLine> reply_queue;
 	Thread input_thread;
 	String line;
+	byte[] line_bytes;
+	int line_count;
+	boolean monitor_mode;
 
 	public void run () {
 		int c;
@@ -54,24 +54,50 @@ public class AltosSerial implements Runnable {
 				c = libaltos.altos_getchar(altos, 0);
 				if (Thread.interrupted())
 					break;
-				if (c == -1)
+				if (c == libaltosConstants.LIBALTOS_ERROR) {
+					for (int e = 0; e < monitors.size(); e++) {
+						LinkedBlockingQueue<AltosLine> q = monitors.get(e);
+						q.put(new AltosLine());
+					}
+					reply_queue.put (new AltosLine());
+					break;
+				}
+				if (c == libaltosConstants.LIBALTOS_TIMEOUT)
 					continue;
 				if (c == '\r')
 					continue;
 				synchronized(this) {
 					if (c == '\n') {
-						if (line != "") {
-							if (line.startsWith("VERSION")) {
+						if (line_count != 0) {
+							try {
+								line = new String(line_bytes, 0, line_count, "UTF-8");
+							} catch (UnsupportedEncodingException ue) {
+								line = "";
+								for (int i = 0; i < line_count; i++)
+									line = line + line_bytes[i];
+							}
+							if (line.startsWith("VERSION") || line.startsWith("CRC")) {
 								for (int e = 0; e < monitors.size(); e++) {
-									LinkedBlockingQueue<String> q = monitors.get(e);
-									q.put(line);
+									LinkedBlockingQueue<AltosLine> q = monitors.get(e);
+									q.put(new AltosLine (line));
 								}
-							} else
-								reply_queue.put(line);
+							} else {
+//								System.out.printf("GOT: %s\n", line);
+								reply_queue.put(new AltosLine (line));
+							}
+							line_count = 0;
 							line = "";
 						}
 					} else {
-						line = line + (char) c;
+						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++;
 					}
 				}
 			}
@@ -79,24 +105,40 @@ public class AltosSerial implements Runnable {
 		}
 	}
 
+	public void flush_output() {
+		if (altos != null)
+			libaltos.altos_flush(altos);
+	}
+
+	public void flush_input() {
+		flush_output();
+		try {
+			Thread.sleep(200);
+		} catch (InterruptedException ie) {
+		}
+		synchronized(this) {
+			if (!"VERSION".startsWith(line) &&
+			    !line.startsWith("VERSION"))
+				line = "";
+			reply_queue.clear();
+		}
+	}
+
 	public String get_reply() throws InterruptedException {
-		return reply_queue.take();
+		flush_output();
+		AltosLine line = reply_queue.take();
+		return line.line;
 	}
 
-	public void add_monitor(LinkedBlockingQueue<String> q) {
+	public void add_monitor(LinkedBlockingQueue<AltosLine> q) {
+		set_monitor(true);
 		monitors.add(q);
 	}
 
-	public void remove_monitor(LinkedBlockingQueue<String> q) {
+	public void remove_monitor(LinkedBlockingQueue<AltosLine> q) {
 		monitors.remove(q);
-	}
-
-	public void flush () {
-		synchronized(this) {
-			if (!"VERSION".startsWith(line) && !line.startsWith("VERSION"))
-				line = "";
-			reply_queue.clear();
-		}
+		if (monitors.isEmpty())
+			set_monitor(false);
 	}
 
 	public boolean opened() {
@@ -106,7 +148,6 @@ public class AltosSerial implements Runnable {
 	public void close() {
 		if (altos != null) {
 			libaltos.altos_close(altos);
-			altos = null;
 		}
 		if (input_thread != null) {
 			try {
@@ -116,13 +157,19 @@ public class AltosSerial implements Runnable {
 			}
 			input_thread = null;
 		}
+		if (altos != null) {
+			libaltos.altos_free(altos);
+			altos = null;
+		}
 	}
 
 	public void putc(char c) {
-		libaltos.altos_putchar(altos, c);
+		if (altos != null)
+			libaltos.altos_putchar(altos, c);
 	}
 
 	public void print(String data) {
+//		System.out.printf("\"%s\" ", data);
 		for (int i = 0; i < data.length(); i++)
 			putc(data.charAt(i));
 	}
@@ -134,15 +181,51 @@ public class AltosSerial implements Runnable {
 	public void open(altos_device device) throws FileNotFoundException {
 		close();
 		altos = libaltos.altos_open(device);
+		if (altos == null)
+			throw new FileNotFoundException(device.getPath());
 		input_thread = new Thread(this);
 		input_thread.start();
+		print("~\nE 0\n");
+		flush_output();
+		set_monitor(monitor_mode);
+		set_channel(AltosPreferences.channel(device.getSerial()));
+		set_callsign(AltosPreferences.callsign());
+	}
+
+	public void set_channel(int channel) {
+		if (altos != null) {
+			if (monitor_mode)
+				printf("m 0\nc r %d\nm 1\n", channel);
+			else
+				printf("c r %d\n", channel);
+			flush_output();
+		}
+	}
+
+	void set_monitor(boolean monitor) {
+		monitor_mode = monitor;
+		if (altos != null) {
+			if (monitor)
+				printf("m 1\n");
+			else
+				printf("m 0\n");
+			flush_output();
+		}
+	}
+
+	public void set_callsign(String callsign) {
+		if (altos != null) {
+			printf ("c c %s\n", callsign);
+			flush_output();
+		}
 	}
 
 	public AltosSerial() {
 		altos = null;
 		input_thread = null;
 		line = "";
-		monitors = new LinkedList<LinkedBlockingQueue<String>> ();
-		reply_queue = new LinkedBlockingQueue<String> ();
+		monitor_mode = false;
+		monitors = new LinkedList<LinkedBlockingQueue<AltosLine>> ();
+		reply_queue = new LinkedBlockingQueue<AltosLine> ();
 	}
 }