git.gag.com Git - fw/altos/blob - altoslib/AltosSensorMega.java

   1 /*
   2  * Copyright © 2013 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_13;
  20
  21 import java.util.concurrent.TimeoutException;
  22
  23 class AltosSensorMega {
  24         int             tick;
  25         int[]           sense;
  26         int             v_batt;
  27         int             v_pbatt;
  28         int             temp;
  29
  30         public AltosSensorMega() {
  31                 sense = new int[6];
  32         }
  33
  34         public AltosSensorMega(AltosLink link) throws InterruptedException, TimeoutException {
  35                 this();
  36                 String[] items = link.adc();
  37                 for (int i = 0; i < items.length;) {
  38                         if (items[i].equals("tick:")) {
  39                                 tick = Integer.parseInt(items[i+1]);
  40                                 i += 2;
  41                                 continue;
  42                         }
  43                         if (items[i].equals("A:")) {
  44                                 sense[0] = Integer.parseInt(items[i+1]);
  45                                 i += 2;
  46                                 continue;
  47                         }
  48                         if (items[i].equals("B:")) {
  49                                 sense[1] = Integer.parseInt(items[i+1]);
  50                                 i += 2;
  51                                 continue;
  52                         }
  53                         if (items[i].equals("C:")) {
  54                                 sense[2] = Integer.parseInt(items[i+1]);
  55                                 i += 2;
  56                                 continue;
  57                         }
  58                         if (items[i].equals("D:")) {
  59                                 sense[3] = Integer.parseInt(items[i+1]);
  60                                 i += 2;
  61                                 continue;
  62                         }
  63                         if (items[i].equals("drogue:")) {
  64                                 sense[4] = Integer.parseInt(items[i+1]);
  65                                 i += 2;
  66                                 continue;
  67                         }
  68                         if (items[i].equals("main:")) {
  69                                 sense[5] = Integer.parseInt(items[i+1]);
  70                                 i += 2;
  71                                 continue;
  72                         }
  73                         if (items[i].equals("batt:")) {
  74                                 v_batt = Integer.parseInt(items[i+1]);
  75                                 i += 2;
  76                                 continue;
  77                         }
  78                         if (items[i].equals("pbatt:")) {
  79                                 v_pbatt = Integer.parseInt(items[i+1]);
  80                                 i += 2;
  81                                 continue;
  82                         }
  83                         if (items[i].equals("temp:")) {
  84                                 temp = Integer.parseInt(items[i+1]);
  85                                 i += 2;
  86                                 continue;
  87                         }
  88                         i++;
  89                 }
  90         }
  91
  92         static public void provide_data(AltosDataListener listener, AltosLink link) throws InterruptedException {
  93                 try {
  94                         AltosSensorMega sensor_mega = new AltosSensorMega(link);
  95
  96                         listener.set_battery_voltage(AltosConvert.mega_battery_voltage(sensor_mega.v_batt));
  97                         listener.set_apogee_voltage(AltosConvert.mega_pyro_voltage(sensor_mega.sense[4]));
  98                         listener.set_main_voltage(AltosConvert.mega_pyro_voltage(sensor_mega.sense[5]));
  99
 100                         double[]        igniter_voltage = new double[4];
 101                         for (int i = 0; i < 4; i++)
 102                                 igniter_voltage[i] = AltosConvert.mega_pyro_voltage(sensor_mega.sense[i]);
 103                         listener.set_igniter_voltage(igniter_voltage);
 104
 105                 } catch (TimeoutException te) {
 106                 }
 107         }
 108 }
 109