altoslib: Keep config data accel cal in antenna up form.
[fw/altos] / altoslib / AltosIdleMonitor.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; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License along
15  * with this program; if not, write to the Free Software Foundation, Inc.,
16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
17  */
18
19 package org.altusmetrum.altoslib_12;
20
21 import java.io.*;
22 import java.util.concurrent.*;
23
24
25 public class AltosIdleMonitor extends Thread {
26         AltosLink               link;
27         AltosIdleMonitorListener        listener;
28
29         AltosIdleFetch          fetch;
30
31         boolean                 remote;
32         boolean                 close_on_exit;
33         double                  frequency;
34         String                  callsign;
35
36         AltosState              state;
37         AltosListenerState      listener_state;
38         AltosConfigData         config_data;
39         AltosGPS                gps;
40
41         void start_link() throws InterruptedException, TimeoutException {
42                 if (remote) {
43                         link.set_radio_frequency(frequency);
44                         link.set_callsign(callsign);
45                         link.start_remote();
46                 } else
47                         link.flush_input();
48         }
49
50         boolean stop_link() throws InterruptedException, TimeoutException {
51                 if (remote)
52                         link.stop_remote();
53                 return link.reply_abort;
54         }
55
56         boolean provide_data() throws InterruptedException, TimeoutException, AltosUnknownProduct {
57                 boolean         worked = false;
58                 boolean         aborted = false;
59
60                 try {
61                         start_link();
62                         link.config_data();
63                         if (state == null)
64                                 state = new AltosState(new AltosCalData(link.config_data()));
65                         fetch.provide_data(state);
66                         if (!link.has_error && !link.reply_abort)
67                                 worked = true;
68                 } finally {
69                         aborted = stop_link();
70                         if (worked) {
71                                 if (remote)
72                                         state.set_rssi(link.rssi(), 0);
73                                 listener_state.battery = link.monitor_battery();
74                         }
75                 }
76                 return aborted;
77         }
78
79         public void set_frequency(double in_frequency) {
80                 frequency = in_frequency;
81                 link.abort_reply();
82         }
83
84         public void set_callsign(String in_callsign) {
85                 callsign = in_callsign;
86                 link.abort_reply();
87         }
88
89         public void abort() throws InterruptedException {
90                 while (isAlive()) {
91                         interrupt();
92                         link.abort_reply();
93                         Thread.sleep(100);
94                 }
95                 join();
96         }
97
98         public void run() {
99                 state = null;
100                 try {
101                         for (;;) {
102                                 try {
103                                         provide_data();
104                                         listener.update(state, listener_state);
105                                 } catch (TimeoutException te) {
106                                 } catch (AltosUnknownProduct ae) {
107                                         listener.error(String.format("Unknown product \"%s\"", ae.product));
108                                 }
109                                 if (link.has_error || link.reply_abort) {
110                                         listener.failed();
111                                         break;
112                                 }
113                                 Thread.sleep(1000);
114                         }
115                 } catch (InterruptedException ie) {
116                 }
117                 if (close_on_exit) {
118                         try {
119                                 link.close();
120                         } catch (InterruptedException ie) {
121                         }
122                 }
123         }
124
125         public AltosIdleMonitor(AltosIdleMonitorListener in_listener, AltosLink in_link, boolean in_remote, boolean in_close_on_exit) {
126                 listener = in_listener;
127                 link = in_link;
128                 remote = in_remote;
129                 close_on_exit = in_close_on_exit;
130                 listener_state = new AltosListenerState();
131                 fetch = new AltosIdleFetch(link);
132         }
133
134         public AltosIdleMonitor(AltosIdleMonitorListener in_listener, AltosLink in_link, boolean in_remote) {
135                 this(in_listener, in_link, in_remote, true);
136         }
137 }
138