1 files changed, 107 insertions, 0 deletions
diff --git a/ao-tools/altosui/AltosRomconfig.java b/ao-tools/altosui/AltosRomconfig.java
new file mode 100644
index 00000000..844da7c4
--- /dev/null
+++ b/ao-tools/altosui/AltosRomconfig.java
@@ -0,0 +1,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;
+	}
+}