1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
|
/*
* Copyright © 2010 Keith Packard <keithp@keithp.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; version 2 of the License.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
*/
package altosui;
import java.io.*;
import org.altusmetrum.AltosLib.*;
public class AltosRomconfig {
public boolean valid;
public int version;
public int check;
public int serial_number;
public int radio_calibration;
static int get_int(byte[] bytes, int start, int len) {
int v = 0;
int o = 0;
while (len > 0) {
v = v | ((((int) bytes[start]) & 0xff) << o);
start++;
len--;
o += 8;
}
return v;
}
static void put_int(int value, byte[] bytes, int start, int len) {
while (len > 0) {
bytes[start] = (byte) (value & 0xff);
start++;
len--;
value >>= 8;
}
}
static void put_string(String value, byte[] bytes, int start) {
for (int i = 0; i < value.length(); i++)
bytes[start + i] = (byte) value.charAt(i);
}
static final int AO_USB_DESC_STRING = 3;
static void put_usb_serial(int value, byte[] bytes, int start) {
int offset = start + 0xa;
int string_num = 0;
while (offset < bytes.length && bytes[offset] != 0) {
if (bytes[offset + 1] == AO_USB_DESC_STRING) {
++string_num;
if (string_num == 4)
break;
}
offset += ((int) bytes[offset]) & 0xff;
}
if (offset >= bytes.length || bytes[offset] == 0)
return;
int len = ((((int) bytes[offset]) & 0xff) - 2) / 2;
String fmt = String.format("%%0%dd", len);
String s = String.format(fmt, value);
if (s.length() != len) {
System.out.printf("weird usb length issue %s isn't %d\n",
s, len);
return;
}
for (int i = 0; i < len; i++) {
bytes[offset + 2 + i*2] = (byte) s.charAt(i);
bytes[offset + 2 + i*2+1] = 0;
}
}
public AltosRomconfig(byte[] bytes, int offset) {
version = get_int(bytes, offset + 0, 2);
check = get_int(bytes, offset + 2, 2);
if (check == (~version & 0xffff)) {
switch (version) {
case 2:
case 1:
serial_number = get_int(bytes, offset + 4, 2);
radio_calibration = get_int(bytes, offset + 6, 4);
valid = true;
break;
}
}
}
public AltosRomconfig(AltosHexfile hexfile) {
this(hexfile.data, 0xa0 - hexfile.address);
}
public void write(byte[] bytes, int offset) throws IOException {
if (!valid)
throw new IOException("rom configuration invalid");
if (offset < 0 || bytes.length < offset + 10)
throw new IOException("image cannot contain rom config");
AltosRomconfig existing = new AltosRomconfig(bytes, offset);
if (!existing.valid)
throw new IOException("image does not contain existing rom config");
switch (existing.version) {
case 2:
put_usb_serial(serial_number, bytes, offset);
case 1:
put_int(serial_number, bytes, offset + 4, 2);
put_int(radio_calibration, bytes, offset + 6, 4);
break;
}
}
public void write (AltosHexfile hexfile) throws IOException {
write(hexfile.data, 0xa0 - hexfile.address);
AltosRomconfig check = new AltosRomconfig(hexfile);
if (!check.valid())
throw new IOException("writing new rom config failed\n");
}
public AltosRomconfig(int in_serial_number, int in_radio_calibration) {
valid = true;
version = 1;
check = (~version & 0xffff);
serial_number = in_serial_number;
radio_calibration = in_radio_calibration;
}
public boolean valid() {
return valid && serial_number != 0;
}
public AltosRomconfig() {
valid = false;
}
}
|
