static void wd33c93ExecCmd(WD33C93* wd33c93, UInt8 value)
{
int atn = 0;
if (wd33c93->regs[REG_AUX_STATUS] & AS_CIP) {
SCSILOG("wd33c93ExecCmd() CIP error\n");
return;
}
//wd33c93->regs[REG_AUX_STATUS] |= AS_CIP;
wd33c93->regs[REG_CMD] = value;
switch (value) {
case 0x00: /* Reset controller (software reset) */
SCSILOG("wd33c93 [CMD] Reset controller\n");
memset(wd33c93->regs + 1, 0, 0x1a);
wd33c93Disconnect(wd33c93);
wd33c93->latch = 0;
wd33c93->regs[REG_SCSI_STATUS] =
(wd33c93->regs[REG_OWN_ID] & OWN_EAF) ? SS_RESET_ADV : SS_RESET;
break;
case 0x02: /* Assert ATN */
SCSILOG("wd33c93 [CMD] Assert ATN\n");
break;
case 0x04: /* Disconnect */
SCSILOG("wd33c93 [CMD] Disconnect\n");
wd33c93Disconnect(wd33c93);
break;
case 0x06: /* Select with ATN (Lv2) */
atn = 1;
case 0x07: /* Select Without ATN (Lv2) */
SCSILOG1("wd33c93 [CMD] Select (ATN %d)\n", atn);
wd33c93->targetId = wd33c93->regs[REG_DST_ID] & 7;
wd33c93->regs[REG_SCSI_STATUS] = SS_SEL_TIMEOUT;
wd33c93->tc = 0;
wd33c93->regs[REG_AUX_STATUS] = AS_INT;
break;
case 0x08: /* Select with ATN and transfer (Lv2) */
atn = 1;
case 0x09: /* Select without ATN and Transfer (Lv2) */
SCSILOG1("wd33c93 [CMD] Select and transfer (ATN %d)\n", atn);
wd33c93->targetId = wd33c93->regs[REG_DST_ID] & 7;
if (!wd33c93->devBusy &&
wd33c93->targetId < wd33c93->maxDev &&
/* wd33c93->targetId != wd33c93->myId && */
scsiDeviceSelection(TARGET)) {
if (atn) scsiDeviceMsgOut(TARGET, wd33c93->regs[REG_TLUN] | 0x80);
wd33c93->devBusy = 1;
wd33c93->counter = scsiDeviceExecuteCmd(
TARGET, &wd33c93->regs[REG_CDB1],
&wd33c93->phase, &wd33c93->blockCounter);
switch (wd33c93->phase) {
case Status:
wd33c93->devBusy = 0;
wd33c93->regs[REG_TLUN] = scsiDeviceGetStatusCode(TARGET);
scsiDeviceMsgIn(TARGET);
wd33c93->regs[REG_SCSI_STATUS] = SS_XFER_END;
wd33c93Disconnect(wd33c93);
break;
case Execute:
wd33c93->regs[REG_AUX_STATUS] = AS_CIP | AS_BSY;
wd33c93->pBuf = wd33c93->buffer;
break;
default:
wd33c93->devBusy = 0;
wd33c93->regs[REG_AUX_STATUS] = AS_CIP | AS_BSY | AS_DBR;
wd33c93->pBuf = wd33c93->buffer;
}
//wd33c93->regs[REG_SRC_ID] |= wd33c93->regs[REG_DST_ID] & 7;
} else {
//wd33c93->timeout = boardSystemTime() + boardFrequency() / 16384;
//wd33c93->timerRunning = 1;
//boardTimerAdd(wd33c93->timer, wd33c93->timeout);
SCSILOG1("wd33c93 %d timeout\n", wd33c93->targetId);
wd33c93->tc = 0;
wd33c93->regs[REG_SCSI_STATUS] = SS_SEL_TIMEOUT;
wd33c93->regs[REG_AUX_STATUS] = AS_INT;
}
break;
case 0x18: /* Translate Address (Lv2) */
default:
SCSILOG1("wd33c93 [CMD] unsupport command %x\n", value);
break;
}
}
static void mb89352SetACKREQ(MB89352* spc, UInt8* value)
{
// REQ check
if ((spc->regs[REG_PSNS] & (PSNS_REQ | PSNS_BSY)) != (PSNS_REQ | PSNS_BSY)) {
SCSILOG("set ACK/REQ: REQ/BSY check error\n");
if (spc->regs[REG_PSNS] & PSNS_IO) { // SCSI -> SPC
*value = 0xff;
}
return;
}
// phase check
if (spc->regs[FIX_PCTL] != (spc->regs[REG_PSNS] & 7)) {
SCSILOG("set ACK/REQ: phase check error\n");
if (spc->regs[REG_PSNS] & PSNS_IO) { // SCSI -> SPC
*value = 0xff;
}
if (spc->isTransfer) {
spc->regs[REG_INTS] |= INTS_ServiceRequited;
}
return;
}
switch (spc->phase) {
// Transfer phase (data in)
case DataIn:
*value = *spc->pBuffer;
++spc->pBuffer;
spc->regs[REG_PSNS] = PSNS_ACK | PSNS_BSY | PSNS_DATAIN;
break;
//Transfer phase (data out)
case DataOut:
*spc->pBuffer = *value;
++spc->pBuffer;
spc->regs[REG_PSNS] = PSNS_ACK | PSNS_BSY | PSNS_DATAOUT;
break;
// Command phase
case Command:
if (spc->counter < 0) {
//Initialize command routine
spc->pCdb = spc->cdb;
spc->counter = cdbLength(*value);
}
*spc->pCdb = *value;
++spc->pCdb;
spc->regs[REG_PSNS] = PSNS_ACK | PSNS_BSY | PSNS_COMMAND;
break;
// Status phase
case Status:
*value = scsiDeviceGetStatusCode(TARGET);
spc->regs[REG_PSNS] = PSNS_ACK | PSNS_BSY | PSNS_STATUS;
break;
// Message In phase
case MsgIn:
*value = scsiDeviceMsgIn(TARGET);
spc->regs[REG_PSNS] = PSNS_ACK | PSNS_BSY | PSNS_MSGIN;
break;
// Message Out phase
case MsgOut:
spc->msgin |= scsiDeviceMsgOut(TARGET, *value);
spc->regs[REG_PSNS] = PSNS_ACK | PSNS_BSY | PSNS_MSGOUT;
break;
default:
SCSILOG("set ACK/REQ code error\n");
break;
}
} // end of mb89352SetACKREQ()
