Lines Matching refs:ms
185 static void mesh_done(struct mesh_state *ms, int start_next);
186 static void mesh_interrupt(struct mesh_state *ms);
187 static void cmd_complete(struct mesh_state *ms);
188 static void set_dma_cmds(struct mesh_state *ms, struct scsi_cmnd *cmd);
189 static void halt_dma(struct mesh_state *ms);
190 static void phase_mismatch(struct mesh_state *ms);
212 static void dlog(struct mesh_state *ms, char *fmt, int a) in dlog() argument
214 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in dlog()
218 slp = &ms->log[ms->log_ix]; in dlog()
221 tlp->phase = (ms->msgphase << 4) + ms->phase; in dlog()
222 tlp->bs0 = ms->mesh->bus_status0; in dlog()
223 tlp->bs1 = ms->mesh->bus_status1; in dlog()
224 tlp->tgt = ms->conn_tgt; in dlog()
231 if (++ms->log_ix >= N_DBG_SLOG) in dlog()
232 ms->log_ix = 0; in dlog()
233 if (ms->n_log < N_DBG_SLOG) in dlog()
234 ++ms->n_log; in dlog()
237 static void dumplog(struct mesh_state *ms, int t) in dumplog() argument
239 struct mesh_target *tp = &ms->tgts[t]; in dumplog()
263 static void dumpslog(struct mesh_state *ms) in dumpslog() argument
268 if (ms->n_log == 0) in dumpslog()
270 i = ms->log_ix - ms->n_log; in dumpslog()
273 ms->n_log = 0; in dumpslog()
275 lp = &ms->log[i]; in dumpslog()
285 } while (i != ms->log_ix); in dumpslog()
290 static inline void dlog(struct mesh_state *ms, char *fmt, int a) in dlog() argument
292 static inline void dumplog(struct mesh_state *ms, int tgt) in dumplog() argument
294 static inline void dumpslog(struct mesh_state *ms) in dumpslog() argument
302 mesh_dump_regs(struct mesh_state *ms) in mesh_dump_regs() argument
304 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_dump_regs()
305 volatile struct dbdma_regs __iomem *md = ms->dma; in mesh_dump_regs()
310 ms, mr, md); in mesh_dump_regs()
322 ms->phase, ms->msgphase, ms->conn_tgt, ms->data_ptr); in mesh_dump_regs()
324 ms->dma_started, ms->dma_count, ms->n_msgout); in mesh_dump_regs()
326 tp = &ms->tgts[t]; in mesh_dump_regs()
347 static void mesh_completed(struct mesh_state *ms, struct scsi_cmnd *cmd) in mesh_completed() argument
357 static void mesh_init(struct mesh_state *ms) in mesh_init() argument
359 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_init()
360 volatile struct dbdma_regs __iomem *md = ms->dma; in mesh_init()
373 out_8(&mr->source_id, ms->host->this_id); in mesh_init()
399 ms->phase = idle; in mesh_init()
400 ms->msgphase = msg_none; in mesh_init()
404 static void mesh_start_cmd(struct mesh_state *ms, struct scsi_cmnd *cmd) in mesh_start_cmd() argument
406 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_start_cmd()
410 ms->current_req = cmd; in mesh_start_cmd()
411 ms->tgts[id].data_goes_out = cmd->sc_data_direction == DMA_TO_DEVICE; in mesh_start_cmd()
412 ms->tgts[id].current_req = cmd; in mesh_start_cmd()
424 if (ms->dma_started) in mesh_start_cmd()
427 ms->phase = arbitrating; in mesh_start_cmd()
428 ms->msgphase = msg_none; in mesh_start_cmd()
429 ms->data_ptr = 0; in mesh_start_cmd()
430 ms->dma_started = 0; in mesh_start_cmd()
431 ms->n_msgout = 0; in mesh_start_cmd()
432 ms->last_n_msgout = 0; in mesh_start_cmd()
433 ms->expect_reply = 0; in mesh_start_cmd()
434 ms->conn_tgt = id; in mesh_start_cmd()
435 ms->tgts[id].saved_ptr = 0; in mesh_start_cmd()
436 ms->stat = DID_OK; in mesh_start_cmd()
437 ms->aborting = 0; in mesh_start_cmd()
439 ms->tgts[id].n_log = 0; in mesh_start_cmd()
440 dlog(ms, "start cmd=%x", (int) cmd); in mesh_start_cmd()
444 dlog(ms, "about to arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
456 dlog(ms, "busy b4 arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
463 dlog(ms, "intr b4 arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
466 mesh_interrupt(ms); in mesh_start_cmd()
467 if (ms->phase != arbitrating) in mesh_start_cmd()
474 ms->stat = DID_BUS_BUSY; in mesh_start_cmd()
475 ms->phase = idle; in mesh_start_cmd()
476 mesh_done(ms, 0); in mesh_start_cmd()
501 dlog(ms, "intr after disresel, intr/exc/err/fc=%.8x", in mesh_start_cmd()
504 mesh_interrupt(ms); in mesh_start_cmd()
505 if (ms->phase != arbitrating) in mesh_start_cmd()
507 dlog(ms, "after intr after disresel, intr/exc/err/fc=%.8x", in mesh_start_cmd()
519 dlog(ms, "after arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
524 dlog(ms, "resel? after arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
535 dlog(ms, "tried reset after arb, intr/exc/err/fc=%.8x", in mesh_start_cmd()
557 static void mesh_start(struct mesh_state *ms) in mesh_start() argument
561 if (ms->phase != idle || ms->current_req != NULL) { in mesh_start()
563 ms->phase, ms); in mesh_start()
567 while (ms->phase == idle) { in mesh_start()
569 for (cmd = ms->request_q; ; cmd = (struct scsi_cmnd *) cmd->host_scribble) { in mesh_start()
572 if (ms->tgts[cmd->device->id].current_req == NULL) in mesh_start()
578 ms->request_q = next; in mesh_start()
582 ms->request_qtail = prev; in mesh_start()
584 mesh_start_cmd(ms, cmd); in mesh_start()
588 static void mesh_done(struct mesh_state *ms, int start_next) in mesh_done() argument
591 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in mesh_done()
593 cmd = ms->current_req; in mesh_done()
594 ms->current_req = NULL; in mesh_done()
597 cmd->result = (ms->stat << 16) + cmd->SCp.Status; in mesh_done()
598 if (ms->stat == DID_OK) in mesh_done()
602 cmd->result, ms->data_ptr, scsi_bufflen(cmd)); in mesh_done()
613 cmd->SCp.this_residual -= ms->data_ptr; in mesh_done()
614 mesh_completed(ms, cmd); in mesh_done()
617 out_8(&ms->mesh->sequence, SEQ_ENBRESEL); in mesh_done()
618 mesh_flush_io(ms->mesh); in mesh_done()
620 ms->phase = idle; in mesh_done()
621 mesh_start(ms); in mesh_done()
625 static inline void add_sdtr_msg(struct mesh_state *ms) in add_sdtr_msg() argument
627 int i = ms->n_msgout; in add_sdtr_msg()
629 ms->msgout[i] = EXTENDED_MESSAGE; in add_sdtr_msg()
630 ms->msgout[i+1] = 3; in add_sdtr_msg()
631 ms->msgout[i+2] = EXTENDED_SDTR; in add_sdtr_msg()
632 ms->msgout[i+3] = mesh_sync_period/4; in add_sdtr_msg()
633 ms->msgout[i+4] = (ALLOW_SYNC(ms->conn_tgt)? mesh_sync_offset: 0); in add_sdtr_msg()
634 ms->n_msgout = i + 5; in add_sdtr_msg()
637 static void set_sdtr(struct mesh_state *ms, int period, int offset) in set_sdtr() argument
639 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in set_sdtr()
640 volatile struct mesh_regs __iomem *mr = ms->mesh; in set_sdtr()
648 ms->conn_tgt); in set_sdtr()
657 v = (ms->clk_freq / 5000) * period; in set_sdtr()
662 tr = (ms->clk_freq + 250000) / 500000; in set_sdtr()
668 tr = ((ms->clk_freq / (v + 2)) + 199999) / 200000; in set_sdtr()
675 ms->conn_tgt, tr/10, tr%10); in set_sdtr()
678 static void start_phase(struct mesh_state *ms) in start_phase() argument
681 volatile struct mesh_regs __iomem *mr = ms->mesh; in start_phase()
682 volatile struct dbdma_regs __iomem *md = ms->dma; in start_phase()
683 struct scsi_cmnd *cmd = ms->current_req; in start_phase()
684 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in start_phase()
686 dlog(ms, "start_phase nmo/exc/fc/seq = %.8x", in start_phase()
687 MKWORD(ms->n_msgout, mr->exception, mr->fifo_count, mr->sequence)); in start_phase()
689 seq = use_active_neg + (ms->n_msgout? SEQ_ATN: 0); in start_phase()
690 switch (ms->msgphase) { in start_phase()
698 ms->n_msgin = 0; in start_phase()
707 if (ms->n_msgout <= 0) { in start_phase()
709 ms->n_msgout); in start_phase()
710 mesh_dump_regs(ms); in start_phase()
711 ms->msgphase = msg_none; in start_phase()
714 if (ALLOW_DEBUG(ms->conn_tgt)) { in start_phase()
716 ms->n_msgout); in start_phase()
717 for (i = 0; i < ms->n_msgout; ++i) in start_phase()
718 printk(" %x", ms->msgout[i]); in start_phase()
721 dlog(ms, "msgout msg=%.8x", MKWORD(ms->n_msgout, ms->msgout[0], in start_phase()
722 ms->msgout[1], ms->msgout[2])); in start_phase()
732 dlog(ms, "bus0 was %.2x explicitly asserting ATN", mr->bus_status0); in start_phase()
739 dlog(ms,"hace: after explicit ATN bus0=%.2x",mr->bus_status0); in start_phase()
741 if (ms->n_msgout == 1) { in start_phase()
748 cmd_complete(ms); in start_phase()
750 out_8(&mr->count_lo, ms->n_msgout - 1); in start_phase()
752 for (i = 0; i < ms->n_msgout - 1; ++i) in start_phase()
753 out_8(&mr->fifo, ms->msgout[i]); in start_phase()
759 ms->msgphase); in start_phase()
762 switch (ms->phase) { in start_phase()
764 out_8(&mr->dest_id, ms->conn_tgt); in start_phase()
784 if (!ms->dma_started) { in start_phase()
785 set_dma_cmds(ms, cmd); in start_phase()
786 out_le32(&md->cmdptr, virt_to_phys(ms->dma_cmds)); in start_phase()
788 ms->dma_started = 1; in start_phase()
790 nb = ms->dma_count; in start_phase()
793 ms->dma_count -= nb; in start_phase()
794 ms->data_ptr += nb; in start_phase()
810 dlog(ms, "enbresel intr/exc/err/fc=%.8x", in start_phase()
817 ms->phase); in start_phase()
818 dumpslog(ms); in start_phase()
823 static inline void get_msgin(struct mesh_state *ms) in get_msgin() argument
825 volatile struct mesh_regs __iomem *mr = ms->mesh; in get_msgin()
830 i = ms->n_msgin; in get_msgin()
831 ms->n_msgin = i + n; in get_msgin()
833 ms->msgin[i++] = in_8(&mr->fifo); in get_msgin()
837 static inline int msgin_length(struct mesh_state *ms) in msgin_length() argument
842 if (ms->n_msgin > 0) { in msgin_length()
843 b = ms->msgin[0]; in msgin_length()
846 n = ms->n_msgin < 2? 2: ms->msgin[1] + 2; in msgin_length()
855 static void reselected(struct mesh_state *ms) in reselected() argument
857 volatile struct mesh_regs __iomem *mr = ms->mesh; in reselected()
862 switch (ms->phase) { in reselected()
866 if ((cmd = ms->current_req) != NULL) { in reselected()
868 cmd->host_scribble = (void *) ms->request_q; in reselected()
869 if (ms->request_q == NULL) in reselected()
870 ms->request_qtail = cmd; in reselected()
871 ms->request_q = cmd; in reselected()
872 tp = &ms->tgts[cmd->device->id]; in reselected()
877 ms->phase = reselecting; in reselected()
878 mesh_done(ms, 0); in reselected()
884 ms->msgphase, ms->phase, ms->conn_tgt); in reselected()
885 dumplog(ms, ms->conn_tgt); in reselected()
886 dumpslog(ms); in reselected()
889 if (ms->dma_started) { in reselected()
891 halt_dma(ms); in reselected()
893 ms->current_req = NULL; in reselected()
894 ms->phase = dataing; in reselected()
895 ms->msgphase = msg_in; in reselected()
896 ms->n_msgout = 0; in reselected()
897 ms->last_n_msgout = 0; in reselected()
898 prev = ms->conn_tgt; in reselected()
912 dlog(ms, "extra resel err/exc/fc = %.6x", in reselected()
928 ms->conn_tgt = ms->host->this_id; in reselected()
934 dlog(ms, "reseldata %x", b); in reselected()
937 if ((b & (1 << t)) != 0 && t != ms->host->this_id) in reselected()
939 if (b != (1 << t) + (1 << ms->host->this_id)) { in reselected()
941 ms->conn_tgt = ms->host->this_id; in reselected()
949 ms->conn_tgt = t; in reselected()
950 tp = &ms->tgts[t]; in reselected()
957 ms->current_req = tp->current_req; in reselected()
962 ms->data_ptr = tp->saved_ptr; in reselected()
963 dlog(ms, "resel prev tgt=%d", prev); in reselected()
964 dlog(ms, "resel err/exc=%.4x", MKWORD(0, 0, mr->error, mr->exception)); in reselected()
965 start_phase(ms); in reselected()
969 dumplog(ms, ms->conn_tgt); in reselected()
970 dumpslog(ms); in reselected()
971 ms->data_ptr = 0; in reselected()
972 ms->aborting = 1; in reselected()
973 start_phase(ms); in reselected()
976 static void do_abort(struct mesh_state *ms) in do_abort() argument
978 ms->msgout[0] = ABORT; in do_abort()
979 ms->n_msgout = 1; in do_abort()
980 ms->aborting = 1; in do_abort()
981 ms->stat = DID_ABORT; in do_abort()
982 dlog(ms, "abort", 0); in do_abort()
985 static void handle_reset(struct mesh_state *ms) in handle_reset() argument
990 volatile struct mesh_regs __iomem *mr = ms->mesh; in handle_reset()
993 tp = &ms->tgts[tgt]; in handle_reset()
997 mesh_completed(ms, cmd); in handle_reset()
999 ms->tgts[tgt].sdtr_state = do_sdtr; in handle_reset()
1000 ms->tgts[tgt].sync_params = ASYNC_PARAMS; in handle_reset()
1002 ms->current_req = NULL; in handle_reset()
1003 while ((cmd = ms->request_q) != NULL) { in handle_reset()
1004 ms->request_q = (struct scsi_cmnd *) cmd->host_scribble; in handle_reset()
1006 mesh_completed(ms, cmd); in handle_reset()
1008 ms->phase = idle; in handle_reset()
1009 ms->msgphase = msg_none; in handle_reset()
1021 struct mesh_state *ms = dev_id; in do_mesh_interrupt() local
1022 struct Scsi_Host *dev = ms->host; in do_mesh_interrupt()
1025 mesh_interrupt(ms); in do_mesh_interrupt()
1030 static void handle_error(struct mesh_state *ms) in handle_error() argument
1033 volatile struct mesh_regs __iomem *mr = ms->mesh; in handle_error()
1038 dlog(ms, "error err/exc/fc/cl=%.8x", in handle_error()
1047 handle_reset(ms); in handle_error()
1054 reselected(ms); in handle_error()
1057 if (!ms->aborting) { in handle_error()
1059 ms->conn_tgt); in handle_error()
1060 dumplog(ms, ms->conn_tgt); in handle_error()
1061 dumpslog(ms); in handle_error()
1064 ms->stat = DID_ABORT; in handle_error()
1065 mesh_done(ms, 1); in handle_error()
1069 if (ms->msgphase == msg_in) { in handle_error()
1071 ms->conn_tgt); in handle_error()
1072 ms->msgout[0] = MSG_PARITY_ERROR; in handle_error()
1073 ms->n_msgout = 1; in handle_error()
1074 ms->msgphase = msg_in_bad; in handle_error()
1075 cmd_complete(ms); in handle_error()
1078 if (ms->stat == DID_OK) { in handle_error()
1080 ms->conn_tgt); in handle_error()
1081 ms->stat = DID_PARITY; in handle_error()
1085 cmd_complete(ms); in handle_error()
1098 reselected(ms); in handle_error()
1104 phase_mismatch(ms); in handle_error()
1112 mesh_dump_regs(ms); in handle_error()
1113 dumplog(ms, ms->conn_tgt); in handle_error()
1114 if (ms->phase > selecting && (in_8(&mr->bus_status1) & BS1_BSY)) { in handle_error()
1116 do_abort(ms); in handle_error()
1117 phase_mismatch(ms); in handle_error()
1120 ms->stat = DID_ERROR; in handle_error()
1121 mesh_done(ms, 1); in handle_error()
1124 static void handle_exception(struct mesh_state *ms) in handle_exception() argument
1127 volatile struct mesh_regs __iomem *mr = ms->mesh; in handle_exception()
1134 reselected(ms); in handle_exception()
1137 ms->stat = DID_BUS_BUSY; in handle_exception()
1138 mesh_done(ms, 1); in handle_exception()
1141 ms->stat = DID_BAD_TARGET; in handle_exception()
1142 mesh_done(ms, 1); in handle_exception()
1146 phase_mismatch(ms); in handle_exception()
1149 mesh_dump_regs(ms); in handle_exception()
1150 dumplog(ms, ms->conn_tgt); in handle_exception()
1151 do_abort(ms); in handle_exception()
1152 phase_mismatch(ms); in handle_exception()
1156 static void handle_msgin(struct mesh_state *ms) in handle_msgin() argument
1159 struct scsi_cmnd *cmd = ms->current_req; in handle_msgin()
1160 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in handle_msgin()
1162 if (ms->n_msgin == 0) in handle_msgin()
1164 code = ms->msgin[0]; in handle_msgin()
1165 if (ALLOW_DEBUG(ms->conn_tgt)) { in handle_msgin()
1166 printk(KERN_DEBUG "got %d message bytes:", ms->n_msgin); in handle_msgin()
1167 for (i = 0; i < ms->n_msgin; ++i) in handle_msgin()
1168 printk(" %x", ms->msgin[i]); in handle_msgin()
1171 dlog(ms, "msgin msg=%.8x", in handle_msgin()
1172 MKWORD(ms->n_msgin, code, ms->msgin[1], ms->msgin[2])); in handle_msgin()
1174 ms->expect_reply = 0; in handle_msgin()
1175 ms->n_msgout = 0; in handle_msgin()
1176 if (ms->n_msgin < msgin_length(ms)) in handle_msgin()
1184 switch (ms->msgin[2]) { in handle_msgin()
1186 ms->data_ptr += (ms->msgin[3] << 24) + ms->msgin[6] in handle_msgin()
1187 + (ms->msgin[4] << 16) + (ms->msgin[5] << 8); in handle_msgin()
1192 add_sdtr_msg(ms); in handle_msgin()
1195 if (ms->msgout[3] < ms->msgin[3]) in handle_msgin()
1196 ms->msgout[3] = ms->msgin[3]; in handle_msgin()
1197 if (ms->msgout[4] > ms->msgin[4]) in handle_msgin()
1198 ms->msgout[4] = ms->msgin[4]; in handle_msgin()
1199 set_sdtr(ms, ms->msgout[3], ms->msgout[4]); in handle_msgin()
1200 ms->msgphase = msg_out; in handle_msgin()
1202 set_sdtr(ms, ms->msgin[3], ms->msgin[4]); in handle_msgin()
1210 tp->saved_ptr = ms->data_ptr; in handle_msgin()
1213 ms->data_ptr = tp->saved_ptr; in handle_msgin()
1216 ms->phase = disconnecting; in handle_msgin()
1222 set_sdtr(ms, 0, 0); in handle_msgin()
1229 do_abort(ms); in handle_msgin()
1230 ms->msgphase = msg_out; in handle_msgin()
1235 cmd->device->lun, ms->conn_tgt); in handle_msgin()
1245 ms->conn_tgt); in handle_msgin()
1246 for (i = 0; i < ms->n_msgin; ++i) in handle_msgin()
1247 printk(" %x", ms->msgin[i]); in handle_msgin()
1249 ms->msgout[0] = MESSAGE_REJECT; in handle_msgin()
1250 ms->n_msgout = 1; in handle_msgin()
1251 ms->msgphase = msg_out; in handle_msgin()
1257 static void set_dma_cmds(struct mesh_state *ms, struct scsi_cmnd *cmd) in set_dma_cmds() argument
1263 dma_cmd = ms->tgts[ms->conn_tgt].data_goes_out? in set_dma_cmds()
1265 dcmds = ms->dma_cmds; in set_dma_cmds()
1277 off = ms->data_ptr; in set_dma_cmds()
1315 ms->dma_count = dtot; in set_dma_cmds()
1318 static void halt_dma(struct mesh_state *ms) in halt_dma() argument
1320 volatile struct dbdma_regs __iomem *md = ms->dma; in halt_dma()
1321 volatile struct mesh_regs __iomem *mr = ms->mesh; in halt_dma()
1322 struct scsi_cmnd *cmd = ms->current_req; in halt_dma()
1325 if (!ms->tgts[ms->conn_tgt].data_goes_out) { in halt_dma()
1336 dlog(ms, "halt_dma fc/count=%.6x", in halt_dma()
1338 if (ms->tgts[ms->conn_tgt].data_goes_out) in halt_dma()
1342 ms->data_ptr -= nb; in halt_dma()
1343 dlog(ms, "data_ptr %x", ms->data_ptr); in halt_dma()
1344 if (ms->data_ptr < 0) { in halt_dma()
1346 ms->data_ptr, nb, ms); in halt_dma()
1347 ms->data_ptr = 0; in halt_dma()
1349 dumplog(ms, ms->conn_tgt); in halt_dma()
1350 dumpslog(ms); in halt_dma()
1353 ms->data_ptr > scsi_bufflen(cmd)) { in halt_dma()
1356 ms->conn_tgt, ms->data_ptr, scsi_bufflen(cmd), in halt_dma()
1357 ms->tgts[ms->conn_tgt].data_goes_out); in halt_dma()
1360 ms->dma_started = 0; in halt_dma()
1363 static void phase_mismatch(struct mesh_state *ms) in phase_mismatch() argument
1365 volatile struct mesh_regs __iomem *mr = ms->mesh; in phase_mismatch()
1368 dlog(ms, "phasemm ch/cl/seq/fc=%.8x", in phase_mismatch()
1371 if (ms->msgphase == msg_out_xxx && phase == BP_MSGOUT) { in phase_mismatch()
1377 out_8(&mr->fifo, ms->msgout[ms->n_msgout-1]); in phase_mismatch()
1378 ms->msgphase = msg_out_last; in phase_mismatch()
1382 if (ms->msgphase == msg_in) { in phase_mismatch()
1383 get_msgin(ms); in phase_mismatch()
1384 if (ms->n_msgin) in phase_mismatch()
1385 handle_msgin(ms); in phase_mismatch()
1388 if (ms->dma_started) in phase_mismatch()
1389 halt_dma(ms); in phase_mismatch()
1396 ms->msgphase = msg_none; in phase_mismatch()
1399 ms->tgts[ms->conn_tgt].data_goes_out = 0; in phase_mismatch()
1400 ms->phase = dataing; in phase_mismatch()
1403 ms->tgts[ms->conn_tgt].data_goes_out = 1; in phase_mismatch()
1404 ms->phase = dataing; in phase_mismatch()
1407 ms->phase = commanding; in phase_mismatch()
1410 ms->phase = statusing; in phase_mismatch()
1413 ms->msgphase = msg_in; in phase_mismatch()
1414 ms->n_msgin = 0; in phase_mismatch()
1417 ms->msgphase = msg_out; in phase_mismatch()
1418 if (ms->n_msgout == 0) { in phase_mismatch()
1419 if (ms->aborting) { in phase_mismatch()
1420 do_abort(ms); in phase_mismatch()
1422 if (ms->last_n_msgout == 0) { in phase_mismatch()
1425 ms->msgout[0] = NOP; in phase_mismatch()
1426 ms->last_n_msgout = 1; in phase_mismatch()
1428 ms->n_msgout = ms->last_n_msgout; in phase_mismatch()
1434 ms->stat = DID_ERROR; in phase_mismatch()
1435 mesh_done(ms, 1); in phase_mismatch()
1439 start_phase(ms); in phase_mismatch()
1442 static void cmd_complete(struct mesh_state *ms) in cmd_complete() argument
1444 volatile struct mesh_regs __iomem *mr = ms->mesh; in cmd_complete()
1445 struct scsi_cmnd *cmd = ms->current_req; in cmd_complete()
1446 struct mesh_target *tp = &ms->tgts[ms->conn_tgt]; in cmd_complete()
1449 dlog(ms, "cmd_complete fc=%x", mr->fifo_count); in cmd_complete()
1450 seq = use_active_neg + (ms->n_msgout? SEQ_ATN: 0); in cmd_complete()
1451 switch (ms->msgphase) { in cmd_complete()
1454 ms->n_msgin = 0; in cmd_complete()
1455 ms->msgphase = msg_in; in cmd_complete()
1460 get_msgin(ms); in cmd_complete()
1461 n = msgin_length(ms); in cmd_complete()
1462 if (ms->n_msgin < n) { in cmd_complete()
1463 out_8(&mr->count_lo, n - ms->n_msgin); in cmd_complete()
1466 ms->msgphase = msg_none; in cmd_complete()
1467 handle_msgin(ms); in cmd_complete()
1468 start_phase(ms); in cmd_complete()
1497 dlog(ms, "last_mbyte err/exc/fc/cl=%.8x", in cmd_complete()
1502 ms->last_n_msgout = ms->n_msgout; in cmd_complete()
1503 ms->n_msgout = 0; in cmd_complete()
1507 handle_error(ms); in cmd_complete()
1516 handle_exception(ms); in cmd_complete()
1523 out_8(&mr->fifo, ms->msgout[ms->n_msgout-1]); in cmd_complete()
1524 ms->msgphase = msg_out_last; in cmd_complete()
1527 ms->msgphase = msg_out_xxx; in cmd_complete()
1532 ms->last_n_msgout = ms->n_msgout; in cmd_complete()
1533 ms->n_msgout = 0; in cmd_complete()
1534 ms->msgphase = ms->expect_reply? msg_in: msg_none; in cmd_complete()
1535 start_phase(ms); in cmd_complete()
1539 switch (ms->phase) { in cmd_complete()
1542 dumpslog(ms); in cmd_complete()
1545 dlog(ms, "Selecting phase at command completion",0); in cmd_complete()
1546 ms->msgout[0] = IDENTIFY(ALLOW_RESEL(ms->conn_tgt), in cmd_complete()
1548 ms->n_msgout = 1; in cmd_complete()
1549 ms->expect_reply = 0; in cmd_complete()
1550 if (ms->aborting) { in cmd_complete()
1551 ms->msgout[0] = ABORT; in cmd_complete()
1552 ms->n_msgout++; in cmd_complete()
1555 add_sdtr_msg(ms); in cmd_complete()
1556 ms->expect_reply = 1; in cmd_complete()
1559 ms->msgphase = msg_out; in cmd_complete()
1570 dlog(ms, "impatient for req", ms->n_msgout); in cmd_complete()
1571 ms->msgphase = msg_none; in cmd_complete()
1578 if (ms->dma_count != 0) { in cmd_complete()
1579 start_phase(ms); in cmd_complete()
1595 halt_dma(ms); in cmd_complete()
1604 ms->msgphase = msg_in; in cmd_complete()
1607 mesh_done(ms, 1); in cmd_complete()
1610 ms->current_req = NULL; in cmd_complete()
1611 ms->phase = idle; in cmd_complete()
1612 mesh_start(ms); in cmd_complete()
1617 ++ms->phase; in cmd_complete()
1618 start_phase(ms); in cmd_complete()
1630 struct mesh_state *ms; in mesh_queue_lck() local
1635 ms = (struct mesh_state *) cmd->device->host->hostdata; in mesh_queue_lck()
1637 if (ms->request_q == NULL) in mesh_queue_lck()
1638 ms->request_q = cmd; in mesh_queue_lck()
1640 ms->request_qtail->host_scribble = (void *) cmd; in mesh_queue_lck()
1641 ms->request_qtail = cmd; in mesh_queue_lck()
1643 if (ms->phase == idle) in mesh_queue_lck()
1644 mesh_start(ms); in mesh_queue_lck()
1656 static void mesh_interrupt(struct mesh_state *ms) in DEF_SCSI_QCMD()
1658 volatile struct mesh_regs __iomem *mr = ms->mesh; in DEF_SCSI_QCMD()
1662 if (ALLOW_DEBUG(ms->conn_tgt)) in DEF_SCSI_QCMD()
1666 ms->phase, ms->msgphase); in DEF_SCSI_QCMD()
1669 dlog(ms, "interrupt intr/err/exc/seq=%.8x", in DEF_SCSI_QCMD()
1672 handle_error(ms); in DEF_SCSI_QCMD()
1674 handle_exception(ms); in DEF_SCSI_QCMD()
1677 cmd_complete(ms); in DEF_SCSI_QCMD()
1688 struct mesh_state *ms = (struct mesh_state *) cmd->device->host->hostdata; in mesh_abort() local
1691 mesh_dump_regs(ms); in mesh_abort()
1692 dumplog(ms, cmd->device->id); in mesh_abort()
1693 dumpslog(ms); in mesh_abort()
1705 struct mesh_state *ms = (struct mesh_state *) cmd->device->host->hostdata; in mesh_host_reset() local
1706 volatile struct mesh_regs __iomem *mr = ms->mesh; in mesh_host_reset()
1707 volatile struct dbdma_regs __iomem *md = ms->dma; in mesh_host_reset()
1712 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_host_reset()
1722 out_8(&mr->source_id, ms->host->this_id); in mesh_host_reset()
1733 handle_reset(ms); in mesh_host_reset()
1735 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_host_reset()
1739 static void set_mesh_power(struct mesh_state *ms, int state) in set_mesh_power() argument
1744 pmac_call_feature(PMAC_FTR_MESH_ENABLE, macio_get_of_node(ms->mdev), 0, 1); in set_mesh_power()
1747 pmac_call_feature(PMAC_FTR_MESH_ENABLE, macio_get_of_node(ms->mdev), 0, 0); in set_mesh_power()
1756 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_suspend() local
1767 if (ms->phase == sleeping) in mesh_suspend()
1770 scsi_block_requests(ms->host); in mesh_suspend()
1771 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_suspend()
1772 while(ms->phase != idle) { in mesh_suspend()
1773 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_suspend()
1775 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_suspend()
1777 ms->phase = sleeping; in mesh_suspend()
1778 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_suspend()
1779 disable_irq(ms->meshintr); in mesh_suspend()
1780 set_mesh_power(ms, 0); in mesh_suspend()
1787 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_resume() local
1790 if (ms->phase != sleeping) in mesh_resume()
1793 set_mesh_power(ms, 1); in mesh_resume()
1794 mesh_init(ms); in mesh_resume()
1795 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_resume()
1796 mesh_start(ms); in mesh_resume()
1797 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_resume()
1798 enable_irq(ms->meshintr); in mesh_resume()
1799 scsi_unblock_requests(ms->host); in mesh_resume()
1813 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_shutdown() local
1818 spin_lock_irqsave(ms->host->host_lock, flags); in mesh_shutdown()
1819 mr = ms->mesh; in mesh_shutdown()
1826 spin_unlock_irqrestore(ms->host->host_lock, flags); in mesh_shutdown()
1850 struct mesh_state *ms; in mesh_probe() local
1889 ms = (struct mesh_state *) mesh_host->hostdata; in mesh_probe()
1890 macio_set_drvdata(mdev, ms); in mesh_probe()
1891 ms->host = mesh_host; in mesh_probe()
1892 ms->mdev = mdev; in mesh_probe()
1893 ms->pdev = pdev; in mesh_probe()
1895 ms->mesh = ioremap(macio_resource_start(mdev, 0), 0x1000); in mesh_probe()
1896 if (ms->mesh == NULL) { in mesh_probe()
1900 ms->dma = ioremap(macio_resource_start(mdev, 1), 0x1000); in mesh_probe()
1901 if (ms->dma == NULL) { in mesh_probe()
1903 iounmap(ms->mesh); in mesh_probe()
1907 ms->meshintr = macio_irq(mdev, 0); in mesh_probe()
1908 ms->dmaintr = macio_irq(mdev, 1); in mesh_probe()
1913 ms->dma_cmd_size = (mesh_host->sg_tablesize + 2) * sizeof(struct dbdma_cmd); in mesh_probe()
1919 ms->dma_cmd_size, &dma_cmd_bus); in mesh_probe()
1925 ms->dma_cmds = (struct dbdma_cmd *) DBDMA_ALIGN(dma_cmd_space); in mesh_probe()
1926 ms->dma_cmd_space = dma_cmd_space; in mesh_probe()
1927 ms->dma_cmd_bus = dma_cmd_bus + ((unsigned long)ms->dma_cmds) in mesh_probe()
1929 ms->current_req = NULL; in mesh_probe()
1931 ms->tgts[tgt].sdtr_state = do_sdtr; in mesh_probe()
1932 ms->tgts[tgt].sync_params = ASYNC_PARAMS; in mesh_probe()
1933 ms->tgts[tgt].current_req = NULL; in mesh_probe()
1937 ms->clk_freq = *cfp; in mesh_probe()
1940 ms->clk_freq = 50000000; in mesh_probe()
1946 minper = 1000000000 / (ms->clk_freq / 5); /* ns */ in mesh_probe()
1951 set_mesh_power(ms, 1); in mesh_probe()
1954 mesh_init(ms); in mesh_probe()
1957 if (request_irq(ms->meshintr, do_mesh_interrupt, 0, "MESH", ms)) { in mesh_probe()
1958 printk(KERN_ERR "MESH: can't get irq %d\n", ms->meshintr); in mesh_probe()
1970 free_irq(ms->meshintr, ms); in mesh_probe()
1976 set_mesh_power(ms, 0); in mesh_probe()
1977 pci_free_consistent(macio_get_pci_dev(mdev), ms->dma_cmd_size, in mesh_probe()
1978 ms->dma_cmd_space, ms->dma_cmd_bus); in mesh_probe()
1980 iounmap(ms->dma); in mesh_probe()
1981 iounmap(ms->mesh); in mesh_probe()
1992 struct mesh_state *ms = (struct mesh_state *)macio_get_drvdata(mdev); in mesh_remove() local
1993 struct Scsi_Host *mesh_host = ms->host; in mesh_remove()
1997 free_irq(ms->meshintr, ms); in mesh_remove()
2003 set_mesh_power(ms, 0); in mesh_remove()
2006 iounmap(ms->mesh); in mesh_remove()
2007 iounmap(ms->dma); in mesh_remove()
2010 pci_free_consistent(macio_get_pci_dev(mdev), ms->dma_cmd_size, in mesh_remove()
2011 ms->dma_cmd_space, ms->dma_cmd_bus); in mesh_remove()