Lines Matching refs:ms
187 static void mesh_done(struct mesh_state *ms, int start_next);
188 static void mesh_interrupt(struct mesh_state *ms);
189 static void cmd_complete(struct mesh_state *ms);
190 static void set_dma_cmds(struct mesh_state *ms, struct scsi_cmnd *cmd);
191 static void halt_dma(struct mesh_state *ms);
192 static void phase_mismatch(struct mesh_state *ms);
214 static void dlog(struct mesh_state *ms, char *fmt, int a) in dlog() argument
216 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in dlog()
220 slp = &ms->log[ms->log_ix]; in dlog()
223 tlp->phase = (ms->msgphase << 4) + ms->phase; in dlog()
224 tlp->bs0 = ms->mesh->bus_status0; in dlog()
225 tlp->bs1 = ms->mesh->bus_status1; in dlog()
226 tlp->tgt = ms->conn_tgt; in dlog()
233 if (++ms->log_ix >= N_DBG_SLOG) in dlog()
234 ms->log_ix = 0; in dlog()
235 if (ms->n_log < N_DBG_SLOG) in dlog()
236 ++ms->n_log; in dlog()
239 static void dumplog(struct mesh_state *ms, int t) in dumplog() argument
241 struct mesh_target *tp = &ms->tgts[t]; in dumplog()
265 static void dumpslog(struct mesh_state *ms) in dumpslog() argument
270 if (ms->n_log == 0) in dumpslog()
272 i = ms->log_ix - ms->n_log; in dumpslog()
275 ms->n_log = 0; in dumpslog()
277 lp = &ms->log[i]; in dumpslog()
287 } while (i != ms->log_ix); in dumpslog()
292 static inline void dlog(struct mesh_state *ms, char *fmt, int a) in dlog() argument
294 static inline void dumplog(struct mesh_state *ms, int tgt) in dumplog() argument
296 static inline void dumpslog(struct mesh_state *ms) in dumpslog() argument
304 mesh_dump_regs(struct mesh_state *ms) in mesh_dump_regs() argument
306 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_dump_regs()
307 volatile struct dbdma_regs __iomem *md = ms->dma; in mesh_dump_regs()
312 ms, mr, md); in mesh_dump_regs()
324 ms->phase, ms->msgphase, ms->conn_tgt, ms->data_ptr); in mesh_dump_regs()
326 ms->dma_started, ms->dma_count, ms->n_msgout); in mesh_dump_regs()
328 tp = &ms->tgts[t]; in mesh_dump_regs()
349 static void mesh_completed(struct mesh_state *ms, struct scsi_cmnd *cmd) in mesh_completed() argument
359 static void mesh_init(struct mesh_state *ms) in mesh_init() argument
361 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_init()
362 volatile struct dbdma_regs __iomem *md = ms->dma; in mesh_init()
375 out_8(&mr->source_id, ms->host->this_id); in mesh_init()
401 ms->phase = idle; in mesh_init()
402 ms->msgphase = msg_none; in mesh_init()
406 static void mesh_start_cmd(struct mesh_state *ms, struct scsi_cmnd *cmd) in mesh_start_cmd() argument
408 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_start_cmd()
412 ms->current_req = cmd; in mesh_start_cmd()
413 ms->tgts[id].data_goes_out = cmd->sc_data_direction == DMA_TO_DEVICE; in mesh_start_cmd()
414 ms->tgts[id].current_req = cmd; in mesh_start_cmd()
427 if (ms->dma_started) in mesh_start_cmd()
430 ms->phase = arbitrating; in mesh_start_cmd()
431 ms->msgphase = msg_none; in mesh_start_cmd()
432 ms->data_ptr = 0; in mesh_start_cmd()
433 ms->dma_started = 0; in mesh_start_cmd()
434 ms->n_msgout = 0; in mesh_start_cmd()
435 ms->last_n_msgout = 0; in mesh_start_cmd()
436 ms->expect_reply = 0; in mesh_start_cmd()
437 ms->conn_tgt = id; in mesh_start_cmd()
438 ms->tgts[id].saved_ptr = 0; in mesh_start_cmd()
439 ms->stat = DID_OK; in mesh_start_cmd()
440 ms->aborting = 0; in mesh_start_cmd()
442 ms->tgts[id].n_log = 0; in mesh_start_cmd()
443 dlog(ms, "start cmd=%x", (int) cmd); in mesh_start_cmd()
447 dlog(ms, "about to arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
459 dlog(ms, "busy b4 arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
466 dlog(ms, "intr b4 arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
469 mesh_interrupt(ms); in mesh_start_cmd()
470 if (ms->phase != arbitrating) in mesh_start_cmd()
477 ms->stat = DID_BUS_BUSY; in mesh_start_cmd()
478 ms->phase = idle; in mesh_start_cmd()
479 mesh_done(ms, 0); in mesh_start_cmd()
504 dlog(ms, "intr after disresel, intr/exc/err/fc=%.8x", in mesh_start_cmd()
507 mesh_interrupt(ms); in mesh_start_cmd()
508 if (ms->phase != arbitrating) in mesh_start_cmd()
510 dlog(ms, "after intr after disresel, intr/exc/err/fc=%.8x", in mesh_start_cmd()
522 dlog(ms, "after arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
527 dlog(ms, "resel? after arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
538 dlog(ms, "tried reset after arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
560 static void mesh_start(struct mesh_state *ms) in mesh_start() argument
564 if (ms->phase != idle || ms->current_req != NULL) { in mesh_start()
566 ms->phase, ms); in mesh_start()
570 while (ms->phase == idle) { in mesh_start()
572 for (cmd = ms->request_q; ; cmd = (struct scsi_cmnd *) cmd->host_scribble) { in mesh_start()
575 if (ms->tgts[cmd->device->id].current_req == NULL) in mesh_start()
581 ms->request_q = next; in mesh_start()
585 ms->request_qtail = prev; in mesh_start()
587 mesh_start_cmd(ms, cmd); in mesh_start()
591 static void mesh_done(struct mesh_state *ms, int start_next) in mesh_done() argument
594 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in mesh_done()
596 cmd = ms->current_req; in mesh_done()
597 ms->current_req = NULL; in mesh_done()
600 cmd->result = (ms->stat << 16) + cmd->SCp.Status; in mesh_done()
601 if (ms->stat == DID_OK) in mesh_done()
605 cmd->result, ms->data_ptr, scsi_bufflen(cmd)); in mesh_done()
616 cmd->SCp.this_residual -= ms->data_ptr; in mesh_done()
617 mesh_completed(ms, cmd); in mesh_done()
620 out_8(&ms->mesh->sequence, SEQ_ENBRESEL); in mesh_done()
621 mesh_flush_io(ms->mesh); in mesh_done()
623 ms->phase = idle; in mesh_done()
624 mesh_start(ms); in mesh_done()
628 static inline void add_sdtr_msg(struct mesh_state *ms) in add_sdtr_msg() argument
630 int i = ms->n_msgout; in add_sdtr_msg()
632 ms->msgout[i] = EXTENDED_MESSAGE; in add_sdtr_msg()
633 ms->msgout[i+1] = 3; in add_sdtr_msg()
634 ms->msgout[i+2] = EXTENDED_SDTR; in add_sdtr_msg()
635 ms->msgout[i+3] = mesh_sync_period/4; in add_sdtr_msg()
636 ms->msgout[i+4] = (ALLOW_SYNC(ms->conn_tgt)? mesh_sync_offset: 0); in add_sdtr_msg()
637 ms->n_msgout = i + 5; in add_sdtr_msg()
640 static void set_sdtr(struct mesh_state *ms, int period, int offset) in set_sdtr() argument
642 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in set_sdtr()
643 volatile struct mesh_regs __iomem *mr = ms->mesh; in set_sdtr()
651 ms->conn_tgt); in set_sdtr()
660 v = (ms->clk_freq / 5000) * period; in set_sdtr()
665 tr = (ms->clk_freq + 250000) / 500000; in set_sdtr()
671 tr = ((ms->clk_freq / (v + 2)) + 199999) / 200000; in set_sdtr()
678 ms->conn_tgt, tr/10, tr%10); in set_sdtr()
681 static void start_phase(struct mesh_state *ms) in start_phase() argument
684 volatile struct mesh_regs __iomem *mr = ms->mesh; in start_phase()
685 volatile struct dbdma_regs __iomem *md = ms->dma; in start_phase()
686 struct scsi_cmnd *cmd = ms->current_req; in start_phase()
687 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in start_phase()
689 dlog(ms, "start_phase nmo/exc/fc/seq = %.8x", in start_phase()
690 MKWORD(ms->n_msgout, mr->exception, mr->fifo_count, mr->sequence)); in start_phase()
692 seq = use_active_neg + (ms->n_msgout? SEQ_ATN: 0); in start_phase()
693 switch (ms->msgphase) { in start_phase()
701 ms->n_msgin = 0; in start_phase()
710 if (ms->n_msgout <= 0) { in start_phase()
712 ms->n_msgout); in start_phase()
713 mesh_dump_regs(ms); in start_phase()
714 ms->msgphase = msg_none; in start_phase()
717 if (ALLOW_DEBUG(ms->conn_tgt)) { in start_phase()
719 ms->n_msgout); in start_phase()
720 for (i = 0; i < ms->n_msgout; ++i) in start_phase()
721 printk(" %x", ms->msgout[i]); in start_phase()
724 dlog(ms, "msgout msg=%.8x", MKWORD(ms->n_msgout, ms->msgout[0], in start_phase()
725 ms->msgout[1], ms->msgout[2])); in start_phase()
735 dlog(ms, "bus0 was %.2x explicitly asserting ATN", mr->bus_status0); in start_phase()
742 dlog(ms,"hace: after explicit ATN bus0=%.2x",mr->bus_status0); in start_phase()
744 if (ms->n_msgout == 1) { in start_phase()
751 cmd_complete(ms); in start_phase()
753 out_8(&mr->count_lo, ms->n_msgout - 1); in start_phase()
755 for (i = 0; i < ms->n_msgout - 1; ++i) in start_phase()
756 out_8(&mr->fifo, ms->msgout[i]); in start_phase()
762 ms->msgphase); in start_phase()
765 switch (ms->phase) { in start_phase()
767 out_8(&mr->dest_id, ms->conn_tgt); in start_phase()
787 if (!ms->dma_started) { in start_phase()
788 set_dma_cmds(ms, cmd); in start_phase()
789 out_le32(&md->cmdptr, virt_to_phys(ms->dma_cmds)); in start_phase()
791 ms->dma_started = 1; in start_phase()
793 nb = ms->dma_count; in start_phase()
796 ms->dma_count -= nb; in start_phase()
797 ms->data_ptr += nb; in start_phase()
813 dlog(ms, "enbresel intr/exc/err/fc=%.8x", in start_phase()
820 ms->phase); in start_phase()
821 dumpslog(ms); in start_phase()
826 static inline void get_msgin(struct mesh_state *ms) in get_msgin() argument
828 volatile struct mesh_regs __iomem *mr = ms->mesh; in get_msgin()
833 i = ms->n_msgin; in get_msgin()
834 ms->n_msgin = i + n; in get_msgin()
836 ms->msgin[i++] = in_8(&mr->fifo); in get_msgin()
840 static inline int msgin_length(struct mesh_state *ms) in msgin_length() argument
845 if (ms->n_msgin > 0) { in msgin_length()
846 b = ms->msgin[0]; in msgin_length()
849 n = ms->n_msgin < 2? 2: ms->msgin[1] + 2; in msgin_length()
858 static void reselected(struct mesh_state *ms) in reselected() argument
860 volatile struct mesh_regs __iomem *mr = ms->mesh; in reselected()
865 switch (ms->phase) { in reselected()
869 if ((cmd = ms->current_req) != NULL) { in reselected()
871 cmd->host_scribble = (void *) ms->request_q; in reselected()
872 if (ms->request_q == NULL) in reselected()
873 ms->request_qtail = cmd; in reselected()
874 ms->request_q = cmd; in reselected()
875 tp = &ms->tgts[cmd->device->id]; in reselected()
880 ms->phase = reselecting; in reselected()
881 mesh_done(ms, 0); in reselected()
887 ms->msgphase, ms->phase, ms->conn_tgt); in reselected()
888 dumplog(ms, ms->conn_tgt); in reselected()
889 dumpslog(ms); in reselected()
892 if (ms->dma_started) { in reselected()
894 halt_dma(ms); in reselected()
896 ms->current_req = NULL; in reselected()
897 ms->phase = dataing; in reselected()
898 ms->msgphase = msg_in; in reselected()
899 ms->n_msgout = 0; in reselected()
900 ms->last_n_msgout = 0; in reselected()
901 prev = ms->conn_tgt; in reselected()
915 dlog(ms, "extra resel err/exc/fc = %.6x", in reselected()
931 ms->conn_tgt = ms->host->this_id; in reselected()
937 dlog(ms, "reseldata %x", b); in reselected()
940 if ((b & (1 << t)) != 0 && t != ms->host->this_id) in reselected()
942 if (b != (1 << t) + (1 << ms->host->this_id)) { in reselected()
944 ms->conn_tgt = ms->host->this_id; in reselected()
952 ms->conn_tgt = t; in reselected()
953 tp = &ms->tgts[t]; in reselected()
960 ms->current_req = tp->current_req; in reselected()
965 ms->data_ptr = tp->saved_ptr; in reselected()
966 dlog(ms, "resel prev tgt=%d", prev); in reselected()
967 dlog(ms, "resel err/exc=%.4x", MKWORD(0, 0, mr->error, mr->exception)); in reselected()
968 start_phase(ms); in reselected()
972 dumplog(ms, ms->conn_tgt); in reselected()
973 dumpslog(ms); in reselected()
974 ms->data_ptr = 0; in reselected()
975 ms->aborting = 1; in reselected()
976 start_phase(ms); in reselected()
979 static void do_abort(struct mesh_state *ms) in do_abort() argument
981 ms->msgout[0] = ABORT; in do_abort()
982 ms->n_msgout = 1; in do_abort()
983 ms->aborting = 1; in do_abort()
984 ms->stat = DID_ABORT; in do_abort()
985 dlog(ms, "abort", 0); in do_abort()
988 static void handle_reset(struct mesh_state *ms) in handle_reset() argument
993 volatile struct mesh_regs __iomem *mr = ms->mesh; in handle_reset()
996 tp = &ms->tgts[tgt]; in handle_reset()
1000 mesh_completed(ms, cmd); in handle_reset()
1002 ms->tgts[tgt].sdtr_state = do_sdtr; in handle_reset()
1003 ms->tgts[tgt].sync_params = ASYNC_PARAMS; in handle_reset()
1005 ms->current_req = NULL; in handle_reset()
1006 while ((cmd = ms->request_q) != NULL) { in handle_reset()
1007 ms->request_q = (struct scsi_cmnd *) cmd->host_scribble; in handle_reset()
1009 mesh_completed(ms, cmd); in handle_reset()
1011 ms->phase = idle; in handle_reset()
1012 ms->msgphase = msg_none; in handle_reset()
1024 struct mesh_state *ms = dev_id; in do_mesh_interrupt() local
1025 struct Scsi_Host *dev = ms->host; in do_mesh_interrupt()
1028 mesh_interrupt(ms); in do_mesh_interrupt()
1033 static void handle_error(struct mesh_state *ms) in handle_error() argument
1036 volatile struct mesh_regs __iomem *mr = ms->mesh; in handle_error()
1041 dlog(ms, "error err/exc/fc/cl=%.8x", in handle_error()
1050 handle_reset(ms); in handle_error()
1057 reselected(ms); in handle_error()
1060 if (!ms->aborting) { in handle_error()
1062 ms->conn_tgt); in handle_error()
1063 dumplog(ms, ms->conn_tgt); in handle_error()
1064 dumpslog(ms); in handle_error()
1067 ms->stat = DID_ABORT; in handle_error()
1068 mesh_done(ms, 1); in handle_error()
1072 if (ms->msgphase == msg_in) { in handle_error()
1074 ms->conn_tgt); in handle_error()
1075 ms->msgout[0] = MSG_PARITY_ERROR; in handle_error()
1076 ms->n_msgout = 1; in handle_error()
1077 ms->msgphase = msg_in_bad; in handle_error()
1078 cmd_complete(ms); in handle_error()
1081 if (ms->stat == DID_OK) { in handle_error()
1083 ms->conn_tgt); in handle_error()
1084 ms->stat = DID_PARITY; in handle_error()
1088 cmd_complete(ms); in handle_error()
1101 reselected(ms); in handle_error()
1107 phase_mismatch(ms); in handle_error()
1115 mesh_dump_regs(ms); in handle_error()
1116 dumplog(ms, ms->conn_tgt); in handle_error()
1117 if (ms->phase > selecting && (in_8(&mr->bus_status1) & BS1_BSY)) { in handle_error()
1119 do_abort(ms); in handle_error()
1120 phase_mismatch(ms); in handle_error()
1123 ms->stat = DID_ERROR; in handle_error()
1124 mesh_done(ms, 1); in handle_error()
1127 static void handle_exception(struct mesh_state *ms) in handle_exception() argument
1130 volatile struct mesh_regs __iomem *mr = ms->mesh; in handle_exception()
1137 reselected(ms); in handle_exception()
1140 ms->stat = DID_BUS_BUSY; in handle_exception()
1141 mesh_done(ms, 1); in handle_exception()
1144 ms->stat = DID_BAD_TARGET; in handle_exception()
1145 mesh_done(ms, 1); in handle_exception()
1149 phase_mismatch(ms); in handle_exception()
1152 mesh_dump_regs(ms); in handle_exception()
1153 dumplog(ms, ms->conn_tgt); in handle_exception()
1154 do_abort(ms); in handle_exception()
1155 phase_mismatch(ms); in handle_exception()
1159 static void handle_msgin(struct mesh_state *ms) in handle_msgin() argument
1162 struct scsi_cmnd *cmd = ms->current_req; in handle_msgin()
1163 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in handle_msgin()
1165 if (ms->n_msgin == 0) in handle_msgin()
1167 code = ms->msgin[0]; in handle_msgin()
1168 if (ALLOW_DEBUG(ms->conn_tgt)) { in handle_msgin()
1169 printk(KERN_DEBUG "got %d message bytes:", ms->n_msgin); in handle_msgin()
1170 for (i = 0; i < ms->n_msgin; ++i) in handle_msgin()
1171 printk(" %x", ms->msgin[i]); in handle_msgin()
1174 dlog(ms, "msgin msg=%.8x", in handle_msgin()
1175 MKWORD(ms->n_msgin, code, ms->msgin[1], ms->msgin[2])); in handle_msgin()
1177 ms->expect_reply = 0; in handle_msgin()
1178 ms->n_msgout = 0; in handle_msgin()
1179 if (ms->n_msgin < msgin_length(ms)) in handle_msgin()
1187 switch (ms->msgin[2]) { in handle_msgin()
1189 ms->data_ptr += (ms->msgin[3] << 24) + ms->msgin[6] in handle_msgin()
1190 + (ms->msgin[4] << 16) + (ms->msgin[5] << 8); in handle_msgin()
1195 add_sdtr_msg(ms); in handle_msgin()
1198 if (ms->msgout[3] < ms->msgin[3]) in handle_msgin()
1199 ms->msgout[3] = ms->msgin[3]; in handle_msgin()
1200 if (ms->msgout[4] > ms->msgin[4]) in handle_msgin()
1201 ms->msgout[4] = ms->msgin[4]; in handle_msgin()
1202 set_sdtr(ms, ms->msgout[3], ms->msgout[4]); in handle_msgin()
1203 ms->msgphase = msg_out; in handle_msgin()
1205 set_sdtr(ms, ms->msgin[3], ms->msgin[4]); in handle_msgin()
1213 tp->saved_ptr = ms->data_ptr; in handle_msgin()
1216 ms->data_ptr = tp->saved_ptr; in handle_msgin()
1219 ms->phase = disconnecting; in handle_msgin()
1225 set_sdtr(ms, 0, 0); in handle_msgin()
1232 do_abort(ms); in handle_msgin()
1233 ms->msgphase = msg_out; in handle_msgin()
1238 cmd->device->lun, ms->conn_tgt); in handle_msgin()
1248 ms->conn_tgt); in handle_msgin()
1249 for (i = 0; i < ms->n_msgin; ++i) in handle_msgin()
1250 printk(" %x", ms->msgin[i]); in handle_msgin()
1252 ms->msgout[0] = MESSAGE_REJECT; in handle_msgin()
1253 ms->n_msgout = 1; in handle_msgin()
1254 ms->msgphase = msg_out; in handle_msgin()
1260 static void set_dma_cmds(struct mesh_state *ms, struct scsi_cmnd *cmd) in set_dma_cmds() argument
1266 dma_cmd = ms->tgts[ms->conn_tgt].data_goes_out? in set_dma_cmds()
1268 dcmds = ms->dma_cmds; in set_dma_cmds()
1280 off = ms->data_ptr; in set_dma_cmds()
1318 ms->dma_count = dtot; in set_dma_cmds()
1321 static void halt_dma(struct mesh_state *ms) in halt_dma() argument
1323 volatile struct dbdma_regs __iomem *md = ms->dma; in halt_dma()
1324 volatile struct mesh_regs __iomem *mr = ms->mesh; in halt_dma()
1325 struct scsi_cmnd *cmd = ms->current_req; in halt_dma()
1328 if (!ms->tgts[ms->conn_tgt].data_goes_out) { in halt_dma()
1339 dlog(ms, "halt_dma fc/count=%.6x", in halt_dma()
1341 if (ms->tgts[ms->conn_tgt].data_goes_out) in halt_dma()
1345 ms->data_ptr -= nb; in halt_dma()
1346 dlog(ms, "data_ptr %x", ms->data_ptr); in halt_dma()
1347 if (ms->data_ptr < 0) { in halt_dma()
1349 ms->data_ptr, nb, ms); in halt_dma()
1350 ms->data_ptr = 0; in halt_dma()
1352 dumplog(ms, ms->conn_tgt); in halt_dma()
1353 dumpslog(ms); in halt_dma()
1356 ms->data_ptr > scsi_bufflen(cmd)) { in halt_dma()
1359 ms->conn_tgt, ms->data_ptr, scsi_bufflen(cmd), in halt_dma()
1360 ms->tgts[ms->conn_tgt].data_goes_out); in halt_dma()
1363 ms->dma_started = 0; in halt_dma()
1366 static void phase_mismatch(struct mesh_state *ms) in phase_mismatch() argument
1368 volatile struct mesh_regs __iomem *mr = ms->mesh; in phase_mismatch()
1371 dlog(ms, "phasemm ch/cl/seq/fc=%.8x", in phase_mismatch()
1374 if (ms->msgphase == msg_out_xxx && phase == BP_MSGOUT) { in phase_mismatch()
1380 out_8(&mr->fifo, ms->msgout[ms->n_msgout-1]); in phase_mismatch()
1381 ms->msgphase = msg_out_last; in phase_mismatch()
1385 if (ms->msgphase == msg_in) { in phase_mismatch()
1386 get_msgin(ms); in phase_mismatch()
1387 if (ms->n_msgin) in phase_mismatch()
1388 handle_msgin(ms); in phase_mismatch()
1391 if (ms->dma_started) in phase_mismatch()
1392 halt_dma(ms); in phase_mismatch()
1399 ms->msgphase = msg_none; in phase_mismatch()
1402 ms->tgts[ms->conn_tgt].data_goes_out = 0; in phase_mismatch()
1403 ms->phase = dataing; in phase_mismatch()
1406 ms->tgts[ms->conn_tgt].data_goes_out = 1; in phase_mismatch()
1407 ms->phase = dataing; in phase_mismatch()
1410 ms->phase = commanding; in phase_mismatch()
1413 ms->phase = statusing; in phase_mismatch()
1416 ms->msgphase = msg_in; in phase_mismatch()
1417 ms->n_msgin = 0; in phase_mismatch()
1420 ms->msgphase = msg_out; in phase_mismatch()
1421 if (ms->n_msgout == 0) { in phase_mismatch()
1422 if (ms->aborting) { in phase_mismatch()
1423 do_abort(ms); in phase_mismatch()
1425 if (ms->last_n_msgout == 0) { in phase_mismatch()
1428 ms->msgout[0] = NOP; in phase_mismatch()
1429 ms->last_n_msgout = 1; in phase_mismatch()
1431 ms->n_msgout = ms->last_n_msgout; in phase_mismatch()
1437 ms->stat = DID_ERROR; in phase_mismatch()
1438 mesh_done(ms, 1); in phase_mismatch()
1442 start_phase(ms); in phase_mismatch()
1445 static void cmd_complete(struct mesh_state *ms) in cmd_complete() argument
1447 volatile struct mesh_regs __iomem *mr = ms->mesh; in cmd_complete()
1448 struct scsi_cmnd *cmd = ms->current_req; in cmd_complete()
1449 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in cmd_complete()
1452 dlog(ms, "cmd_complete fc=%x", mr->fifo_count); in cmd_complete()
1453 seq = use_active_neg + (ms->n_msgout? SEQ_ATN: 0); in cmd_complete()
1454 switch (ms->msgphase) { in cmd_complete()
1457 ms->n_msgin = 0; in cmd_complete()
1458 ms->msgphase = msg_in; in cmd_complete()
1463 get_msgin(ms); in cmd_complete()
1464 n = msgin_length(ms); in cmd_complete()
1465 if (ms->n_msgin < n) { in cmd_complete()
1466 out_8(&mr->count_lo, n - ms->n_msgin); in cmd_complete()
1469 ms->msgphase = msg_none; in cmd_complete()
1470 handle_msgin(ms); in cmd_complete()
1471 start_phase(ms); in cmd_complete()
1500 dlog(ms, "last_mbyte err/exc/fc/cl=%.8x", in cmd_complete()
1505 ms->last_n_msgout = ms->n_msgout; in cmd_complete()
1506 ms->n_msgout = 0; in cmd_complete()
1510 handle_error(ms); in cmd_complete()
1519 handle_exception(ms); in cmd_complete()
1526 out_8(&mr->fifo, ms->msgout[ms->n_msgout-1]); in cmd_complete()
1527 ms->msgphase = msg_out_last; in cmd_complete()
1530 ms->msgphase = msg_out_xxx; in cmd_complete()
1535 ms->last_n_msgout = ms->n_msgout; in cmd_complete()
1536 ms->n_msgout = 0; in cmd_complete()
1537 ms->msgphase = ms->expect_reply? msg_in: msg_none; in cmd_complete()
1538 start_phase(ms); in cmd_complete()
1542 switch (ms->phase) { in cmd_complete()
1545 dumpslog(ms); in cmd_complete()
1548 dlog(ms, "Selecting phase at command completion",0); in cmd_complete()
1549 ms->msgout[0] = IDENTIFY(ALLOW_RESEL(ms->conn_tgt), in cmd_complete()
1551 ms->n_msgout = 1; in cmd_complete()
1552 ms->expect_reply = 0; in cmd_complete()
1553 if (ms->aborting) { in cmd_complete()
1554 ms->msgout[0] = ABORT; in cmd_complete()
1555 ms->n_msgout++; in cmd_complete()
1558 add_sdtr_msg(ms); in cmd_complete()
1559 ms->expect_reply = 1; in cmd_complete()
1562 ms->msgphase = msg_out; in cmd_complete()
1573 dlog(ms, "impatient for req", ms->n_msgout); in cmd_complete()
1574 ms->msgphase = msg_none; in cmd_complete()
1581 if (ms->dma_count != 0) { in cmd_complete()
1582 start_phase(ms); in cmd_complete()
1598 halt_dma(ms); in cmd_complete()
1607 ms->msgphase = msg_in; in cmd_complete()
1610 mesh_done(ms, 1); in cmd_complete()
1613 ms->current_req = NULL; in cmd_complete()
1614 ms->phase = idle; in cmd_complete()
1615 mesh_start(ms); in cmd_complete()
1620 ++ms->phase; in cmd_complete()
1621 start_phase(ms); in cmd_complete()
1633 struct mesh_state *ms; in mesh_queue() local
1638 ms = (struct mesh_state *) cmd->device->host->hostdata; in mesh_queue()
1640 if (ms->request_q == NULL) in mesh_queue()
1641 ms->request_q = cmd; in mesh_queue()
1643 ms->request_qtail->host_scribble = (void *) cmd; in mesh_queue()
1644 ms->request_qtail = cmd; in mesh_queue()
1646 if (ms->phase == idle) in mesh_queue()
1647 mesh_start(ms); in mesh_queue()
1657 static void mesh_interrupt(struct mesh_state *ms) in mesh_interrupt() argument
1659 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_interrupt()
1663 if (ALLOW_DEBUG(ms->conn_tgt)) in mesh_interrupt()
1667 ms->phase, ms->msgphase); in mesh_interrupt()
1670 dlog(ms, "interrupt intr/err/exc/seq=%.8x", in mesh_interrupt()
1673 handle_error(ms); in mesh_interrupt()
1675 handle_exception(ms); in mesh_interrupt()
1678 cmd_complete(ms); in mesh_interrupt()
1689 struct mesh_state *ms = (struct mesh_state *) cmd->device->host->hostdata; in mesh_abort() local
1692 mesh_dump_regs(ms); in mesh_abort()
1693 dumplog(ms, cmd->device->id); in mesh_abort()
1694 dumpslog(ms); in mesh_abort()
1706 struct mesh_state *ms = (struct mesh_state *) cmd->device->host->hostdata; in mesh_host_reset() local
1707 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_host_reset()
1708 volatile struct dbdma_regs __iomem *md = ms->dma; in mesh_host_reset()
1713 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_host_reset()
1723 out_8(&mr->source_id, ms->host->this_id); in mesh_host_reset()
1734 handle_reset(ms); in mesh_host_reset()
1736 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_host_reset()
1740 static void set_mesh_power(struct mesh_state *ms, int state) in set_mesh_power() argument
1745 pmac_call_feature(PMAC_FTR_MESH_ENABLE, macio_get_of_node(ms->mdev), 0, 1); in set_mesh_power()
1748 pmac_call_feature(PMAC_FTR_MESH_ENABLE, macio_get_of_node(ms->mdev), 0, 0); in set_mesh_power()
1757 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_suspend() local
1768 if (ms->phase == sleeping) in mesh_suspend()
1771 scsi_block_requests(ms->host); in mesh_suspend()
1772 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_suspend()
1773 while(ms->phase != idle) { in mesh_suspend()
1774 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_suspend()
1776 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_suspend()
1778 ms->phase = sleeping; in mesh_suspend()
1779 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_suspend()
1780 disable_irq(ms->meshintr); in mesh_suspend()
1781 set_mesh_power(ms, 0); in mesh_suspend()
1788 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_resume() local
1791 if (ms->phase != sleeping) in mesh_resume()
1794 set_mesh_power(ms, 1); in mesh_resume()
1795 mesh_init(ms); in mesh_resume()
1796 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_resume()
1797 mesh_start(ms); in mesh_resume()
1798 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_resume()
1799 enable_irq(ms->meshintr); in mesh_resume()
1800 scsi_unblock_requests(ms->host); in mesh_resume()
1814 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_shutdown() local
1819 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_shutdown()
1820 mr = ms->mesh; in mesh_shutdown()
1827 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_shutdown()
1851 struct mesh_state *ms; in mesh_probe() local
1890 ms = (struct mesh_state *) mesh_host->hostdata; in mesh_probe()
1891 macio_set_drvdata(mdev, ms); in mesh_probe()
1892 ms->host = mesh_host; in mesh_probe()
1893 ms->mdev = mdev; in mesh_probe()
1894 ms->pdev = pdev; in mesh_probe()
1896 ms->mesh = ioremap(macio_resource_start(mdev, 0), 0x1000); in mesh_probe()
1897 if (ms->mesh == NULL) { in mesh_probe()
1901 ms->dma = ioremap(macio_resource_start(mdev, 1), 0x1000); in mesh_probe()
1902 if (ms->dma == NULL) { in mesh_probe()
1904 iounmap(ms->mesh); in mesh_probe()
1908 ms->meshintr = macio_irq(mdev, 0); in mesh_probe()
1909 ms->dmaintr = macio_irq(mdev, 1); in mesh_probe()
1914 ms->dma_cmd_size = (mesh_host->sg_tablesize + 2) * sizeof(struct dbdma_cmd); in mesh_probe()
1920 ms->dma_cmd_size, in mesh_probe()
1926 memset(dma_cmd_space, 0, ms->dma_cmd_size); in mesh_probe()
1928 ms->dma_cmds = (struct dbdma_cmd *) DBDMA_ALIGN(dma_cmd_space); in mesh_probe()
1929 ms->dma_cmd_space = dma_cmd_space; in mesh_probe()
1930 ms->dma_cmd_bus = dma_cmd_bus + ((unsigned long)ms->dma_cmds) in mesh_probe()
1932 ms->current_req = NULL; in mesh_probe()
1934 ms->tgts[tgt].sdtr_state = do_sdtr; in mesh_probe()
1935 ms->tgts[tgt].sync_params = ASYNC_PARAMS; in mesh_probe()
1936 ms->tgts[tgt].current_req = NULL; in mesh_probe()
1940 ms->clk_freq = *cfp; in mesh_probe()
1943 ms->clk_freq = 50000000; in mesh_probe()
1949 minper = 1000000000 / (ms->clk_freq / 5); /* ns */ in mesh_probe()
1954 set_mesh_power(ms, 1); in mesh_probe()
1957 mesh_init(ms); in mesh_probe()
1960 if (request_irq(ms->meshintr, do_mesh_interrupt, 0, "MESH", ms)) { in mesh_probe()
1961 printk(KERN_ERR "MESH: can't get irq %d\n", ms->meshintr); in mesh_probe()
1973 free_irq(ms->meshintr, ms); in mesh_probe()
1979 set_mesh_power(ms, 0); in mesh_probe()
1980 pci_free_consistent(macio_get_pci_dev(mdev), ms->dma_cmd_size, in mesh_probe()
1981 ms->dma_cmd_space, ms->dma_cmd_bus); in mesh_probe()
1983 iounmap(ms->dma); in mesh_probe()
1984 iounmap(ms->mesh); in mesh_probe()
1995 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_remove() local
1996 struct Scsi_Host *mesh_host = ms->host; in mesh_remove()
2000 free_irq(ms->meshintr, ms); in mesh_remove()
2006 set_mesh_power(ms, 0); in mesh_remove()
2009 iounmap(ms->mesh); in mesh_remove()
2010 iounmap(ms->dma); in mesh_remove()
2013 pci_free_consistent(macio_get_pci_dev(mdev), ms->dma_cmd_size, in mesh_remove()
2014 ms->dma_cmd_space, ms->dma_cmd_bus); in mesh_remove()