rework SD controller emulation to work with Input- and OutputStreams (no longer load the image into a byte array)
This commit is contained in:
1 parent
c61a63d5bb
commit
7a215736fe
1 file changed
+66
-27
@@ -27,9 +27,9 @@ package com.loomcom.symon.devices;
|
|||||||
|
|
||||||
import com.loomcom.symon.exceptions.MemoryAccessException;
|
import com.loomcom.symon.exceptions.MemoryAccessException;
|
||||||
import com.loomcom.symon.exceptions.MemoryRangeException;
|
import com.loomcom.symon.exceptions.MemoryRangeException;
|
||||||
import java.io.ByteArrayOutputStream;
|
|
||||||
import java.io.File;
|
import java.io.File;
|
||||||
import java.io.FileInputStream;
|
import java.io.FileInputStream;
|
||||||
|
import java.io.FileOutputStream;
|
||||||
import java.io.IOException;
|
import java.io.IOException;
|
||||||
import java.util.logging.Level;
|
import java.util.logging.Level;
|
||||||
import java.util.logging.Logger;
|
import java.util.logging.Logger;
|
||||||
@@ -48,34 +48,28 @@ public class SdController extends Device {
|
|||||||
}
|
}
|
||||||
|
|
||||||
public static final int CONTROLLER_SIZE = 8;
|
public static final int CONTROLLER_SIZE = 8;
|
||||||
|
private final int SECTOR_SIZE = 512;
|
||||||
private final static Logger logger = Logger.getLogger(SdController.class.getName());
|
private final static Logger logger = Logger.getLogger(SdController.class.getName());
|
||||||
private byte[] sdcontent;
|
|
||||||
|
|
||||||
|
private File sdImageFile;
|
||||||
private int lba0,lba1,lba2;
|
private int lba0,lba1,lba2;
|
||||||
private int command;
|
private int command;
|
||||||
private int position;
|
private int position;
|
||||||
private Status status = Status.IDLE;
|
private Status status = Status.IDLE;
|
||||||
|
|
||||||
|
private final byte[] readBuffer = new byte[SECTOR_SIZE];
|
||||||
|
private final byte[] writeBuffer = new byte[SECTOR_SIZE];
|
||||||
|
private int readPosition = 0;
|
||||||
|
private int writePosition = 0;
|
||||||
|
|
||||||
|
|
||||||
public SdController(int address) throws MemoryRangeException {
|
public SdController(int address) throws MemoryRangeException {
|
||||||
super(address, address + CONTROLLER_SIZE - 1, "SDCONTROLLER");
|
super(address, address + CONTROLLER_SIZE - 1, "SDCONTROLLER");
|
||||||
|
|
||||||
// assume an empty 64K SD card by default
|
sdImageFile = new File("sd.img");
|
||||||
sdcontent = new byte[64 * 1024];
|
if(!sdImageFile.exists()) {
|
||||||
|
sdImageFile = null;
|
||||||
// try to load an actual SD card image
|
logger.log(Level.INFO, "Could not find SD card image 'sd.img'");
|
||||||
try {
|
|
||||||
FileInputStream fis = new FileInputStream(new File("sd.img"));
|
|
||||||
ByteArrayOutputStream baos = new ByteArrayOutputStream();
|
|
||||||
byte[] buf = new byte[2048];
|
|
||||||
int read = fis.read(buf);
|
|
||||||
while(read > 0) {
|
|
||||||
baos.write(buf, 0, read);
|
|
||||||
read = fis.read(buf);
|
|
||||||
}
|
|
||||||
sdcontent = baos.toByteArray();
|
|
||||||
} catch (IOException ex) {
|
|
||||||
logger.log(Level.INFO, "Could not load image for SD card from file 'sd.img'");
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -120,24 +114,70 @@ public class SdController extends Device {
|
|||||||
this.position = lba0 + (lba1 << 8) + (lba2 << 16);
|
this.position = lba0 + (lba1 << 8) + (lba2 << 16);
|
||||||
// each sector is 512 bytes, so multiply accordingly
|
// each sector is 512 bytes, so multiply accordingly
|
||||||
this.position <<= 9;
|
this.position <<= 9;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
private void prepareRead() {
|
||||||
|
this.status = Status.READ;
|
||||||
|
this.readPosition = 0;
|
||||||
|
computePosition();
|
||||||
|
|
||||||
|
if(sdImageFile != null) {
|
||||||
|
try {
|
||||||
|
FileInputStream fis = new FileInputStream(sdImageFile);
|
||||||
|
fis.skip(this.position);
|
||||||
|
int read = fis.read(readBuffer);
|
||||||
|
if(read < SECTOR_SIZE) {
|
||||||
|
logger.log(Level.WARNING, "not enough data to fill read buffer from SD image file");
|
||||||
|
}
|
||||||
|
fis.close();
|
||||||
|
} catch (IOException ex) {
|
||||||
|
logger.log(Level.WARNING, "could not fill read buffer from SD image file", ex);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
private void prepareWrite() {
|
||||||
|
this.status = Status.WRITE;
|
||||||
|
this.writePosition = 0;
|
||||||
|
computePosition();
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
private int readData() {
|
private int readData() {
|
||||||
if(status != Status.READ) {
|
if(status != Status.READ) {
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
this.position %= this.sdcontent.length;
|
int data = readBuffer[readPosition++];
|
||||||
int data = this.sdcontent[this.position++];
|
|
||||||
if(this.position % 512 == 0) {
|
if(readPosition >= SECTOR_SIZE) {
|
||||||
this.status = Status.IDLE;
|
this.status = Status.IDLE;
|
||||||
}
|
}
|
||||||
|
|
||||||
return data;
|
return data;
|
||||||
}
|
}
|
||||||
|
|
||||||
private void writeData(int data) {
|
private void writeData(int data) {
|
||||||
this.position %= this.sdcontent.length;
|
if(status != Status.WRITE) {
|
||||||
this.sdcontent[this.position++] = (byte) data;
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
writeBuffer[writePosition++] = (byte) data;
|
||||||
|
|
||||||
|
if(writePosition >= SECTOR_SIZE) {
|
||||||
|
if(sdImageFile != null) {
|
||||||
|
try {
|
||||||
|
FileOutputStream fos = new FileOutputStream(sdImageFile);
|
||||||
|
fos.write(writeBuffer, this.position, writeBuffer.length);
|
||||||
|
fos.close();
|
||||||
|
} catch (IOException ex) {
|
||||||
|
logger.log(Level.WARNING, "could not write data back to SD image file!", ex);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
this.status = Status.IDLE;
|
||||||
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
private int readStatus() {
|
private int readStatus() {
|
||||||
@@ -155,15 +195,14 @@ public class SdController extends Device {
|
|||||||
this.command = data;
|
this.command = data;
|
||||||
switch(this.command) {
|
switch(this.command) {
|
||||||
case 0 :
|
case 0 :
|
||||||
this.status = Status.READ;
|
prepareRead();
|
||||||
break;
|
break;
|
||||||
case 1 :
|
case 1 :
|
||||||
this.status = Status.WRITE;
|
prepareWrite();
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
this.status = Status.IDLE;
|
this.status = Status.IDLE;
|
||||||
}
|
}
|
||||||
computePosition();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
@Override
|
@Override
|
||||||
|
|||||||
Reference in new issue
Block a user