X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ao-tools%2Faltosui%2FAltosSerial.java;h=99ba3324e623fbd3d3fe3c82c0323b6b3587c9f3;hp=efa63f681819e2ed9f3d22ebfac66d79e47f7750;hb=ae02b1590439d5c8dfb472cf1f83a14fdcfbaf11;hpb=53c279b9e96da8b69837ae84038a78ca5707f2a5

diff --git a/ao-tools/altosui/AltosSerial.java b/ao-tools/altosui/AltosSerial.java
index efa63f68..99ba3324 100644
--- a/ao-tools/altosui/AltosSerial.java
+++ b/ao-tools/altosui/AltosSerial.java
@@ -45,6 +45,9 @@ public class AltosSerial implements Runnable {
 	LinkedBlockingQueue<String> reply_queue;
 	Thread input_thread;
 	String line;
+	byte[] line_bytes;
+	int line_count;
+	boolean monitor_mode;
 
 	public void run () {
 		int c;
@@ -60,18 +63,36 @@ public class AltosSerial implements Runnable {
 					continue;
 				synchronized(this) {
 					if (c == '\n') {
-						if (line != "") {
+						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")) {
 								for (int e = 0; e < monitors.size(); e++) {
 									LinkedBlockingQueue<String> q = monitors.get(e);
 									q.put(line);
 								}
-							} else
+							} else {
+//								System.out.printf("GOT: %s\n", line);
 								reply_queue.put(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 +100,39 @@ public class AltosSerial implements Runnable {
 		}
 	}
 
+	public void flush_output() {
+		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();
+		String line = reply_queue.take();
+		return line;
 	}
 
 	public void add_monitor(LinkedBlockingQueue<String> q) {
+		set_monitor(true);
 		monitors.add(q);
 	}
 
 	public void remove_monitor(LinkedBlockingQueue<String> 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() {
@@ -104,8 +140,9 @@ public class AltosSerial implements Runnable {
 	}
 
 	public void close() {
-		if (altos != null)
+		if (altos != null) {
 			libaltos.altos_close(altos);
+		}
 		if (input_thread != null) {
 			try {
 				input_thread.interrupt();
@@ -126,6 +163,7 @@ public class AltosSerial implements Runnable {
 	}
 
 	public void print(String data) {
+//		System.out.printf("\"%s\" ", data);
 		for (int i = 0; i < data.length(); i++)
 			putc(data.charAt(i));
 	}
@@ -141,23 +179,40 @@ public class AltosSerial implements Runnable {
 			throw new FileNotFoundException(device.getPath());
 		input_thread = new Thread(this);
 		input_thread.start();
-		print("\nE 0\n");
-		try {
-			Thread.sleep(200);
-		} catch (InterruptedException e) {
-		}
-		flush();
+		print("~\nE 0\n");
+		set_monitor(monitor_mode);
+		flush_input();
 	}
 
 	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);
+		}
+	}
+
+	void set_monitor(boolean monitor) {
+		monitor_mode = monitor;
+		if (altos != null) {
+			if (monitor)
+				printf("m 1\n");
+			else
+				printf("m 0\n");
+		}
+	}
+
+	public void set_callsign(String callsign) {
 		if (altos != null)
-			printf("m 0\nc r %d\nm 1\n", channel);
+			printf ("c c %s\n", callsign);
 	}
 
 	public AltosSerial() {
 		altos = null;
 		input_thread = null;
 		line = "";
+		monitor_mode = false;
 		monitors = new LinkedList<LinkedBlockingQueue<String>> ();
 		reply_queue = new LinkedBlockingQueue<String> ();
 	}