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
|
/*
* 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 altosui.AltosHexfile;
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;
}
}
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 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 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);
new AltosRomconfig(hexfile);
}
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;
}
}
|
