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 mb89352ResetACKREQ(MB89352* spc)
{
// ACK check
if ((spc->regs[REG_PSNS] & (PSNS_ACK | PSNS_BSY)) != (PSNS_ACK | PSNS_BSY)) {
SCSILOG("reset ACK/REQ: ACK/BSY check error\n");
return;
}
// phase check
if (spc->regs[FIX_PCTL] != (spc->regs[REG_PSNS] & 7)) {
SCSILOG("reset ACK/REQ: phase check error\n");
if (spc->isTransfer) {
spc->regs[REG_INTS] |= INTS_ServiceRequited;
}
return;
}
switch (spc->phase) {
// Transfer phase (data in)
case DataIn:
if (--spc->counter > 0) {
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAIN;
} else {
if (spc->blockCounter > 0) {
spc->counter = scsiDeviceDataIn(TARGET, &spc->blockCounter);
if (spc->counter) {
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAIN;
spc->pBuffer = spc->buffer;
break;
}
}
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_STATUS;
spc->phase = Status;
}
break;
// Transfer phase (data out)
case DataOut:
if (--spc->counter > 0) {
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAOUT;
} else {
spc->counter = scsiDeviceDataOut(TARGET, &spc->blockCounter);
if (spc->counter) {
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAOUT;
spc->pBuffer = spc->buffer;
break;
}
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_STATUS;
spc->phase = Status;
}
break;
// Command phase
case Command:
if (--spc->counter > 0) {
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_COMMAND;
} else {
spc->pBuffer = spc->buffer; // reset buffer pointer
spc->devBusy = 1;
spc->counter =
scsiDeviceExecuteCmd(TARGET, spc->cdb, &spc->phase, &spc->blockCounter);
switch (spc->phase) {
case DataIn:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAIN;
break;
case DataOut:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAOUT;
break;
case Status:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_STATUS;
break;
case Execute:
spc->regs[REG_PSNS] = PSNS_BSY;
return;
default:
SCSILOG("phase error\n");
break;
}
spc->devBusy = 0;
}
break;
// Status phase
case Status:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_MSGIN;
spc->phase = MsgIn;
break;
// Message In phase
case MsgIn:
if (spc->msgin <= 0) {
mb89352Disconnect(spc);
break;
}
spc->msgin = 0;
// throw to MsgOut...
// Message Out phase
case MsgOut:
if (spc->msgin == -1) {
mb89352Disconnect(spc);
return;
}
if (spc->atn) {
if (spc->msgin & 2) {
mb89352Disconnect(spc);
return;
}
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_MSGOUT;
return;
}
if (spc->msgin & 1) {
spc->phase = MsgIn;
} else {
if (spc->msgin & 4) {
spc->phase = Status;
spc->nextPhase = -1;
} else {
spc->phase = spc->nextPhase;
spc->nextPhase = -1;
}
}
spc->msgin = 0;
switch (spc->phase) {
case Command:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_COMMAND;
break;
case DataIn:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAIN;
break;
case DataOut:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_DATAOUT;
break;
case Status:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_STATUS;
break;
case MsgIn:
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_MSGIN;
break;
default:
SCSILOG("MsgOut code error\n");
break;
}
return;
default:
//assert(false);
SCSILOG("reset ACK/REQ code error\n");
break;
}
if (spc->atn) {
spc->nextPhase = spc->phase;
spc->phase = MsgOut;
spc->regs[REG_PSNS] = PSNS_REQ | PSNS_BSY | PSNS_MSGOUT;
}
} // end of mb89352ResetACKREQ()
