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

   1 /*
   2  * Copyright © 2020 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_14;
  20
  21 import java.util.concurrent.TimeoutException;
  22
  23 class AltosSensorEasyMotor2 {
  24         int             tick;
  25         int             v_batt;
  26         int             motor_pressure;
  27
  28         public AltosSensorEasyMotor2(AltosLink link) throws InterruptedException, TimeoutException {
  29                 String[] items = link.adc();
  30                 for (int i = 0; i < items.length;) {
  31                         if (items[i].equals("tick:")) {
  32                                 tick = Integer.parseInt(items[i+1]);
  33                                 i += 2;
  34                                 continue;
  35                         }
  36                         if (items[i].equals("motor_pressure:")) {
  37                                 motor_pressure = Integer.parseInt(items[i+1]);
  38                                 i += 2;
  39                                 continue;
  40                         }
  41                         if (items[i].equals("batt:")) {
  42                                 v_batt = Integer.parseInt(items[i+1]);
  43                                 i += 2;
  44                                 continue;
  45                         }
  46                         i++;
  47                 }
  48         }
  49
  50         static public void provide_data(AltosDataListener listener, AltosLink link) throws InterruptedException {
  51                 try {
  52                         AltosSensorEasyMotor2   sensor_easymotor2 = new AltosSensorEasyMotor2(link);
  53
  54                         listener.set_battery_voltage(AltosConvert.easy_mini_2_voltage(sensor_easymotor2.v_batt));
  55                         double pa = AltosConvert.easy_motor_2_motor_pressure(sensor_easymotor2.motor_pressure,
  56                                                                              listener.cal_data().ground_motor_pressure);
  57                         listener.set_motor_pressure(pa);
  58
  59                 } catch (TimeoutException te) {
  60                 }
  61         }
  62 }
  63