import java.util.LinkedList;
import java.util.Iterator;
import altosui.AltosSerialMonitor;
+import altosui.AltosLine;
import libaltosJNI.libaltos;
import libaltosJNI.altos_device;
import libaltosJNI.SWIGTYPE_p_altos_file;
import libaltosJNI.SWIGTYPE_p_altos_list;
+import libaltosJNI.libaltosConstants;
/*
* This class reads from the serial port and places each received
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;
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;
for (int i = 0; i < line_count; i++)
line = line + line_bytes[i];
}
- if (line.startsWith("VERSION")) {
+ 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 {
// System.out.printf("GOT: %s\n", line);
- reply_queue.put(line);
+ reply_queue.put(new AltosLine (line));
}
line_count = 0;
line = "";
}
}
- public void flush_reply() {
- libaltos.altos_flush(altos);
+ public void flush_output() {
+ if (altos != null)
+ libaltos.altos_flush(altos);
+ }
+
+ public void flush_input() {
+ flush_output();
try {
- Thread.sleep(100);
+ Thread.sleep(200);
} catch (InterruptedException ie) {
}
- reply_queue.clear();
+ synchronized(this) {
+ if (!"VERSION".startsWith(line) &&
+ !line.startsWith("VERSION"))
+ line = "";
+ reply_queue.clear();
+ }
}
public String get_reply() throws InterruptedException {
- libaltos.altos_flush(altos);
- String line = reply_queue.take();
- return line;
+ 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() {
}
public void close() {
- if (altos != null)
+ if (altos != null) {
libaltos.altos_close(altos);
+ }
if (input_thread != null) {
try {
input_thread.interrupt();
}
public void print(String data) {
-//h System.out.printf("\"%s\" ", data);
+// System.out.printf("\"%s\" ", data);
for (int i = 0; i < data.length(); i++)
putc(data.charAt(i));
}
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");
+ 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)
- printf("m 0\nc r %d\nm 1\n", 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)
+ 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> ();
}
}