git.gag.com Git - fw/altos/blob - 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                                 if (altos == null)
  55                                         break;
  56                                 c = libaltos.altos_getchar(altos, 0);
  57                                 if (Thread.interrupted())
  58                                         break;
  59                                 if (c == -1)
  60                                         continue;
  61                                 if (c == '\r')
  62                                         continue;
  63                                 synchronized(this) {
  64                                         if (c == '\n') {
  65                                                 if (line != "") {
  66                                                         if (line.startsWith("VERSION")) {
  67                                                                 for (int e = 0; e < monitors.size(); e++) {
  68                                                                         LinkedBlockingQueue<String> q = monitors.get(e);
  69                                                                         q.put(line);
  70                                                                 }
  71                                                         } else
  72                                                                 reply_queue.put(line);
  73                                                         line = "";
  74                                                 }
  75                                         } else {
  76                                                 line = line + (char) c;
  77                                         }
  78                                 }
  79                         }
  80                 } catch (InterruptedException e) {
  81                 }
  82         }
  83
  84         public String get_reply() throws InterruptedException {
  85                 return reply_queue.take();
  86         }
  87
  88         public void add_monitor(LinkedBlockingQueue<String> q) {
  89                 monitors.add(q);
  90         }
  91
  92         public void remove_monitor(LinkedBlockingQueue<String> q) {
  93                 monitors.remove(q);
  94         }
  95
  96         public void flush () {
  97                 synchronized(this) {
  98                         if (!"VERSION".startsWith(line) && !line.startsWith("VERSION"))
  99                                 line = "";
 100                         reply_queue.clear();
 101                 }
 102         }
 103
 104         public boolean opened() {
 105                 return altos != null;
 106         }
 107
 108         public void close() {
 109                 if (altos != null) {
 110                         libaltos.altos_close(altos);
 111                         altos = null;
 112                 }
 113                 if (input_thread != null) {
 114                         try {
 115                                 input_thread.interrupt();
 116                                 input_thread.join();
 117                         } catch (InterruptedException e) {
 118                         }
 119                         input_thread = null;
 120                 }
 121         }
 122
 123         public void putc(char c) {
 124                 if (altos != null)
 125                         libaltos.altos_putchar(altos, c);
 126         }
 127
 128         public void print(String data) {
 129                 for (int i = 0; i < data.length(); i++)
 130                         putc(data.charAt(i));
 131         }
 132
 133         public void printf(String format, Object ... arguments) {
 134                 print(String.format(format, arguments));
 135         }
 136
 137         public void open(altos_device device) throws FileNotFoundException {
 138                 close();
 139                 altos = libaltos.altos_open(device);
 140                 if (altos == null)
 141                         throw new FileNotFoundException(device.getPath());
 142                 input_thread = new Thread(this);
 143                 input_thread.start();
 144                 print("\nE 0\n");
 145                 try {
 146                         Thread.sleep(200);
 147                 } catch (InterruptedException e) {
 148                 }
 149                 flush();
 150         }
 151
 152         public void set_channel(int channel) {
 153                 if (altos != null)
 154                         printf("m 0\nc r %d\nm 1\n", channel);
 155         }
 156
 157         public AltosSerial() {
 158                 altos = null;
 159                 input_thread = null;
 160                 line = "";
 161                 monitors = new LinkedList<LinkedBlockingQueue<String>> ();
 162                 reply_queue = new LinkedBlockingQueue<String> ();
 163         }
 164 }