+
+ // AvrDrone leftovers //////////////////////////////////////////////////////////////////////////////
+
+ private void init() throws IOException {
+ byte[] bytes = new byte[6];
+ int i=0;
+
+ out.write(0);
+ out.flush();
+
+ // read any crap that might be left in the buffer
+ while(true) {
+ System.arraycopy(bytes, 1, bytes, 0, 5);
+ bytes[5] = in.readByte();
+ i++;
+ System.out.print("\rsignature: read \"" + new String(bytes) + "\" ");
+ if (bytes[0] == (byte)'O' &&
+ bytes[1] == (byte)'B' &&
+ bytes[2] == (byte)'I' &&
+ bytes[3] == (byte)'T' &&
+ bytes[4] == (byte)'S') {
+ System.out.println("\rsignature: got proper signature ");
+ chip.purge();
+ break;
+ }
+ }
+
+ // FIXME: what if init() is called twice?
+ new Thread() {
+ public void run() {
+ while(true) {
+ try {
+ while(callbacks.size() == 0) Thread.sleep(500);
+ byte b = in.readByte();
+ ByteCallback bc = (ByteCallback)callbacks.remove(0);
+ //System.out.println("readback " + b + " in " + (System.currentTimeMillis()-bc.time));
+ bc.call(b);
+ synchronized(lock) {
+ lock.notifyAll();
+ }
+ } catch (Exception e) {
+ e.printStackTrace();
+ }
+ }
+ }
+ }.start();
+ }
+
+
+ // Programming ///////////////////////////////////////////////////////////////////////////////
+
+ private byte[][][] cache = new byte[24][][];
+ public byte mode4(int z, int y, int x) {
+ if (cache[x]==null) return 0;
+ if (cache[x][y]==null) return 0;
+ return cache[x][y][z];
+ }
+
+ public synchronized void mode4(int z, int y, int x, int d) {
+ try {
+ if (cache[x & 0xff]==null) cache[x & 0xff] = new byte[24][];
+ if (cache[x & 0xff][y & 0xff]==null) cache[x & 0xff][y & 0xff] = new byte[256];
+ cache[x & 0xff][y & 0xff][z & 0xff] = (byte)(d & 0xff);
+
+ out.writeByte(1);
+ out.writeByte(z);
+ out.writeByte(y);
+ out.writeByte(x);
+ out.writeByte(d);
+ } catch (IOException e) {
+ throw new RuntimeException(e);
+ }
+ }
+
+ public void flush() { try { out.flush(); } catch (IOException e) { throw new RuntimeException(e); } }
+
+
+ // Callbacks //////////////////////////////////////////////////////////////////////////////
+
+ private Vector callbacks = new Vector();
+
+ private Object lock = new Object();
+ private static final int limit = 40;
+
+ private void enqueue(ByteCallback bcb) {
+ synchronized(lock) {
+ try {
+ while (callbacks.size() >= limit) {
+ lock.wait(100);
+ }
+ } catch (Exception e) {
+ throw new RuntimeException(e);
+ }
+ }
+ bcb.time = System.currentTimeMillis();
+ callbacks.add(bcb);
+ }
+
+ public static abstract class ByteCallback {
+ public int result;
+ public long time;
+ public abstract void call(byte b) throws Exception;
+ }
+
+ public synchronized int readCount() {
+ try {
+ ByteCallback bc = new ByteCallback() {
+ public synchronized void call(byte b) throws Exception {
+ result =
+ ((b & 0xff) << 24) |
+ ((in.read() & 0xff) << 16) |
+ ((in.read() & 0xff) << 8) |
+ ((in.read() & 0xff) << 0);
+ this.notify();
+ }
+ };
+ synchronized(bc) {
+ enqueue(bc);
+ out.writeByte(3);
+ out.flush();
+ bc.wait();
+ }
+ return bc.result;
+ } catch (Exception e) { throw new RuntimeException(e); }
+ }
+
+ public synchronized void readBus(ByteCallback bc) throws IOException {
+ enqueue(bc);
+ out.writeByte(2);
+ out.flush();
+ }
+
+ public synchronized void readInterrupts(ByteCallback bc) throws IOException {
+ enqueue(bc);
+ out.writeByte(3);
+ out.flush();
+ }
+
+
+ // Util //////////////////////////////////////////////////////////////////////////////
+
+ private String pad(int i, String s) { if (s.length()>i) return s; return "0"+pad((i-1),s); }