altos: Add gyro-based orientation tracking
[fw/altos] / altoslib / AltosSensorEMini.java
1 /*
2  * Copyright © 2012 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 package org.altusmetrum.altoslib_2;
19
20 import java.util.concurrent.TimeoutException;
21
22 public class AltosSensorEMini {
23         public int      tick;
24         public int      apogee;
25         public int      main;
26         public int      batt;
27
28         static public void update_state(AltosState state, AltosLink link, AltosConfigData config_data) {
29                 try {
30                         AltosSensorEMini        sensor_emini = new AltosSensorEMini(link);
31
32                         if (sensor_emini == null)
33                                 return;
34                         state.set_battery_voltage(AltosConvert.easy_mini_voltage(sensor_emini.batt));
35                         state.set_apogee_voltage(AltosConvert.easy_mini_voltage(sensor_emini.apogee));
36                         state.set_main_voltage(AltosConvert.easy_mini_voltage(sensor_emini.main));
37                         
38                 } catch (TimeoutException te) {
39                 } catch (InterruptedException ie) {
40                 }
41         }
42
43         public AltosSensorEMini(AltosLink link) throws InterruptedException, TimeoutException {
44                 String[] items = link.adc();
45                 for (int i = 0; i < items.length;) {
46                         if (items[i].equals("tick:")) {
47                                 tick = Integer.parseInt(items[i+1]);
48                                 i += 2;
49                                 continue;
50                         }
51                         if (items[i].equals("apogee:")) {
52                                 apogee = Integer.parseInt(items[i+1]);
53                                 i += 2;
54                                 continue;
55                         }
56                         if (items[i].equals("main:")) {
57                                 main = Integer.parseInt(items[i+1]);
58                                 i += 2;
59                                 continue;
60                         }
61                         if (items[i].equals("batt:")) {
62                                 batt = Integer.parseInt(items[i+1]);
63                                 i += 2;
64                                 continue;
65                         }
66                         i++;
67                 }
68         }
69 }
70