Drive Primitive

gistfile1.java

public void write(byte bytes[]) {
	int opcode = bytes[0];
	
	opcode = (opcode < 0) ? opcode + 256 : opcode;
	
	int velocity = (bytes[1] << 8) | (bytes[2] & 0xFF);
	int radius = (bytes[3] << 8) | (bytes[4] & 0xFF);
	
	System.out.println("write(" + opcode + ", " + velocity + ", " + radius + ")");
}