altosui: flush serial output before waiting for reply
[fw/altos] / ao-tools / altosui / AltosSerial.java
1 /*
2  * Copyright © 2010 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; version 2 of the License.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License along
14  * with this program; if not, write to the Free Software Foundation, Inc.,
15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
16  */
17
18 /*
19  * Deal with TeleDongle on a serial port
20  */
21
22 package altosui;
23
24 import java.lang.*;
25 import java.io.*;
26 import java.util.concurrent.LinkedBlockingQueue;
27 import java.util.LinkedList;
28 import java.util.Iterator;
29 import altosui.AltosSerialMonitor;
30 import libaltosJNI.libaltos;
31 import libaltosJNI.altos_device;
32 import libaltosJNI.SWIGTYPE_p_altos_file;
33 import libaltosJNI.SWIGTYPE_p_altos_list;
34
35 /*
36  * This class reads from the serial port and places each received
37  * line in a queue. Dealing with that queue is left up to other
38  * threads.
39  */
40
41 public class AltosSerial implements Runnable {
42
43         SWIGTYPE_p_altos_file altos;
44         LinkedList<LinkedBlockingQueue<String>> monitors;
45         LinkedBlockingQueue<String> reply_queue;
46         Thread input_thread;
47         String line;
48
49         public void run () {
50                 int c;
51
52                 try {
53                         for (;;) {
54                                 c = libaltos.altos_getchar(altos, 0);
55                                 if (Thread.interrupted())
56                                         break;
57                                 if (c == -1)
58                                         continue;
59                                 if (c == '\r')
60                                         continue;
61                                 synchronized(this) {
62                                         if (c == '\n') {
63                                                 if (line != "") {
64                                                         if (line.startsWith("VERSION")) {
65                                                                 for (int e = 0; e < monitors.size(); e++) {
66                                                                         LinkedBlockingQueue<String> q = monitors.get(e);
67                                                                         q.put(line);
68                                                                 }
69                                                         } else
70                                                                 reply_queue.put(line);
71                                                         line = "";
72                                                 }
73                                         } else {
74                                                 line = line + (char) c;
75                                         }
76                                 }
77                         }
78                 } catch (InterruptedException e) {
79                 }
80         }
81
82         public void flush_reply() {
83                 reply_queue.clear();
84         }
85
86         public String get_reply() throws InterruptedException {
87                 libaltos.altos_flush(altos);
88                 String line = reply_queue.take();
89                 return line;
90         }
91
92         public void add_monitor(LinkedBlockingQueue<String> q) {
93                 monitors.add(q);
94         }
95
96         public void remove_monitor(LinkedBlockingQueue<String> q) {
97                 monitors.remove(q);
98         }
99
100         public void flush () {
101                 synchronized(this) {
102                         if (!"VERSION".startsWith(line) && !line.startsWith("VERSION"))
103                                 line = "";
104                         reply_queue.clear();
105                 }
106         }
107
108         public boolean opened() {
109                 return altos != null;
110         }
111
112         public void close() {
113                 if (altos != null)
114                         libaltos.altos_close(altos);
115                 if (input_thread != null) {
116                         try {
117                                 input_thread.interrupt();
118                                 input_thread.join();
119                         } catch (InterruptedException e) {
120                         }
121                         input_thread = null;
122                 }
123                 if (altos != null) {
124                         libaltos.altos_free(altos);
125                         altos = null;
126                 }
127         }
128
129         public void putc(char c) {
130                 if (altos != null)
131                         libaltos.altos_putchar(altos, c);
132         }
133
134         public void print(String data) {
135                 for (int i = 0; i < data.length(); i++)
136                         putc(data.charAt(i));
137         }
138
139         public void printf(String format, Object ... arguments) {
140                 print(String.format(format, arguments));
141         }
142
143         public void open(altos_device device) throws FileNotFoundException {
144                 close();
145                 altos = libaltos.altos_open(device);
146                 if (altos == null)
147                         throw new FileNotFoundException(device.getPath());
148                 input_thread = new Thread(this);
149                 input_thread.start();
150                 print("\nE 0\n");
151                 try {
152                         Thread.sleep(200);
153                 } catch (InterruptedException e) {
154                 }
155                 flush();
156         }
157
158         public void set_channel(int channel) {
159                 if (altos != null)
160                         printf("m 0\nc r %d\nm 1\n", channel);
161         }
162
163         public void set_callsign(String callsign) {
164                 if (altos != null)
165                         printf ("c c %s\n", callsign);
166         }
167
168         public AltosSerial() {
169                 altos = null;
170                 input_thread = null;
171                 line = "";
172                 monitors = new LinkedList<LinkedBlockingQueue<String>> ();
173                 reply_queue = new LinkedBlockingQueue<String> ();
174         }
175 }