mirror of
https://github.com/dkgrizzly/GreenSCSI.git
synced 2025-01-02 16:32:37 +00:00
Remove v1 files as unused
This commit is contained in:
Eric Helgeson
Eric Helgeson
parent
3f0b08bf85
commit
492b68dbc0
730
ArdSCSino.ino
730
ArdSCSino.ino
@ -1,730 +0,0 @@
|
|||||||
/*
|
|
||||||
* SCSI-HD device emulator
|
|
||||||
*/
|
|
||||||
#include <SPI.h>
|
|
||||||
#include "SdFat.h"
|
|
||||||
|
|
||||||
//Set ENABLE_EXTENDED_TRANSFER_CLASS to 1
|
|
||||||
//libraries/SdFat/SdFatConfig.h
|
|
||||||
SPIClass SPI_2(2);
|
|
||||||
SdFatEX SD(&SPI_2);
|
|
||||||
|
|
||||||
//#define SPI_SPEED SD_SCK_MHZ(18)
|
|
||||||
|
|
||||||
#define LOG(XX) //Serial.print(XX)
|
|
||||||
#define LOGHEX(XX) //Serial.print(XX, HEX)
|
|
||||||
#define LOGN(XX) //Serial.println(XX)
|
|
||||||
#define LOGHEXN(XX) //Serial.println(XX, HEX)
|
|
||||||
|
|
||||||
#define high 0
|
|
||||||
#define low 1
|
|
||||||
|
|
||||||
#define isHigh(XX) ((XX) == high)
|
|
||||||
#define isLow(XX) ((XX) != high)
|
|
||||||
|
|
||||||
#define gpio_mode(pin,val) gpio_set_mode(PIN_MAP[pin].gpio_device, PIN_MAP[pin].gpio_bit, val);
|
|
||||||
#define gpio_write(pin,val) gpio_write_bit(PIN_MAP[pin].gpio_device, PIN_MAP[pin].gpio_bit, val)
|
|
||||||
#define gpio_read(pin) gpio_read_bit(PIN_MAP[pin].gpio_device, PIN_MAP[pin].gpio_bit)
|
|
||||||
|
|
||||||
//#define DB0 PA0 // SCSI:DB0
|
|
||||||
//#define DB1 PA1 // SCSI:DB1
|
|
||||||
//#define DB2 PA2 // SCSI:DB2
|
|
||||||
//#define DB3 PA3 // SCSI:DB3
|
|
||||||
//#define DB4 PA4 // SCSI:DB4
|
|
||||||
//#define DB5 PA5 // SCSI:DB5
|
|
||||||
//#define DB6 PA6 // SCSI:DB6
|
|
||||||
//#define DB7 PA7 // SCSI:DB7
|
|
||||||
//#define DBP PA8 // SCSI:DBP
|
|
||||||
|
|
||||||
#define ATN PB0 // SCSI:ATN
|
|
||||||
#define BSY PB1 // SCSI:BSY
|
|
||||||
#define ACK PB10 // SCSI:ACK
|
|
||||||
#define RST PB11 // SCSI:RST
|
|
||||||
#define MSG PB5 // SCSI:MSG
|
|
||||||
#define SEL PB6 // SCSI:SEL
|
|
||||||
#define CD PB7 // SCSI:C/D
|
|
||||||
#define REQ PB8 // SCSI:REQ
|
|
||||||
#define IO PB9 // SCSI:I/O
|
|
||||||
|
|
||||||
#define SD_CS PB12 // SDCARD:CS
|
|
||||||
#define LED PC13 // LED
|
|
||||||
|
|
||||||
#define SCSIID 0 // SCSI-ID
|
|
||||||
|
|
||||||
#define BLOCKSIZE 512 // 1BLOCK size
|
|
||||||
uint8_t m_senseKey = 0; // Sense key
|
|
||||||
volatile bool m_isBusReset = false; // Bus reset
|
|
||||||
|
|
||||||
#define HDIMG_FILE "HD.HDS" // HD image file name
|
|
||||||
File m_file; // File object
|
|
||||||
uint32_t m_fileSize; // file size
|
|
||||||
byte m_buf[BLOCKSIZE]; // General purpose buffer
|
|
||||||
|
|
||||||
int m_msc;
|
|
||||||
bool m_msb[256];
|
|
||||||
|
|
||||||
/*
|
|
||||||
* IO read
|
|
||||||
*/
|
|
||||||
inline byte readIO(void)
|
|
||||||
{
|
|
||||||
//GPIO (SCSI BUS) initialization
|
|
||||||
//Port setting register (lower level)
|
|
||||||
GPIOA->regs->CRL = 0x88888888; // Configure GPIOA[7:0]
|
|
||||||
uint32 ret = GPIOA->regs->IDR;
|
|
||||||
byte bret = 0x00;
|
|
||||||
bret |= ((!bitRead(ret,7)) << 7);
|
|
||||||
bret |= ((!bitRead(ret,6)) << 6);
|
|
||||||
bret |= ((!bitRead(ret,5)) << 5);
|
|
||||||
bret |= ((!bitRead(ret,4)) << 4);
|
|
||||||
bret |= ((!bitRead(ret,3)) << 3);
|
|
||||||
bret |= ((!bitRead(ret,2)) << 2);
|
|
||||||
bret |= ((!bitRead(ret,1)) << 1);
|
|
||||||
bret |= ((!bitRead(ret,0)) << 0);
|
|
||||||
return bret;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* IO writing.
|
|
||||||
*/
|
|
||||||
inline void writeIO(byte v)
|
|
||||||
{
|
|
||||||
//GPIO (SCSI BUS) initialization
|
|
||||||
//Port setting register (lower)
|
|
||||||
// GPIOA->regs->CRL = 0x11111111; // Configure GPIOA PP[7:0]10MHz
|
|
||||||
GPIOA->regs->CRL = 0x33333333; // Configure GPIOA PP[7:0]50MHz
|
|
||||||
//Port setting register (upper)
|
|
||||||
GPIOA->regs->CRH = 0x00000003; // Configure GPIOA PP[16:8]50MHz
|
|
||||||
uint32 retL = 0x00;
|
|
||||||
uint32 retH = 0x00;
|
|
||||||
|
|
||||||
if(!parity(v)) {
|
|
||||||
bitWrite(retL, 8, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 8, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 7 )) {
|
|
||||||
bitWrite(retL, 7, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 7, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 6 )) {
|
|
||||||
bitWrite(retL, 6, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 6, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 5 )) {
|
|
||||||
bitWrite(retL, 5, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 5, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 4 )) {
|
|
||||||
bitWrite(retL, 4, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 4, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 3 )) {
|
|
||||||
bitWrite(retL, 3, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 3, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 2 )) {
|
|
||||||
bitWrite(retL, 2, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 2, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 1 )) {
|
|
||||||
bitWrite(retL, 1, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 1, 1);
|
|
||||||
}
|
|
||||||
if(v & ( 1 << 0 )) {
|
|
||||||
bitWrite(retL, 0, 1);
|
|
||||||
} else {
|
|
||||||
bitWrite(retH, 0, 1);
|
|
||||||
}
|
|
||||||
// Bit set to LOW
|
|
||||||
GPIOA->regs->BRR = retL ;
|
|
||||||
// Bit set to HIGH
|
|
||||||
GPIOA->regs->BSRR = retH ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Initialization.
|
|
||||||
* Parity check
|
|
||||||
*/
|
|
||||||
inline int parity(byte val) {
|
|
||||||
val ^= val >> 16;
|
|
||||||
val ^= val >> 8;
|
|
||||||
val ^= val >> 4;
|
|
||||||
val ^= val >> 2;
|
|
||||||
val ^= val >> 1;
|
|
||||||
|
|
||||||
return val & 0x00000001;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Initialization.
|
|
||||||
* Initialize the bus and set the PIN orientation
|
|
||||||
*/
|
|
||||||
void setup()
|
|
||||||
{
|
|
||||||
// PA15 / PB3 / PB4 Cannot be used
|
|
||||||
// JTAG Because it is used for debugging.
|
|
||||||
disableDebugPorts();
|
|
||||||
|
|
||||||
//Serial initialization
|
|
||||||
//Serial.begin(9600);
|
|
||||||
//while (!Serial);
|
|
||||||
|
|
||||||
//PIN initialization
|
|
||||||
gpio_mode(LED, GPIO_OUTPUT_OD);
|
|
||||||
gpio_write(LED, low);
|
|
||||||
|
|
||||||
//GPIO(SCSI BUS)Initialization
|
|
||||||
//Port setting register (lower)
|
|
||||||
GPIOA->regs->CRL = 0x888888888; // Configure GPIOA[8:0]
|
|
||||||
|
|
||||||
gpio_mode(ATN, GPIO_INPUT_PU);
|
|
||||||
gpio_mode(BSY, GPIO_INPUT_PU);
|
|
||||||
gpio_mode(ACK, GPIO_INPUT_PU);
|
|
||||||
gpio_mode(RST, GPIO_INPUT_PU);
|
|
||||||
gpio_mode(SEL, GPIO_INPUT_PU);
|
|
||||||
|
|
||||||
gpio_mode(MSG, GPIO_OUTPUT_PP);
|
|
||||||
gpio_mode(CD, GPIO_OUTPUT_PP);
|
|
||||||
gpio_mode(REQ, GPIO_OUTPUT_PP);
|
|
||||||
gpio_mode(IO, GPIO_OUTPUT_PP);
|
|
||||||
|
|
||||||
gpio_write(MSG, low);
|
|
||||||
gpio_write(CD, low);
|
|
||||||
gpio_write(REQ, low);
|
|
||||||
gpio_write(IO, low);
|
|
||||||
|
|
||||||
//Occurs when the RST pin state changes from HIGH to LOW
|
|
||||||
attachInterrupt(PIN_MAP[RST].gpio_bit, onBusReset, FALLING);
|
|
||||||
|
|
||||||
if(!SD.begin(SD_CS,SPI_FULL_SPEED)) {
|
|
||||||
Serial.println("SD initialization failed!");
|
|
||||||
onFalseInit();
|
|
||||||
}
|
|
||||||
//HD image file
|
|
||||||
m_file = SD.open(HDIMG_FILE, O_RDWR);
|
|
||||||
if(!m_file) {
|
|
||||||
Serial.println("Error: open hdimg");
|
|
||||||
onFalseInit();
|
|
||||||
}
|
|
||||||
m_fileSize = m_file.size();
|
|
||||||
Serial.println("Found Valid HD Image File.");
|
|
||||||
Serial.print(m_fileSize);
|
|
||||||
Serial.println("byte");
|
|
||||||
Serial.print(m_fileSize / 1024);
|
|
||||||
Serial.println("KB");
|
|
||||||
Serial.print(m_fileSize / 1024 / 1024);
|
|
||||||
Serial.println("MB");
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Initialization failure.
|
|
||||||
*/
|
|
||||||
void onFalseInit(void)
|
|
||||||
{
|
|
||||||
while(true) {
|
|
||||||
gpio_write(LED, high);
|
|
||||||
delay(500);
|
|
||||||
gpio_write(LED, low);
|
|
||||||
delay(500);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Bus reset interrupt.
|
|
||||||
*/
|
|
||||||
void onBusReset(void)
|
|
||||||
{
|
|
||||||
if(isHigh(gpio_read(RST))) {
|
|
||||||
delayMicroseconds(20);
|
|
||||||
if(isHigh(gpio_read(RST))) {
|
|
||||||
LOGN("BusReset!");
|
|
||||||
m_isBusReset = true;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Read by handshake.
|
|
||||||
*/
|
|
||||||
byte readHandshake(void)
|
|
||||||
{
|
|
||||||
gpio_write(REQ, high);
|
|
||||||
while(isLow(gpio_read(ACK))) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
byte r = readIO();
|
|
||||||
gpio_write(REQ, low);
|
|
||||||
while(isHigh(gpio_read(ACK))) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return r;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Write with a handshake.
|
|
||||||
*/
|
|
||||||
void writeHandshake(byte d)
|
|
||||||
{
|
|
||||||
writeIO(d);
|
|
||||||
gpio_write(REQ, high);
|
|
||||||
while(isLow(gpio_read(ACK))) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
gpio_write(REQ, low);
|
|
||||||
while(isHigh(gpio_read(ACK))) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Data in phase.
|
|
||||||
* Send len bytes of data array p.
|
|
||||||
*/
|
|
||||||
void writeDataPhase(int len, byte* p)
|
|
||||||
{
|
|
||||||
LOGN("DATAIN PHASE");
|
|
||||||
gpio_write(MSG, low);
|
|
||||||
gpio_write(CD, low);
|
|
||||||
gpio_write(IO, high);
|
|
||||||
for (int i = 0; i < len; i++) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
writeHandshake(p[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Data in phase.
|
|
||||||
* Send len block while reading from SD card.
|
|
||||||
*/
|
|
||||||
void writeDataPhaseSD(uint32_t adds, uint32_t len)
|
|
||||||
{
|
|
||||||
LOGN("DATAIN PHASE(SD)");
|
|
||||||
uint32_t pos = adds * BLOCKSIZE;
|
|
||||||
m_file.seek(pos);
|
|
||||||
gpio_write(MSG, low);
|
|
||||||
gpio_write(CD, low);
|
|
||||||
gpio_write(IO, high);
|
|
||||||
for(uint32_t i = 0; i < len; i++) {
|
|
||||||
m_file.read(m_buf, BLOCKSIZE);
|
|
||||||
for(int j = 0; j < BLOCKSIZE; j++) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
writeHandshake(m_buf[j]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Data out phase.
|
|
||||||
* Write to SD card while reading len block.
|
|
||||||
*/
|
|
||||||
void readDataPhaseSD(uint32_t adds, uint32_t len)
|
|
||||||
{
|
|
||||||
LOGN("DATAOUT PHASE(SD)");
|
|
||||||
uint32_t pos = adds * BLOCKSIZE;
|
|
||||||
m_file.seek(pos);
|
|
||||||
gpio_write(MSG, low);
|
|
||||||
gpio_write(CD, low);
|
|
||||||
gpio_write(IO, low);
|
|
||||||
for(uint32_t i = 0; i < len; i++) {
|
|
||||||
for(int j = 0; j < BLOCKSIZE; j++) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
m_buf[j] = readHandshake();
|
|
||||||
}
|
|
||||||
m_file.write(m_buf, BLOCKSIZE);
|
|
||||||
}
|
|
||||||
m_file.flush();
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* INQUIRY command processing.
|
|
||||||
*/
|
|
||||||
void onInquiryCommand(byte len)
|
|
||||||
{
|
|
||||||
byte buf[36] = {
|
|
||||||
0x00, //Device type
|
|
||||||
0x00, //RMB = 0
|
|
||||||
0x01, //ISO,ECMA,ANSI version
|
|
||||||
0x01, //Response data format
|
|
||||||
35 - 4, //Additional data length
|
|
||||||
0, 0, //Reserve
|
|
||||||
0x00, //Support function
|
|
||||||
'T', 'N', 'B', ' ', ' ', ' ', ' ', ' ',
|
|
||||||
'A', 'r', 'd', 'S', 'C', 'S', 'i', 'n', 'o', ' ', ' ',' ', ' ', ' ', ' ', ' ',
|
|
||||||
'0', '0', '1', '0',
|
|
||||||
};
|
|
||||||
writeDataPhase(len < 36 ? len : 36, buf);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* REQUEST SENSE command processing.
|
|
||||||
*/
|
|
||||||
void onRequestSenseCommand(byte len)
|
|
||||||
{
|
|
||||||
byte buf[18] = {
|
|
||||||
0x70, //CheckCondition
|
|
||||||
0, //Segment number
|
|
||||||
0x00, //Sense key
|
|
||||||
0, 0, 0, 0, //information
|
|
||||||
17 - 7 , //Additional data length
|
|
||||||
0,
|
|
||||||
};
|
|
||||||
buf[2] = m_senseKey;
|
|
||||||
m_senseKey = 0;
|
|
||||||
writeDataPhase(len < 18 ? len : 18, buf);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* READ CAPACITY command processing.
|
|
||||||
*/
|
|
||||||
void onReadCapacityCommand(byte pmi)
|
|
||||||
{
|
|
||||||
uint32_t bc = m_fileSize / BLOCKSIZE;
|
|
||||||
uint32_t bl = BLOCKSIZE;
|
|
||||||
uint8_t buf[8] = {
|
|
||||||
bc >> 24, bc >> 16, bc >> 8, bc,
|
|
||||||
bl >> 24, bl >> 16, bl >> 8, bl
|
|
||||||
};
|
|
||||||
writeDataPhase(8, buf);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* READ6/10 Command processing.
|
|
||||||
*/
|
|
||||||
byte onReadCommand(uint32_t adds, uint32_t len)
|
|
||||||
{
|
|
||||||
LOGN("-R");
|
|
||||||
LOGHEXN(adds);
|
|
||||||
LOGHEXN(len);
|
|
||||||
gpio_write(LED, high);
|
|
||||||
writeDataPhaseSD(adds, len);
|
|
||||||
gpio_write(LED, low);
|
|
||||||
return 0; //sts
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* WRITE6/10 Command processing.
|
|
||||||
*/
|
|
||||||
byte onWriteCommand(uint32_t adds, uint32_t len)
|
|
||||||
{
|
|
||||||
LOGN("-W");
|
|
||||||
LOGHEXN(adds);
|
|
||||||
LOGHEXN(len);
|
|
||||||
gpio_write(LED, high);
|
|
||||||
readDataPhaseSD(adds, len);
|
|
||||||
gpio_write(LED, low);
|
|
||||||
return 0; //sts
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* MODE SENSE command processing.
|
|
||||||
*/
|
|
||||||
void onModeSenseCommand(byte dbd, int pageCode, uint32_t len)
|
|
||||||
{
|
|
||||||
memset(m_buf, 0, sizeof(m_buf));
|
|
||||||
int a = 4;
|
|
||||||
if(dbd == 0) {
|
|
||||||
uint32_t bc = m_fileSize / BLOCKSIZE;
|
|
||||||
uint32_t bl = BLOCKSIZE;
|
|
||||||
byte c[8] = {
|
|
||||||
0,//Dense code
|
|
||||||
bc >> 16, bc >> 8, bc,
|
|
||||||
0, //Reserve
|
|
||||||
bl >> 16, bl >> 8, bl
|
|
||||||
};
|
|
||||||
memcpy(&m_buf[4], c, 8);
|
|
||||||
a += 8;
|
|
||||||
m_buf[3] = 0x08;
|
|
||||||
}
|
|
||||||
switch(pageCode) {
|
|
||||||
case 0x3F:
|
|
||||||
case 0x03: //Drive parameters
|
|
||||||
m_buf[a + 0] = 0x03; //Page code
|
|
||||||
m_buf[a + 1] = 0x16; //Page length
|
|
||||||
m_buf[a + 11] = 0x3F;//number of sectors/track
|
|
||||||
a += 24;
|
|
||||||
if(pageCode != 0x3F) {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case 0x04: //Drive parameters
|
|
||||||
{
|
|
||||||
uint32_t bc = m_fileSize / BLOCKSIZE;
|
|
||||||
m_buf[a + 0] = 0x04; //Page code
|
|
||||||
m_buf[a + 1] = 0x16; // Page length
|
|
||||||
m_buf[a + 2] = bc >> 16;// Cylinder length
|
|
||||||
m_buf[a + 3] = bc >> 8;
|
|
||||||
m_buf[a + 4] = bc;
|
|
||||||
m_buf[a + 5] = 1; //Number of heads
|
|
||||||
a += 24;
|
|
||||||
}
|
|
||||||
if(pageCode != 0x3F) {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
m_buf[0] = a - 1;
|
|
||||||
writeDataPhase(len < a ? len : a, m_buf);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* MsgIn2.
|
|
||||||
*/
|
|
||||||
void MsgIn2(int msg)
|
|
||||||
{
|
|
||||||
LOGN("MsgIn2");
|
|
||||||
gpio_write(MSG, high);
|
|
||||||
gpio_write(CD, high);
|
|
||||||
gpio_write(IO, high);
|
|
||||||
writeHandshake(msg);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* MsgOut2.
|
|
||||||
*/
|
|
||||||
void MsgOut2()
|
|
||||||
{
|
|
||||||
LOGN("MsgOut2");
|
|
||||||
gpio_write(MSG, high);
|
|
||||||
gpio_write(CD, high);
|
|
||||||
gpio_write(IO, low);
|
|
||||||
m_msb[m_msc] = readHandshake();
|
|
||||||
m_msc++;
|
|
||||||
m_msc %= 256;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Main loop.
|
|
||||||
*/
|
|
||||||
void loop()
|
|
||||||
{
|
|
||||||
int sts = 0;
|
|
||||||
int msg = 0;
|
|
||||||
|
|
||||||
//BSY,SEL + is bus free
|
|
||||||
// Selection check
|
|
||||||
// Loop between BSY-
|
|
||||||
if(isHigh(gpio_read(BSY))) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
// Loop while SEL is +
|
|
||||||
if(isLow(gpio_read(SEL))) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
// BSY+ SEL-
|
|
||||||
byte db = readIO();
|
|
||||||
if((db & (1 << SCSIID)) == 0) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
LOGN("Selection");
|
|
||||||
m_isBusReset = false;
|
|
||||||
// Set BSY to-when selected
|
|
||||||
gpio_mode(BSY, GPIO_OUTPUT_PP);
|
|
||||||
gpio_write(BSY, high);
|
|
||||||
while(isHigh(gpio_read(SEL))) {
|
|
||||||
if(m_isBusReset) {
|
|
||||||
goto BusFree;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if(isHigh(gpio_read(ATN))) {
|
|
||||||
bool syncenable = false;
|
|
||||||
int syncperiod = 50;
|
|
||||||
int syncoffset = 0;
|
|
||||||
m_msc = 0;
|
|
||||||
memset(m_msb, 0x00, sizeof(m_msb));
|
|
||||||
while(isHigh(gpio_read(ATN))) {
|
|
||||||
MsgOut2();
|
|
||||||
}
|
|
||||||
for(int i = 0; i < m_msc; i++) {
|
|
||||||
// ABORT
|
|
||||||
if (m_msb[i] == 0x06) {
|
|
||||||
goto BusFree;
|
|
||||||
}
|
|
||||||
// BUS DEVICE RESET
|
|
||||||
if (m_msb[i] == 0x0C) {
|
|
||||||
syncoffset = 0;
|
|
||||||
goto BusFree;
|
|
||||||
}
|
|
||||||
// IDENTIFY
|
|
||||||
if (m_msb[i] >= 0x80) {
|
|
||||||
}
|
|
||||||
// Extended message
|
|
||||||
if (m_msb[i] == 0x01) {
|
|
||||||
// Check only when synchronous transfer is possible
|
|
||||||
if (!syncenable || m_msb[i + 2] != 0x01) {
|
|
||||||
MsgIn2(0x07);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
// Transfer period factor(50 x 4 = Limited to 200ns)
|
|
||||||
syncperiod = m_msb[i + 3];
|
|
||||||
if (syncperiod > 50) {
|
|
||||||
syncoffset = 50;
|
|
||||||
}
|
|
||||||
// REQ/ACK offset(Limited to 16)
|
|
||||||
syncoffset = m_msb[i + 4];
|
|
||||||
if (syncoffset > 16) {
|
|
||||||
syncoffset = 16;
|
|
||||||
}
|
|
||||||
// STDR response message generation
|
|
||||||
MsgIn2(0x01);
|
|
||||||
MsgIn2(0x03);
|
|
||||||
MsgIn2(0x01);
|
|
||||||
MsgIn2(syncperiod);
|
|
||||||
MsgIn2(syncoffset);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
LOGN("Command");
|
|
||||||
gpio_write(MSG, low);
|
|
||||||
gpio_write(CD, high);
|
|
||||||
gpio_write(IO, low);
|
|
||||||
int len;
|
|
||||||
byte cmd[12];
|
|
||||||
cmd[0] = readHandshake();
|
|
||||||
LOGHEX(cmd[0]);
|
|
||||||
len = 1;
|
|
||||||
switch(cmd[0] >> 5) {
|
|
||||||
case 0b000:
|
|
||||||
len = 6;
|
|
||||||
break;
|
|
||||||
case 0b001:
|
|
||||||
len = 10;
|
|
||||||
break;
|
|
||||||
case 0b010:
|
|
||||||
len = 10;
|
|
||||||
break;
|
|
||||||
case 0b101:
|
|
||||||
len = 12;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
for(int i = 1; i < len; i++ ) {
|
|
||||||
cmd[i] = readHandshake();
|
|
||||||
LOGHEX(cmd[i]);
|
|
||||||
}
|
|
||||||
LOGN("");
|
|
||||||
|
|
||||||
switch(cmd[0]) {
|
|
||||||
case 0x00:
|
|
||||||
LOGN("[Test Unit]");
|
|
||||||
break;
|
|
||||||
case 0x01:
|
|
||||||
LOGN("[Rezero Unit]");
|
|
||||||
break;
|
|
||||||
case 0x03:
|
|
||||||
LOGN("[RequestSense]");
|
|
||||||
onRequestSenseCommand(cmd[4]);
|
|
||||||
break;
|
|
||||||
case 0x04:
|
|
||||||
LOGN("[FormatUnit]");
|
|
||||||
break;
|
|
||||||
case 0x06:
|
|
||||||
LOGN("[FormatUnit]");
|
|
||||||
break;
|
|
||||||
case 0x07:
|
|
||||||
LOGN("[ReassignBlocks]");
|
|
||||||
break;
|
|
||||||
case 0x08:
|
|
||||||
LOGN("[Read6]");
|
|
||||||
sts = onReadCommand((((uint32_t)cmd[1] & 0x1F) << 16) | ((uint32_t)cmd[2] << 8) | cmd[3], (cmd[4] == 0) ? 0x100 : cmd[4]);
|
|
||||||
break;
|
|
||||||
case 0x0A:
|
|
||||||
LOGN("[Write6]");
|
|
||||||
sts = onWriteCommand((((uint32_t)cmd[1] & 0x1F) << 16) | ((uint32_t)cmd[2] << 8) | cmd[3], (cmd[4] == 0) ? 0x100 : cmd[4]);
|
|
||||||
break;
|
|
||||||
case 0x0B:
|
|
||||||
LOGN("[Seek6]");
|
|
||||||
break;
|
|
||||||
case 0x12:
|
|
||||||
LOGN("[Inquiry]");
|
|
||||||
onInquiryCommand(cmd[4]);
|
|
||||||
break;
|
|
||||||
case 0x1A:
|
|
||||||
LOGN("[ModeSense6]");
|
|
||||||
onModeSenseCommand(cmd[1]&0x80, cmd[2] & 0x3F, cmd[4]);
|
|
||||||
break;
|
|
||||||
case 0x1B:
|
|
||||||
LOGN("[StartStopUnit]");
|
|
||||||
break;
|
|
||||||
case 0x1E:
|
|
||||||
LOGN("[PreAllowMed.Removal]");
|
|
||||||
break;
|
|
||||||
case 0x25:
|
|
||||||
LOGN("[ReadCapacity]");
|
|
||||||
onReadCapacityCommand(cmd[8]);
|
|
||||||
break;
|
|
||||||
case 0x28:
|
|
||||||
LOGN("[Read10]");
|
|
||||||
sts = onReadCommand(((uint32_t)cmd[2] << 24) | ((uint32_t)cmd[3] << 16) | ((uint32_t)cmd[4] << 8) | cmd[5], ((uint32_t)cmd[7] << 8) | cmd[8]);
|
|
||||||
break;
|
|
||||||
case 0x2A:
|
|
||||||
LOGN("[Write10]");
|
|
||||||
sts = onWriteCommand(((uint32_t)cmd[2] << 24) | ((uint32_t)cmd[3] << 16) | ((uint32_t)cmd[4] << 8) | cmd[5], ((uint32_t)cmd[7] << 8) | cmd[8]);
|
|
||||||
break;
|
|
||||||
case 0x2B:
|
|
||||||
LOGN("[Seek10]");
|
|
||||||
break;
|
|
||||||
case 0x5A:
|
|
||||||
LOGN("[ModeSense10]");
|
|
||||||
onModeSenseCommand(cmd[1] & 0x80, cmd[2] & 0x3F, ((uint32_t)cmd[7] << 8) | cmd[8]);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
LOGN("[*Unknown]");
|
|
||||||
sts = 2;
|
|
||||||
m_senseKey = 5;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if(m_isBusReset) {
|
|
||||||
goto BusFree;
|
|
||||||
}
|
|
||||||
|
|
||||||
LOGN("Sts");
|
|
||||||
gpio_write(MSG, low);
|
|
||||||
gpio_write(CD, high);
|
|
||||||
gpio_write(IO, high);
|
|
||||||
writeHandshake(sts);
|
|
||||||
if(m_isBusReset) {
|
|
||||||
goto BusFree;
|
|
||||||
}
|
|
||||||
|
|
||||||
LOGN("MsgIn");
|
|
||||||
gpio_write(MSG, high);
|
|
||||||
gpio_write(CD, high);
|
|
||||||
gpio_write(IO, high);
|
|
||||||
writeHandshake(msg);
|
|
||||||
|
|
||||||
BusFree:
|
|
||||||
LOGN("BusFree");
|
|
||||||
m_isBusReset = false;
|
|
||||||
gpio_write(REQ, low);
|
|
||||||
gpio_write(MSG, low);
|
|
||||||
gpio_write(CD, low);
|
|
||||||
gpio_write(IO, low);
|
|
||||||
// gpio_write(BSY, low);
|
|
||||||
gpio_mode(BSY, GPIO_INPUT_PU);
|
|
||||||
}
|
|
||||||
BIN
ArdSCSino.png
BIN
ArdSCSino.png
Binary file not shown.
|
Before Width: | Height: | Size: 834 KiB |
Binary file not shown.
Loading…
Reference in New Issue
Block a user