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

   1 /*
   2  * Copyright © 2011 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.text.*;
  21 import java.util.concurrent.*;
  22
  23 public class AltosEepromChunk {
  24
  25         public static final int chunk_size = 256;
  26         public static final int per_line = 8;
  27
  28         public int              data[];
  29         public int              address;
  30         public ParseException   parse_exception = null;
  31
  32         int[] ParseHex(String line) {
  33                 String[] tokens = line.split("\\s+");
  34                 int[] array = new int[tokens.length];
  35
  36                 for (int i = 0; i < tokens.length; i++)
  37                         try {
  38                                 array[i] = Integer.parseInt(tokens[i], 16);
  39                         } catch (NumberFormatException ne) {
  40                                 return null;
  41                         }
  42                 return array;
  43         }
  44
  45         public int data(int offset) {
  46                 return data[offset];
  47         }
  48
  49         public int data16(int offset) {
  50                 return data[offset] | (data[offset + 1] << 8);
  51         }
  52
  53         public int data32(int offset) {
  54                 return data[offset] | (data[offset + 1] << 8) |
  55                         (data[offset+2] << 16) | (data[offset+3] << 24);
  56         }
  57
  58         public boolean erased(int start, int len) {
  59                 for (int i = 0; i < len; i++)
  60                         if (data[start+i] != 0xff)
  61                                 return false;
  62                 return true;
  63         }
  64
  65         public AltosEeprom eeprom(int offset, int log_format, AltosState state) throws ParseException {
  66                 AltosEeprom     eeprom = null;
  67                 switch (log_format) {
  68                 case AltosLib.AO_LOG_FORMAT_FULL:
  69                         eeprom = new AltosEepromTM(this, offset);
  70                         break;
  71                 case AltosLib.AO_LOG_FORMAT_TINY:
  72                         eeprom = new AltosEepromTm(this, offset, state);
  73                         break;
  74                 case AltosLib.AO_LOG_FORMAT_TELEMETRY:
  75                 case AltosLib.AO_LOG_FORMAT_TELESCIENCE:
  76                         break;
  77                 case AltosLib.AO_LOG_FORMAT_TELEMEGA:
  78                         eeprom = new AltosEepromMega(this, offset);
  79                         break;
  80                 case AltosLib.AO_LOG_FORMAT_TELEMETRUM:
  81                         eeprom = new AltosEepromMetrum2(this, offset);
  82                         break;
  83                 case AltosLib.AO_LOG_FORMAT_TELEMINI:
  84                 case AltosLib.AO_LOG_FORMAT_EASYMINI:
  85                         eeprom = new AltosEepromMini(this, offset);
  86                         break;
  87                 default:
  88                         throw new ParseException("unknown eeprom format " + log_format, 0);
  89                 }
  90                 return eeprom;
  91         }
  92
  93         public AltosEepromChunk(AltosLink link, int block, boolean flush)
  94                 throws TimeoutException, InterruptedException {
  95
  96                 int     offset;
  97
  98                 data = new int[chunk_size];
  99                 address = block * chunk_size;
 100                 if (flush)
 101                         link.flush_input();
 102                 link.printf("e %x\n", block);
 103
 104                 for (offset = 0; offset < chunk_size; offset += per_line) {
 105                         try {
 106                                 String  line = link.get_reply(5000);
 107
 108                                 if (line == null)
 109                                         throw new TimeoutException();
 110
 111                                 int[] values = ParseHex(line);
 112
 113                                 if (values == null || values.length != per_line + 1)
 114                                         throw new ParseException(String.format("invalid line %s", line), 0);
 115                                 if (values[0] != offset)
 116                                         throw new ParseException(String.format("data address out of sync at 0x%x",
 117                                                                                address + offset), 0);
 118                                 for (int i = 0; i < per_line; i++)
 119                                         data[offset + i] = values[1 + i];
 120                         } catch (ParseException pe) {
 121                                 for (int i = 0; i < per_line; i++)
 122                                         data[offset + i] = 0xff;
 123                                 if (parse_exception == null)
 124                                         parse_exception = pe;
 125                         }
 126                 }
 127         }
 128 }