diff --git a/ArdSCSinoV2.ino b/ArdSCSinoV2.ino index 5cc4125..cf0198d 100644 --- a/ArdSCSinoV2.ino +++ b/ArdSCSinoV2.ino @@ -1,19 +1,53 @@ /* - * SCSI-HDデバイスエミュレータ + * SCSI-HDデバイスエミュレータ for STM32F103 */ -#include -#include "SdFat.h" -//ENABLE_EXTENDED_TRANSFER_CLASSを1に設定する -//libraries/SdFat/SdFatConfig.h +#define X1TURBO_DTC510B 0 /* for SHARP X1turbo */ +#define READ_SPEED_OPTIMIZE 1 /* リードの高速化 */ +#define WRITE_SPEED_OPTIMIZE 1 /* ライトの高速化 */ +#define USE_DB2ID_TABLE 1 /* SEL-DBからIDの取得にテーブル使用 */ + +// SCSI config +#define NUM_SCSIID 7 // サポート最大SCSI-ID数 (最小は0) +#define NUM_SCSILUN 2 // サポート最大LUN数 (最小は0) +#define READ_PARITY_CHECK 0 // リードパリティーチェックを行う（未検証） + +// HDD format +#if X1TURBO_DTC510B +#define BLOCKSIZE 256 // 1BLOCKサイズ +#else +#define BLOCKSIZE 512 // 1BLOCKサイズ +#endif + +//#include + +#include +//SdFatEX CLASSを利用可能にする +#undef ENABLE_EXTENDED_TRANSFER_CLASS +#define ENABLE_EXTENDED_TRANSFER_CLASS 1 +#include + +#ifdef USE_STM32_DMA +#warning "warning USE_STM32_DMA" +#endif + SPIClass SPI_1(1); SdFatEX SD(&SPI_1); +#if 0 +#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) +#else #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) +#endif +#define active 1 +#define inactive 0 #define high 0 #define low 1 @@ -33,7 +67,6 @@ SdFatEX SD(&SPI_1); //#define DB6 PB14 // SCSI:DB6 //#define DB7 PB15 // SCSI:DB7 //#define DBP PB0 // SCSI:DBP - #define ATN PA8 // SCSI:ATN #define BSY PA9 // SCSI:BSY #define ACK PA10 // SCSI:ACK @@ -47,123 +80,160 @@ SdFatEX SD(&SPI_1); #define SD_CS PA4 // SDCARD:CS #define LED PC13 // LED -#define SCSIID 0 // SCSI-ID +// GPIOレジスタポート +#define PAREG GPIOA->regs +#define PBREG GPIOB->regs + +// LED control +#define LED_ON() gpio_write(LED, high); +#define LED_OFF() gpio_write(LED, low); + + +// 仮想ピン（Arduio互換は遅いのでMCU依存にして） +#define PA(BIT) (BIT) +#define PB(BIT) (BIT+16) +// 仮想ピンのデコード +#define GPIOREG(VPIN) ((VPIN)>=16?PBREG:PAREG) +#define BITMASK(VPIN) (1<<((VPIN)&15)) + +#define vATN PA(8) // SCSI:ATN +#define vBSY PA(9) // SCSI:BSY +#define vACK PA(10) // SCSI:ACK +#define vRST PA(15) // SCSI:RST +#define vMSG PB(3) // SCSI:MSG +#define vSEL PB(4) // SCSI:SEL +#define vCD PB(5) // SCSI:C/D +#define vREQ PB(6) // SCSI:REQ +#define vIO PB(7) // SCSI:I/O +#define vSD_CS PA(4) // SDCARD:CS + +// SCSI 出力ピン制御 : opendrain active LOW (direct pin drive) +#define SCSI_OUT(VPIN,ACTIVE) { GPIOREG(VPIN)->BSRR = BITMASK(VPIN)<<((ACTIVE)?16:0); } + +// SCSI 入力ピン確認(inactive=0,avtive=1) +#define SCSI_IN(VPIN) ((~GPIOREG(VPIN)->IDR>>(VPIN&15))&1) + +// GPIO mode +// IN , FLOAT : 4 +// IN , PU/PD : 8 +// OUT, PUSH/PULL : 3 +// OUT, OD : 1 +//#define DB_MODE_OUT 3 +#define DB_MODE_OUT 1 +#define DB_MODE_IN 8 + +// DB,DPを出力モードにする +#define SCSI_DB_OUTPUT() { PBREG->CRL=(PBREG->CRL &0xfffffff0)|DB_MODE_OUT; PBREG->CRH = 0x11111111*DB_MODE_OUT; } +// DB,DPを入力モードにする +#define SCSI_DB_INPUT() { PBREG->CRL=(PBREG->CRL &0xfffffff0)|DB_MODE_IN ; PBREG->CRH = 0x11111111*DB_MODE_IN; } + +// BSYだけ出力をON にする +#define SCSI_BSY_ACTIVE() { gpio_mode(BSY, GPIO_OUTPUT_OD); SCSI_OUT(vBSY, active) } +// BSY,REQ,MSG,CD,IO 出力をON にする (ODの場合は変更不要） +#define SCSI_TARGET_ACTIVE() { } +// BSY,REQ,MSG,CD,IO 出力をOFFにする、BSYは最後、入力に +#define SCSI_TARGET_INACTIVE() { SCSI_OUT(vREQ,inactive); SCSI_OUT(vMSG,inactive); SCSI_OUT(vCD,inactive);SCSI_OUT(vIO,inactive); SCSI_OUT(vBSY,inactive); gpio_mode(BSY, GPIO_INPUT_PU); } + +// HDDiamge file +#define HDIMG_FILE "HDxx.HDS" // HDイメージファイル名ベース +#define HDIMG_ID_POS 2 // ID数字を埋め込む位置 +#define HDIMG_LUN_POS 3 // LUN数字を埋め込む位置 + +// HDD image +typedef struct hddimg_struct +{ + File m_file; // ファイルオブジェクト + uint32_t m_fileSize; // ファイルサイズ +}HDDIMG; +HDDIMG img[NUM_SCSIID][NUM_SCSILUN]; // 最大個数分 -#define BLOCKSIZE 512 // 1BLOCKサイズ uint8_t m_senseKey = 0; //センスキー volatile bool m_isBusReset = false; //バスリセット -#define HDIMG_FILE "HD.HDS" // HDイメージファイル名 -File m_file; // ファイルオブジェクト -uint32_t m_fileSize; // ファイルサイズ -byte m_buf[BLOCKSIZE]; // 汎用バッファ - +byte scsi_id_mask; // 応答するSCSI IDのマスクリスト +byte m_id; // 現在応答中の SCSI-ID +byte m_lun; // 現在応答中のロジカルユニット番号 +byte m_sts; // ステータスバイト +byte m_msg; // メッセージバイト +HDDIMG *m_img; // 現在の SCSI-ID,LUNに対するHDD image +byte m_buf[BLOCKSIZE+1]; // 汎用バッファ +オーバーランフェッチ int m_msc; bool m_msb[256]; +/* + * データバイト to BSRRレジスタ設定値、兼パリティーテーブル +*/ + +// パリティービット生成 +#define PTY(V) (1^((V)^((V)>>1)^((V)>>2)^((V)>>3)^((V)>>4)^((V)>>5)^((V)>>6)^((V)>>7))&1) + +// データバイト to BSRRレジスタ設定値変換テーブル +// BSRR[31:24] = DB[7:0] +// BSRR[ 16] = PTY(DB) +// BSRR[15: 8] = ~DB[7:0] +// BSRR[ 0] = ~PTY(DB) + +// DBPのセット、REQ=inactiveにする +#define DBP(D) ((((((uint32_t)(D)<<8)|PTY(D))*0x00010001)^0x0000ff01)|BITMASK(vREQ)) + +#define DBP8(D) DBP(D),DBP(D+1),DBP(D+2),DBP(D+3),DBP(D+4),DBP(D+5),DBP(D+6),DBP(D+7) +#define DBP32(D) DBP8(D),DBP8(D+8),DBP8(D+16),DBP8(D+24) + +// DBのセット,DPのセット,REQ=H(inactrive) を同時に行うBSRRレジスタ制御値 +static const uint32_t db_bsrr[256]={ + DBP32(0x00),DBP32(0x20),DBP32(0x40),DBP32(0x60), + DBP32(0x80),DBP32(0xA0),DBP32(0xC0),DBP32(0xE0) +}; +// パリティービット取得 +#define PARITY(DB) (db_bsrr[DB]&1) + +// マクロの掃除 +#undef DBP32 +#undef DBP8 +//#undef DBP +//#undef PTY + +#if USE_DB2ID_TABLE +/* DB to SCSI-ID テーブル */ +static const byte db2scsiid[256]={ + 0xff, + 0, + 1,1, + 2,2,2,2, + 3,3,3,3,3,3,3,3, + 4,4,4,4,4,4,4,4,4,4,4,4,4,4,4,4, + 5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5, + 6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6, + 6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6, + 7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7, + 7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7, + 7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7, + 7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7 +}; +#endif + + + + +void onFalseInit(void); +void onBusReset(void); + /* * IO読み込み. */ inline byte readIO(void) { - //GPIO(SCSI BUS)初期化 - //ポート設定レジスタ（下位） -// GPIOB->regs->CRL |= 0x000000008; // SET INPUT W/ PUPD on PAB-PB0 - //ポート設定レジスタ（上位） - GPIOB->regs->CRH = 0x88888888; // SET INPUT W/ PUPD on PB15-PB8 -// GPIOB->regs->ODR = 0x0000FF00; // SET PULL-UPs on PB15-PB8 //ポート入力データレジスタ uint32 ret = GPIOB->regs->IDR; - byte bret = 0x00; - bret |= (!(ret & (1<<15))) << 7; - bret |= (!(ret & (1<<14))) << 6; - bret |= (!(ret & (1<<13))) << 5; - bret |= (!(ret & (1<<12))) << 4; - bret |= (!(ret & (1<<11))) << 3; - bret |= (!(ret & (1<<10))) << 2; - bret |= (!(ret & (1<<9))) << 1; - bret |= (!(ret & (1<<8))) << 0; + byte bret = (byte)((~ret)>>8); +#if READ_PARITY_CHECK + if((db_bsrr[bret]^ret)&1) + m_sts |= 0x01; // parity error +#endif + return bret; } -/* - * IO書き込み. - */ -inline void writeIO(byte v) -{ - //GPIO(SCSI BUS)初期化 - //ポート設定レジスタ（下位） - GPIOB->regs->CRL |= 0x00000003; // SET OUTPUT W/ PUPD on PA7-PB0 50MHz - //ポート設定レジスタ（上位） - GPIOB->regs->CRH = 0x33333333; // SET OUTPUT W/ PUPD on PB15-PB8 50MHz -// GPIOB->regs->ODR != 0x0000FF00; // SET PULL-UPs on PB15-PB8 - uint32 retL = 0x00; - uint32 retH = 0x00; - if(!parity(v)) { - retL |= (1<<0); - } else { - retH |= (1<<0); - } - if(v & ( 1 << 7 )) { - retL |= (1<<15); - } else { - retH |= (1<<15); - } - if(v & ( 1 << 6 )) { - retL |= (1<<14); - } else { - retH |= (1<<14); - } - if(v & ( 1 << 5 )) { - retL |= (1<<13); - } else { - retH |= (1<<13); - } - if(v & ( 1 << 4 )) { - retL |= (1<<12); - } else { - retH |= (1<<12); - } - if(v & ( 1 << 3 )) { - retL |= (1<<11); - } else { - retH |= (1<<11); - } - if(v & ( 1 << 2 )) { - retL |= (1<<10); - } else { - retH |= (1<<10); - } - if(v & ( 1 << 1 )) { - retL |= (1<<9); - } else { - retH |= (1<<9); - } - if(v & ( 1 << 0 )) { - retL |= (1<<8); - } else { - retH |= (1<<8); - } - //ビットがLOWに設定される - GPIOB->regs->BRR = retL ; - // ビットがHIGHに設定される - GPIOB->regs->BSRR = retH ; -} - -/* - * 初期化. - * パリティチェック - */ -inline int parity(byte val) { - val ^= val >> 16; - val ^= val >> 8; - val ^= val >> 4; - val ^= val >> 2; - val ^= val >> 1; - - return val & 0x00000001; -} - /* * 初期化. * バスの初期化、PINの向きの設定を行う @@ -182,50 +252,129 @@ void setup() gpio_mode(LED, GPIO_OUTPUT_OD); gpio_write(LED, low); - //GPIO(SCSI BUS)初期化 + //GPIO(SCSI BUS)初期化 //ポート設定レジスタ（下位） // GPIOB->regs->CRL |= 0x000000008; // SET INPUT W/ PUPD on PAB-PB0 //ポート設定レジスタ（上位） - GPIOB->regs->CRH = 0x88888888; // SET INPUT W/ PUPD on PB15-PB8 + //GPIOB->regs->CRH = 0x88888888; // SET INPUT W/ PUPD on PB15-PB8 // GPIOB->regs->ODR = 0x0000FF00; // SET PULL-UPs on PB15-PB8 + // DB,DPは入力モード + SCSI_DB_INPUT() + // 入力ポート 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_mode(MSG, GPIO_OUTPUT_OD); + gpio_mode(CD, GPIO_OUTPUT_OD); + gpio_mode(REQ, GPIO_OUTPUT_OD); + gpio_mode(IO, GPIO_OUTPUT_OD); + // 出力ポートはOFFにする + SCSI_TARGET_INACTIVE() - gpio_write(MSG, low); - gpio_write(CD, low); - gpio_write(REQ, low); - gpio_write(IO, low); +#if X1TURBO_DTC510B + // シリアル初期化 + Serial.begin(9600); + for(int tout=3000/200;tout;tout--) + { + if(Serial) break; + Serial.print("."); + delay(200); + break; + } + Serial.println("DTC510B HDD emulator for X1turbo"); +#endif //RSTピンの状態がHIGHからLOWに変わったときに発生 - attachInterrupt(PIN_MAP[RST].gpio_bit, onBusReset, FALLING); - + //attachInterrupt(PIN_MAP[RST].gpio_bit, onBusReset, FALLING); + + LED_ON(); + + // clock = 36MHz , about 4Mbytes/sec if(!SD.begin(SD_CS,SPI_FULL_SPEED)) { Serial.println("SD initialization failed!"); onFalseInit(); } - //HDイメージファイル - m_file = SD.open(HDIMG_FILE, O_RDWR); - if(!m_file) { - Serial.println("Error: open hdimg"); - onFalseInit(); + + //セクタデータオーバーランバイトの設定 + m_buf[BLOCKSIZE] = 0xff; // DB0 all off,DBP off + //HDイメージファイルオープン + //int totalImage = 0; + scsi_id_mask = 0x00; + for(int id=0;idm_fileSize = 0; + h->m_file = SD.open(file_path, O_RDWR); + if(h->m_file.isOpen()) + { + h->m_fileSize = h->m_file.size(); + Serial.print("Found Imagefile:"); + Serial.print(file_path); + if(h->m_fileSize==0) + { + h->m_file.close(); + } + else + { + Serial.print(" / "); + Serial.print(h->m_fileSize); + Serial.print("bytes / "); + Serial.print(h->m_fileSize / 1024); + Serial.print("KiB / "); + Serial.print(h->m_fileSize / 1024 / 1024); + Serial.println("MiB"); + // 応答するIDとしてマーキング + scsi_id_mask |= 1<:"); + Serial.println("D:0:1:2:3:4:5:6:7:"); + for(int id=0;idregs->BSRR = db_bsrr[d]; // setup DB,DBP (160ns) + SCSI_DB_OUTPUT() // (180ns) + // ACK.Fall to DB output delay 100ns(MAX) (DTC-510B) + SCSI_OUT(vREQ,inactive) // setup wait (30ns) + SCSI_OUT(vREQ,inactive) // setup wait (30ns) + SCSI_OUT(vREQ,inactive) // setup wait (30ns) + SCSI_OUT(vREQ,active) // (30ns) + //while(!SCSI_IN(vACK)) { if(m_isBusReset){ SCSI_DB_INPUT() return; }} + while(!m_isBusReset && !SCSI_IN(vACK)); + // ACK.Fall to REQ.Raise delay 500ns(typ.) (DTC-510B) + GPIOB->regs->BSRR = DBP(0xff); // DB=0xFF , SCSI_OUT(vREQ,inactive) + // REQ.Raise to DB hold time 0ns + SCSI_DB_INPUT() // (150ns) + while( SCSI_IN(vACK)) { if(m_isBusReset) return; } } /* * データインフェーズ. * データ配列 p を len バイト送信する。 */ -void writeDataPhase(int len, byte* p) +void writeDataPhase(int len, const byte* p) { LOGN("DATAIN PHASE"); - gpio_write(MSG, low); - gpio_write(CD, low); - gpio_write(IO, high); + SCSI_OUT(vMSG,inactive) // gpio_write(MSG, low); + SCSI_OUT(vCD ,inactive) // gpio_write(CD, low); + SCSI_OUT(vIO , active) // gpio_write(IO, high); for (int i = 0; i < len; i++) { if(m_isBusReset) { return; @@ -322,21 +478,125 @@ 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); + m_img->m_file.seek(pos); + + SCSI_OUT(vMSG,inactive) // gpio_write(MSG, low); + SCSI_OUT(vCD ,inactive) // gpio_write(CD, low); + SCSI_OUT(vIO , active) // gpio_write(IO, high); + for(uint32_t i = 0; i < len; i++) { - m_file.read(m_buf, BLOCKSIZE); + // 非同期リードにすれば速くなるんだけど... + m_img->m_file.read(m_buf, BLOCKSIZE); + +#if READ_SPEED_OPTIMIZE + +//#define REQ_ON() SCSI_OUT(vREQ,active) +#define REQ_ON() (*db_dst = BITMASK(vREQ)<<16) +#define FETCH_SRC() (src_byte = *srcptr++) +#define FETCH_BSRR_DB() (bsrr_val = bsrr_tbl[src_byte]) +#define REQ_OFF_DB_SET(BSRR_VAL) *db_dst = BSRR_VAL +#define WAIT_ACK_ACTIVE() while(!m_isBusReset && !SCSI_IN(vACK)) +#define WAIT_ACK_INACTIVE() do{ if(m_isBusReset) return; }while(SCSI_IN(vACK)) + + SCSI_DB_OUTPUT() + register byte *srcptr= m_buf; // ソースバッファ + /*register*/ byte src_byte; // 送信データバイト + register const uint32_t *bsrr_tbl = db_bsrr; // BSRRに変換するテーブル + register uint32_t bsrr_val; // 出力するBSRR値(DB,DBP,REQ=ACTIVE) + register volatile uint32_t *db_dst = &(GPIOB->regs->BSRR); // 出力ポート + + // prefetch & 1st out + FETCH_SRC(); + FETCH_BSRR_DB(); + REQ_OFF_DB_SET(bsrr_val); + // DB.set to REQ.F setup 100ns max (DTC-510B) + // ここには多少のウェイトがあったほうがいいかも + //　WAIT_ACK_INACTIVE(); + do{ + // 0 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + // ACK.F to REQ.R 500ns typ. (DTC-510B) + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + // 1 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + // 2 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + // 3 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + // 4 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + // 5 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + // 6 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + // 7 + REQ_ON(); + FETCH_SRC(); + FETCH_BSRR_DB(); + WAIT_ACK_ACTIVE(); + REQ_OFF_DB_SET(bsrr_val); + WAIT_ACK_INACTIVE(); + }while(srcptr < m_buf+BLOCKSIZE); + SCSI_DB_INPUT() +#else for(int j = 0; j < BLOCKSIZE; j++) { if(m_isBusReset) { return; } writeHandshake(m_buf[j]); } +#endif } } +/* + * データアウトフェーズ. + * len ブロック読み込むこむ + */ +void readDataPhase(int len, byte* p) +{ + LOGN("DATAOUT PHASE"); + SCSI_OUT(vMSG,inactive) // gpio_write(MSG, low); + SCSI_OUT(vCD ,inactive) // gpio_write(CD, low); + SCSI_OUT(vIO ,inactive) // gpio_write(IO, low); + for(uint32_t i = 0; i < len; i++) + p[i] = readHandshake(); +} + /* * データアウトフェーズ. * len ブロック読み込みながら SDカードへ書き込む。 @@ -345,26 +605,44 @@ 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); + m_img->m_file.seek(pos); + SCSI_OUT(vMSG,inactive) // gpio_write(MSG, low); + SCSI_OUT(vCD ,inactive) // gpio_write(CD, low); + SCSI_OUT(vIO ,inactive) // gpio_write(IO, low); for(uint32_t i = 0; i < len; i++) { +#if WRITE_SPEED_OPTIMIZE + register byte *dstptr= m_buf; + for(int j = 0; j < BLOCKSIZE/8; j++) { + dstptr[0] = readHandshake(); + dstptr[1] = readHandshake(); + dstptr[2] = readHandshake(); + dstptr[3] = readHandshake(); + dstptr[4] = readHandshake(); + dstptr[5] = readHandshake(); + dstptr[6] = readHandshake(); + dstptr[7] = readHandshake(); + if(m_isBusReset) { + return; + } + dstptr+=8; + } +#else for(int j = 0; j < BLOCKSIZE; j++) { if(m_isBusReset) { return; } m_buf[j] = readHandshake(); } - m_file.write(m_buf, BLOCKSIZE); +#endif + m_img->m_file.write(m_buf, BLOCKSIZE); } - m_file.flush(); + m_img->m_file.flush(); } /* * INQUIRY コマンド処理. */ -void onInquiryCommand(byte len) +byte onInquiryCommand(byte len) { byte buf[36] = { 0x00, //デバイスタイプ @@ -379,6 +657,7 @@ void onInquiryCommand(byte len) '0', '0', '1', '0', }; writeDataPhase(len < 36 ? len : 36, buf); + return 0x00; } /* @@ -402,15 +681,18 @@ void onRequestSenseCommand(byte len) /* * READ CAPACITY コマンド処理. */ -void onReadCapacityCommand(byte pmi) +byte onReadCapacityCommand(byte pmi) { - uint32_t bc = m_fileSize / BLOCKSIZE; + if(!m_img) return 0x02; // イメージファイル不在 + + uint32_t bc = m_img->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); + return 0x00; } /* @@ -421,10 +703,13 @@ byte onReadCommand(uint32_t adds, uint32_t len) LOGN("-R"); LOGHEXN(adds); LOGHEXN(len); + + if(!m_img) return 0x02; // イメージファイル不在 + gpio_write(LED, high); writeDataPhaseSD(adds, len); gpio_write(LED, low); - return 0; //sts + return 0x00; //sts } /* @@ -435,6 +720,9 @@ byte onWriteCommand(uint32_t adds, uint32_t len) LOGN("-W"); LOGHEXN(adds); LOGHEXN(len); + + if(!m_img) return 0x02; // イメージファイル不在 + gpio_write(LED, high); readDataPhaseSD(adds, len); gpio_write(LED, low); @@ -444,12 +732,14 @@ byte onWriteCommand(uint32_t adds, uint32_t len) /* * MODE SENSE コマンド処理. */ -void onModeSenseCommand(byte dbd, int pageCode, uint32_t len) +byte onModeSenseCommand(byte dbd, int pageCode, uint32_t len) { + if(!m_img) return 0x02; // イメージファイル不在 + memset(m_buf, 0, sizeof(m_buf)); int a = 4; if(dbd == 0) { - uint32_t bc = m_fileSize / BLOCKSIZE; + uint32_t bc = m_img->m_fileSize / BLOCKSIZE; uint32_t bl = BLOCKSIZE; byte c[8] = { 0,//デンシティコード @@ -473,7 +763,7 @@ void onModeSenseCommand(byte dbd, int pageCode, uint32_t len) } case 0x04: //ドライブパラメータ { - uint32_t bc = m_fileSize / BLOCKSIZE; + uint32_t bc = m_img->m_fileSize / BLOCKSIZE; m_buf[a + 0] = 0x04; //ページコード m_buf[a + 1] = 0x16; // ページ長 m_buf[a + 2] = bc >> 16;// シリンダ長 @@ -490,17 +780,73 @@ void onModeSenseCommand(byte dbd, int pageCode, uint32_t len) } m_buf[0] = a - 1; writeDataPhase(len < a ? len : a, m_buf); + return 0x00; } + +#if X1TURBO_DTC510B +/* + * dtc510b_setDriveparameter + */ +#define PACKED __attribute__((packed)) +typedef struct PACKED dtc500_cmd_c2_param_struct +{ + uint8_t StepPlusWidth; // Default is 13.6usec (11) + uint8_t StepPeriod; // Default is 3 msec.(60) + uint8_t StepMode; // Default is Bufferd (0) + uint8_t MaximumHeadAdress; // Default is 4 heads (3) + uint8_t HighCylinderAddressByte; // Default set to 0 (0) + uint8_t LowCylinderAddressByte; // Default is 153 cylinders (152) + uint8_t ReduceWrietCurrent; // Default is above Cylinder 128 (127) + uint8_t DriveType_SeekCompleteOption;// (0) + uint8_t Reserved8; // (0) + uint8_t Reserved9; // (0) +} DTC510_CMD_C2_PARAM; + +static void logStrHex(const char *msg,uint32_t num) +{ + LOG(msg); + LOGHEXN(num); +} + +static byte dtc510b_setDriveparameter(void) +{ + DTC510_CMD_C2_PARAM DriveParameter; + uint16_t maxCylinder; + uint16_t numLAD; + //uint32_t stepPulseUsec; + int StepPeriodMsec; + + // receive paramter + writeDataPhase(sizeof(DriveParameter),(byte *)(&DriveParameter)); + + maxCylinder = + (((uint16_t)DriveParameter.HighCylinderAddressByte)<<8) | + (DriveParameter.LowCylinderAddressByte); + numLAD = maxCylinder * (DriveParameter.MaximumHeadAdress+1); + //stepPulseUsec = calcStepPulseUsec(DriveParameter.StepPlusWidth); + StepPeriodMsec = DriveParameter.StepPeriod*50; + logStrHex (" StepPlusWidth : ",DriveParameter.StepPlusWidth); + logStrHex (" StepPeriod : ",DriveParameter.StepPeriod ); + logStrHex (" StepMode : ",DriveParameter.StepMode ); + logStrHex (" MaximumHeadAdress : ",DriveParameter.MaximumHeadAdress); + logStrHex (" CylinderAddress : ",maxCylinder); + logStrHex (" ReduceWrietCurrent : ",DriveParameter.ReduceWrietCurrent); + logStrHex (" DriveType/SeekCompleteOption : ",DriveParameter.DriveType_SeekCompleteOption); + logStrHex (" Maximum LAD : ",numLAD-1); + return 0; // error result +} +#endif + /* * MsgIn2. */ void MsgIn2(int msg) { LOGN("MsgIn2"); - gpio_write(MSG, high); - gpio_write(CD, high); - gpio_write(IO, high); + SCSI_OUT(vMSG, active) // gpio_write(MSG, high); + SCSI_OUT(vCD , active) // gpio_write(CD, high); + SCSI_OUT(vIO , active) // gpio_write(IO, high); writeHandshake(msg); } @@ -510,9 +856,9 @@ void MsgIn2(int msg) void MsgOut2() { LOGN("MsgOut2"); - gpio_write(MSG, high); - gpio_write(CD, high); - gpio_write(IO, low); + SCSI_OUT(vMSG, active) // gpio_write(MSG, high); + SCSI_OUT(vCD , active) // gpio_write(CD, high); + SCSI_OUT(vIO ,inactive) // gpio_write(IO, low); m_msb[m_msc] = readHandshake(); m_msc++; m_msc %= 256; @@ -523,35 +869,43 @@ void MsgOut2() */ void loop() { - int sts = 0; - int msg = 0; + //int msg = 0; + m_msg = 0; - //BSY,SELが+はバスフリー - // セレクションチェック - // BSYが-の間ループ - if(isHigh(gpio_read(BSY))) { - return; - } - // SELが+の間ループ - if(isLow(gpio_read(SEL))) { - return; - } - // BSY+ SEL- - byte db = readIO(); - if((db & (1 << SCSIID)) == 0) { - return; - } + // RST=H,BSY=H,SEL=L になるまで待つ + do {} while( SCSI_IN(vBSY) || !SCSI_IN(vSEL) || SCSI_IN(vRST)); + // BSY+ SEL- + // 応答すべきIDがドライブされていなければ次を待つ + //byte db = readIO(); + //byte scsiid = db & scsi_id_mask; + byte scsiid = readIO() & scsi_id_mask; + if((scsiid) == 0) { + return; + } LOGN("Selection"); m_isBusReset = false; // セレクトされたらBSYを-にする - gpio_mode(BSY, GPIO_OUTPUT_PP); - gpio_write(BSY, high); + SCSI_BSY_ACTIVE(); // BSY出力だけON , ACTIVE にする + + // 応答するTARGET-IDを求める +#if USE_DB2ID_TABLE + m_id = db2scsiid[scsiid]; + //if(m_id==0xff) return; +#else + for(m_id=7;m_id>=0;m_id--) + if(scsiid & (1<> 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++ ) { + // コマンド長選択、受信 + static const int cmd_class_len[8]={6,10,10,6,6,12,6,6}; + len = cmd_class_len[cmd[0] >> 5]; + cmd[1] = readHandshake(); LOG(":");LOGHEX(cmd[1]); if(m_isBusReset) goto BusFree; + cmd[2] = readHandshake(); LOG(":");LOGHEX(cmd[2]); if(m_isBusReset) goto BusFree; + cmd[3] = readHandshake(); LOG(":");LOGHEX(cmd[3]); if(m_isBusReset) goto BusFree; + cmd[4] = readHandshake(); LOG(":");LOGHEX(cmd[4]); if(m_isBusReset) goto BusFree; + cmd[5] = readHandshake(); LOG(":");LOGHEX(cmd[5]); if(m_isBusReset) goto BusFree; + // 残りのコマンド受信 + for(int i = 6; i < len; i++ ) { cmd[i] = readHandshake(); + LOG(":"); LOGHEX(cmd[i]); + if(m_isBusReset) goto BusFree; } - LOGN(""); + // LUN 確認 + m_lun = m_sts>>5; + m_sts = cmd[1]&0xe0; // ステータスバイトにLUNをプリセット + // HDD Imageの選択 + m_img = (HDDIMG *)0; // 無し + if( (m_lun <= NUM_SCSILUN) ) + { + m_img = &(img[m_id][m_lun]); // イメージあり + if(!(m_img->m_file.isOpen())) + m_img = (HDDIMG *)0; // イメージ不在 + } + // if(!m_img) m_sts |= 0x02; // LUNに対するイメージファイル不在 + //LOGHEX(((uint32_t)m_img)); + + LOG(":ID "); + LOG(m_id); + LOG(":LUN "); + LOG(m_lun); + LOGN(""); switch(cmd[0]) { case 0x00: LOGN("[Test Unit]"); @@ -655,22 +1022,22 @@ void loop() 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]); + m_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]); + m_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]); + m_sts |= onInquiryCommand(cmd[4]); break; case 0x1A: LOGN("[ModeSense6]"); - onModeSenseCommand(cmd[1]&0x80, cmd[2] & 0x3F, cmd[4]); + m_sts |= onModeSenseCommand(cmd[1]&0x80, cmd[2] & 0x3F, cmd[4]); break; case 0x1B: LOGN("[StartStopUnit]"); @@ -680,15 +1047,15 @@ void loop() break; case 0x25: LOGN("[ReadCapacity]"); - onReadCapacityCommand(cmd[8]); + m_sts |= 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]); + m_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]); + m_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]"); @@ -697,9 +1064,15 @@ void loop() LOGN("[ModeSense10]"); onModeSenseCommand(cmd[1] & 0x80, cmd[2] & 0x3F, ((uint32_t)cmd[7] << 8) | cmd[8]); break; +#if X1TURBO_DTC510B + case 0xc2: + LOGN("[DTC510B setDriveParameter]"); + m_sts |= dtc510b_setDriveparameter(); + break; +#endif default: LOGN("[*Unknown]"); - sts = 2; + m_sts |= 0x02; m_senseKey = 5; break; } @@ -708,27 +1081,27 @@ void loop() } LOGN("Sts"); - gpio_write(MSG, low); - gpio_write(CD, high); - gpio_write(IO, high); - writeHandshake(sts); + SCSI_OUT(vMSG,inactive) // gpio_write(MSG, low); + SCSI_OUT(vCD , active) // gpio_write(CD, high); + SCSI_OUT(vIO , active) // gpio_write(IO, high); + writeHandshake(m_sts); if(m_isBusReset) { goto BusFree; } LOGN("MsgIn"); - gpio_write(MSG, high); - gpio_write(CD, high); - gpio_write(IO, high); - writeHandshake(msg); + SCSI_OUT(vMSG, active) // gpio_write(MSG, high); + SCSI_OUT(vCD , active) // gpio_write(CD, high); + SCSI_OUT(vIO , active) // gpio_write(IO, high); + writeHandshake(m_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); + //SCSI_OUT(vREQ,inactive) // gpio_write(REQ, low); + //SCSI_OUT(vMSG,inactive) // gpio_write(MSG, low); + //SCSI_OUT(vCD ,inactive) // gpio_write(CD, low); + //SCSI_OUT(vIO ,inactive) // gpio_write(IO, low); + //SCSI_OUT(vBSY,inactive) + SCSI_TARGET_INACTIVE() // BSY,REQ,MSG,CD,IO 出力をOFFにする }