git.gag.com Git - fw/altos/blob - altoslib/AltosSensorTM.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;
  19
  20 import java.util.concurrent.TimeoutException;
  21
  22 class AltosSensorTM extends AltosRecordTM {
  23
  24         public AltosSensorTM(AltosLink link, AltosConfigData config_data) throws InterruptedException, TimeoutException {
  25                 super();
  26                 link.printf("a\n");
  27                 for (;;) {
  28                         String line = link.get_reply_no_dialog(5000);
  29                         if (line == null) {
  30                                 throw new TimeoutException();
  31                         }
  32                         if (!line.startsWith("tick:"))
  33                                 continue;
  34                         String[] items = line.split("\\s+");
  35                         for (int i = 0; i < items.length;) {
  36                                 if (items[i].equals("tick:")) {
  37                                         tick = Integer.parseInt(items[i+1]);
  38                                         i += 2;
  39                                         continue;
  40                                 }
  41                                 if (items[i].equals("accel:")) {
  42                                         accel = Integer.parseInt(items[i+1]);
  43                                         i += 2;
  44                                         continue;
  45                                 }
  46                                 if (items[i].equals("pres:")) {
  47                                         pres = Integer.parseInt(items[i+1]);
  48                                         i += 2;
  49                                         continue;
  50                                 }
  51                                 if (items[i].equals("temp:")) {
  52                                         temp = Integer.parseInt(items[i+1]);
  53                                         i += 2;
  54                                         continue;
  55                                 }
  56                                 if (items[i].equals("batt:")) {
  57                                         batt = Integer.parseInt(items[i+1]);
  58                                         i += 2;
  59                                         continue;
  60                                 }
  61                                 if (items[i].equals("drogue:")) {
  62                                         drogue = Integer.parseInt(items[i+1]);
  63                                         i += 2;
  64                                         continue;
  65                                 }
  66                                 if (items[i].equals("main:")) {
  67                                         main = Integer.parseInt(items[i+1]);
  68                                         i += 2;
  69                                         continue;
  70                                 }
  71                                 i++;
  72                         }
  73                         break;
  74                 }
  75                 ground_accel = config_data.accel_cal_plus;
  76                 ground_pres = pres;
  77                 accel_plus_g = config_data.accel_cal_plus;
  78                 accel_minus_g = config_data.accel_cal_minus;
  79         }
  80 }
  81