package edu.berkeley.obits.device.atmel;
+import com.atmel.fpslic.*;
+import edu.berkeley.slipway.*;
import edu.berkeley.obits.*;
import org.ibex.util.Log;
import java.io.*;
import gnu.io.*;
/** the "host" side of the AVR Drone; see AvrDrone.c for the other side */
-public class AvrDrone extends AtmelDevice {
-
- final DataInputStream in;
-
- final DataOutputStream out;
-
- final SerialPort sp;
-
- public AvrDrone(SerialPort sp) throws IOException, UnsupportedCommOperationException, InterruptedException, DeviceException {
- this.sp = sp;
- sp.setSerialPortParams(115200, SerialPort.DATABITS_8, SerialPort.STOPBITS_1, SerialPort.PARITY_NONE);
- sp.setFlowControlMode(sp.FLOWCONTROL_RTSCTS_OUT);
- //sp.setFlowControlMode(sp.FLOWCONTROL_NONE);
- this.out = new DataOutputStream(sp.getOutputStream());
- this.in = new DataInputStream(sp.getInputStream());
- Log.debug(this, "consuming any leftover data on the serial port");
- while(in.available() > 0) in.read();
- reset();
- Log.debug(this, "waiting for device to identify itself");
- if (in.readByte() != (byte)'O') throw new RuntimeException("didn't get the proper signature");
- if (in.readByte() != (byte)'B') throw new RuntimeException("didn't get the proper signature");
- if (in.readByte() != (byte)'I') throw new RuntimeException("didn't get the proper signature");
- if (in.readByte() != (byte)'T') throw new RuntimeException("didn't get the proper signature");
- if (in.readByte() != (byte)'S') throw new RuntimeException("didn't get the proper signature");
- if (in.readByte() != (byte)'\n') throw new RuntimeException("didn't get the proper signature");
- Log.info(this, "device correctly identified itself; ready for operation");
+public class AvrDrone extends Fpslic {
+
+ private final DataInputStream in;
+ private final DataOutputStream out;
+ private final Board board;
+
+ public AvrDrone(Board b) throws IOException {
+ this.board = b;
+ this.out = new DataOutputStream(b.getOutputStream());
+ this.in = new DataInputStream(b.getInputStream());
+ init();
+ }
+
+ public void reset() throws IOException {
+ board.reset();
+ }
+
+ 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 ");
+ break;
+ }
+ }
+
}
- public void reset() throws DeviceException {
+ public synchronized void scanFPGA(boolean on) throws IOException {
+ if (on) {
+ out.writeByte(3);
+ out.flush();
+ } else {
+ // FIXME
+ }
+ }
+ // fixme!
+ public static int retval = 0;
+ public synchronized int readCount() {
try {
- Log.info(this, "resetting device");
- sp.setDTR(true);
- sp.setRTS(true);
- Thread.sleep(500);
- Log.info(this, "deasserting reset signal");
- sp.setDTR(false);
- sp.setRTS(false);
- Thread.sleep(100);
- } catch (InterruptedException e) { throw new DeviceException(e); }
+ if (reader != null) {
+ reader.start();
+ reader = null;
+ }
+ ByteCallback bc = new ByteCallback() {
+ public synchronized void call(byte b) throws Exception {
+ retval =
+ ((b & 0xff) << 24) |
+ ((in.read() & 0xff) << 16) |
+ ((in.read() & 0xff) << 8) |
+ ((in.read() & 0xff) << 0);
+ this.notify();
+ }
+ };
+ synchronized(bc) {
+ callbacks.add(bc);
+ out.writeByte(6);
+ out.flush();
+ bc.wait();
+ }
+ return retval;
+ } catch (Exception e) { throw new RuntimeException(e); }
+ }
+
+ public static interface ByteCallback {
+ public void call(byte b) throws Exception;
+ }
+
+ private Vector callbacks = new Vector();
+
+ private Thread reader = new Thread() {
+ public void run() {
+ System.out.println("*** reader thread begun");
+ while(true) {
+ try {
+ byte b = in.readByte();
+ ByteCallback bc = (ByteCallback)callbacks.remove(0);
+ bc.call(b);
+ } catch (Exception e) {
+ e.printStackTrace();
+ }
+ }
+ }
+ };
+
+ public synchronized void readBus(ByteCallback bc) throws IOException {
+ callbacks.add(bc);
+ out.writeByte(2);
+ out.flush();
+ if (reader != null) {
+ reader.start();
+ reader = null;
+ }
+ }
+
+ public synchronized void readInterrupts(ByteCallback bc) throws IOException {
+ callbacks.add(bc);
+ out.writeByte(6);
+ out.flush();
+ if (reader != null) {
+ reader.start();
+ reader = null;
+ }
}
private byte[][][] cache = new byte[24][][];
- public byte mode4(int z, int y, int x) throws DeviceException {
+ public /*synchronized*/ 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 void mode4(int z, int y, int x, int d) throws DeviceException {
+
+ int lastz = 0;
+ int lastx = 0;
+ int lasty = 0;
+ public static int save = 0;
+ public static int saveof = 0;
+ public /*synchronized*/ void mode4(int z, int y, int x, int d) {
try {
- Log.debug(this, "writing configuration frame [zyxd]: " +
- pad(2, Integer.toString(z, 16)) + " " +
- pad(2, Integer.toString(y, 16)) + " " +
- pad(2, Integer.toString(x, 16)) + " " +
- pad(2, Integer.toString(d, 16))
- );
out.writeByte(1);
out.writeByte(z);
out.writeByte(y);
out.writeByte(x);
+ saveof++;
+ lastz = z;
+ lastx = x;
+ lasty = y;
out.writeByte(d);
+
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);
- } catch (IOException e) { throw new DeviceException(e); }
+ } catch (IOException e) {
+ throw new RuntimeException(e);
+ }
}
- public void flush() throws DeviceException {
+ public /*synchronized*/ void flush() {
try {
out.flush();
- } catch (IOException e) { throw new DeviceException(e); }
+ } catch (IOException e) {
+ throw new RuntimeException(e);
+ }
}
private String pad(int i, String s) { if (s.length()>i) return s; return "0"+pad((i-1),s); }
projects / slipway.git / blobdiff