altosui: Clean up eeprom parsing a bit
[fw/altos] / altosui / 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 altosui;
19
20 import java.io.*;
21 import java.util.*;
22 import java.text.*;
23 import java.util.concurrent.*;
24
25 public class AltosEepromChunk {
26
27         static final int        chunk_size = 256;
28         static final int        per_line = 8;
29
30         public int              data[];
31         public int              address;
32         public ParseException   parse_exception = null;
33
34         int[] ParseHex(String line) {
35                 String[] tokens = line.split("\\s+");
36                 int[] array = new int[tokens.length];
37
38                 for (int i = 0; i < tokens.length; i++)
39                         try {
40                                 array[i] = Integer.parseInt(tokens[i], 16);
41                         } catch (NumberFormatException ne) {
42                                 return null;
43                         }
44                 return array;
45         }
46
47         int data(int offset) {
48                 return data[offset];
49         }
50
51         int data16(int offset) {
52                 return data[offset] | (data[offset + 1] << 8);
53         }
54
55         boolean erased(int start, int len) {
56                 for (int i = 0; i < len; i++)
57                         if (data[start+i] != 0xff)
58                                 return false;
59                 return true;
60         }
61
62         public AltosEepromChunk(AltosSerial serial_line, int block)
63                 throws TimeoutException, InterruptedException {
64
65                 int     offset;
66
67                 data = new int[chunk_size];
68                 address = block * chunk_size;
69                 serial_line.flush_input();
70                 serial_line.printf("e %x\n", block);
71
72                 for (offset = 0; offset < chunk_size; offset += per_line) {
73                         try {
74                                 String  line = serial_line.get_reply(5000);
75
76                                 if (line == null)
77                                         throw new TimeoutException();
78
79                                 int[] values = ParseHex(line);
80
81                                 if (values == null || values.length != per_line + 1)
82                                         throw new ParseException(String.format("invalid line %s", line), 0);
83                                 if (values[0] != offset)
84                                         throw new ParseException(String.format("data address out of sync at 0x%x",
85                                                                                address + offset), 0);
86                                 for (int i = 0; i < per_line; i++)
87                                         data[offset + i] = values[1 + i];
88                         } catch (ParseException pe) {
89                                 for (int i = 0; i < per_line; i++)
90                                         data[offset + i] = 0xff;
91                                 if (parse_exception == null)
92                                         parse_exception = pe;
93                         }
94                 }
95         }
96 }