1 /*====================================================================== 2 3 NinjaSCSI-3 / NinjaSCSI-32Bi PCMCIA SCSI host adapter card driver 4 By: YOKOTA Hiroshi <yokota@netlab.is.tsukuba.ac.jp> 5 6 Ver.2.8 Support 32bit MMIO mode 7 Support Synchronous Data Transfer Request (SDTR) mode 8 Ver.2.0 Support 32bit PIO mode 9 Ver.1.1.2 Fix for scatter list buffer exceeds 10 Ver.1.1 Support scatter list 11 Ver.0.1 Initial version 12 13 This software may be used and distributed according to the terms of 14 the GNU General Public License. 15 16 ======================================================================*/ 17 18 /*********************************************************************** 19 This driver is for these PCcards. 20 21 I-O DATA PCSC-F (Workbit NinjaSCSI-3) 22 "WBT", "NinjaSCSI-3", "R1.0" 23 I-O DATA CBSC-II (Workbit NinjaSCSI-32Bi in 16bit mode) 24 "IO DATA", "CBSC16 ", "1" 25 26 ***********************************************************************/ 27 28 #include <linux/module.h> 29 #include <linux/kernel.h> 30 #include <linux/init.h> 31 #include <linux/slab.h> 32 #include <linux/string.h> 33 #include <linux/timer.h> 34 #include <linux/ioport.h> 35 #include <linux/delay.h> 36 #include <linux/interrupt.h> 37 #include <linux/major.h> 38 #include <linux/blkdev.h> 39 #include <linux/stat.h> 40 41 #include <asm/io.h> 42 #include <asm/irq.h> 43 44 #include <../drivers/scsi/scsi.h> 45 #include <scsi/scsi_host.h> 46 47 #include <scsi/scsi.h> 48 #include <scsi/scsi_ioctl.h> 49 50 #include <pcmcia/cistpl.h> 51 #include <pcmcia/cisreg.h> 52 #include <pcmcia/ds.h> 53 54 #include "nsp_cs.h" 55 56 MODULE_AUTHOR("YOKOTA Hiroshi <yokota@netlab.is.tsukuba.ac.jp>"); 57 MODULE_DESCRIPTION("WorkBit NinjaSCSI-3 / NinjaSCSI-32Bi(16bit) PCMCIA SCSI host adapter module"); 58 MODULE_SUPPORTED_DEVICE("sd,sr,sg,st"); 59 #ifdef MODULE_LICENSE 60 MODULE_LICENSE("GPL"); 61 #endif 62 63 #include "nsp_io.h" 64 65 /*====================================================================*/ 66 /* Parameters that can be set with 'insmod' */ 67 68 static int nsp_burst_mode = BURST_MEM32; 69 module_param(nsp_burst_mode, int, 0); 70 MODULE_PARM_DESC(nsp_burst_mode, "Burst transfer mode (0=io8, 1=io32, 2=mem32(default))"); 71 72 /* Release IO ports after configuration? */ 73 static bool free_ports = 0; 74 module_param(free_ports, bool, 0); 75 MODULE_PARM_DESC(free_ports, "Release IO ports after configuration? (default: 0 (=no))"); 76 77 static struct scsi_host_template nsp_driver_template = { 78 .proc_name = "nsp_cs", 79 .show_info = nsp_show_info, 80 .name = "WorkBit NinjaSCSI-3/32Bi(16bit)", 81 .info = nsp_info, 82 .queuecommand = nsp_queuecommand, 83 /* .eh_abort_handler = nsp_eh_abort,*/ 84 .eh_bus_reset_handler = nsp_eh_bus_reset, 85 .eh_host_reset_handler = nsp_eh_host_reset, 86 .can_queue = 1, 87 .this_id = NSP_INITIATOR_ID, 88 .sg_tablesize = SG_ALL, 89 .use_clustering = DISABLE_CLUSTERING, 90 }; 91 92 static nsp_hw_data nsp_data_base; /* attach <-> detect glue */ 93 94 95 96 /* 97 * debug, error print 98 */ 99 #ifndef NSP_DEBUG 100 # define NSP_DEBUG_MASK 0x000000 101 # define nsp_msg(type, args...) nsp_cs_message("", 0, (type), args) 102 # define nsp_dbg(mask, args...) /* */ 103 #else 104 # define NSP_DEBUG_MASK 0xffffff 105 # define nsp_msg(type, args...) \ 106 nsp_cs_message (__func__, __LINE__, (type), args) 107 # define nsp_dbg(mask, args...) \ 108 nsp_cs_dmessage(__func__, __LINE__, (mask), args) 109 #endif 110 111 #define NSP_DEBUG_QUEUECOMMAND BIT(0) 112 #define NSP_DEBUG_REGISTER BIT(1) 113 #define NSP_DEBUG_AUTOSCSI BIT(2) 114 #define NSP_DEBUG_INTR BIT(3) 115 #define NSP_DEBUG_SGLIST BIT(4) 116 #define NSP_DEBUG_BUSFREE BIT(5) 117 #define NSP_DEBUG_CDB_CONTENTS BIT(6) 118 #define NSP_DEBUG_RESELECTION BIT(7) 119 #define NSP_DEBUG_MSGINOCCUR BIT(8) 120 #define NSP_DEBUG_EEPROM BIT(9) 121 #define NSP_DEBUG_MSGOUTOCCUR BIT(10) 122 #define NSP_DEBUG_BUSRESET BIT(11) 123 #define NSP_DEBUG_RESTART BIT(12) 124 #define NSP_DEBUG_SYNC BIT(13) 125 #define NSP_DEBUG_WAIT BIT(14) 126 #define NSP_DEBUG_TARGETFLAG BIT(15) 127 #define NSP_DEBUG_PROC BIT(16) 128 #define NSP_DEBUG_INIT BIT(17) 129 #define NSP_DEBUG_DATA_IO BIT(18) 130 #define NSP_SPECIAL_PRINT_REGISTER BIT(20) 131 132 #define NSP_DEBUG_BUF_LEN 150 133 134 static inline void nsp_inc_resid(struct scsi_cmnd *SCpnt, int residInc) 135 { 136 scsi_set_resid(SCpnt, scsi_get_resid(SCpnt) + residInc); 137 } 138 139 static void nsp_cs_message(const char *func, int line, char *type, char *fmt, ...) 140 { 141 va_list args; 142 char buf[NSP_DEBUG_BUF_LEN]; 143 144 va_start(args, fmt); 145 vsnprintf(buf, sizeof(buf), fmt, args); 146 va_end(args); 147 148 #ifndef NSP_DEBUG 149 printk("%snsp_cs: %s\n", type, buf); 150 #else 151 printk("%snsp_cs: %s (%d): %s\n", type, func, line, buf); 152 #endif 153 } 154 155 #ifdef NSP_DEBUG 156 static void nsp_cs_dmessage(const char *func, int line, int mask, char *fmt, ...) 157 { 158 va_list args; 159 char buf[NSP_DEBUG_BUF_LEN]; 160 161 va_start(args, fmt); 162 vsnprintf(buf, sizeof(buf), fmt, args); 163 va_end(args); 164 165 if (mask & NSP_DEBUG_MASK) { 166 printk("nsp_cs-debug: 0x%x %s (%d): %s\n", mask, func, line, buf); 167 } 168 } 169 #endif 170 171 /***********************************************************/ 172 173 /*==================================================== 174 * Clenaup parameters and call done() functions. 175 * You must be set SCpnt->result before call this function. 176 */ 177 static void nsp_scsi_done(struct scsi_cmnd *SCpnt) 178 { 179 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 180 181 data->CurrentSC = NULL; 182 183 SCpnt->scsi_done(SCpnt); 184 } 185 186 static int nsp_queuecommand_lck(struct scsi_cmnd *SCpnt, 187 void (*done)(struct scsi_cmnd *)) 188 { 189 #ifdef NSP_DEBUG 190 /*unsigned int host_id = SCpnt->device->host->this_id;*/ 191 /*unsigned int base = SCpnt->device->host->io_port;*/ 192 unsigned char target = scmd_id(SCpnt); 193 #endif 194 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 195 196 nsp_dbg(NSP_DEBUG_QUEUECOMMAND, 197 "SCpnt=0x%p target=%d lun=%llu sglist=0x%p bufflen=%d sg_count=%d", 198 SCpnt, target, SCpnt->device->lun, scsi_sglist(SCpnt), 199 scsi_bufflen(SCpnt), scsi_sg_count(SCpnt)); 200 //nsp_dbg(NSP_DEBUG_QUEUECOMMAND, "before CurrentSC=0x%p", data->CurrentSC); 201 202 SCpnt->scsi_done = done; 203 204 if (data->CurrentSC != NULL) { 205 nsp_msg(KERN_DEBUG, "CurrentSC!=NULL this can't be happen"); 206 SCpnt->result = DID_BAD_TARGET << 16; 207 nsp_scsi_done(SCpnt); 208 return 0; 209 } 210 211 #if 0 212 /* XXX: pcmcia-cs generates SCSI command with "scsi_info" utility. 213 This makes kernel crash when suspending... */ 214 if (data->ScsiInfo->stop != 0) { 215 nsp_msg(KERN_INFO, "suspending device. reject command."); 216 SCpnt->result = DID_BAD_TARGET << 16; 217 nsp_scsi_done(SCpnt); 218 return SCSI_MLQUEUE_HOST_BUSY; 219 } 220 #endif 221 222 show_command(SCpnt); 223 224 data->CurrentSC = SCpnt; 225 226 SCpnt->SCp.Status = CHECK_CONDITION; 227 SCpnt->SCp.Message = 0; 228 SCpnt->SCp.have_data_in = IO_UNKNOWN; 229 SCpnt->SCp.sent_command = 0; 230 SCpnt->SCp.phase = PH_UNDETERMINED; 231 scsi_set_resid(SCpnt, scsi_bufflen(SCpnt)); 232 233 /* setup scratch area 234 SCp.ptr : buffer pointer 235 SCp.this_residual : buffer length 236 SCp.buffer : next buffer 237 SCp.buffers_residual : left buffers in list 238 SCp.phase : current state of the command */ 239 if (scsi_bufflen(SCpnt)) { 240 SCpnt->SCp.buffer = scsi_sglist(SCpnt); 241 SCpnt->SCp.ptr = BUFFER_ADDR; 242 SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length; 243 SCpnt->SCp.buffers_residual = scsi_sg_count(SCpnt) - 1; 244 } else { 245 SCpnt->SCp.ptr = NULL; 246 SCpnt->SCp.this_residual = 0; 247 SCpnt->SCp.buffer = NULL; 248 SCpnt->SCp.buffers_residual = 0; 249 } 250 251 if (nsphw_start_selection(SCpnt) == FALSE) { 252 nsp_dbg(NSP_DEBUG_QUEUECOMMAND, "selection fail"); 253 SCpnt->result = DID_BUS_BUSY << 16; 254 nsp_scsi_done(SCpnt); 255 return 0; 256 } 257 258 259 //nsp_dbg(NSP_DEBUG_QUEUECOMMAND, "out"); 260 #ifdef NSP_DEBUG 261 data->CmdId++; 262 #endif 263 return 0; 264 } 265 266 static DEF_SCSI_QCMD(nsp_queuecommand) 267 268 /* 269 * setup PIO FIFO transfer mode and enable/disable to data out 270 */ 271 static void nsp_setup_fifo(nsp_hw_data *data, int enabled) 272 { 273 unsigned int base = data->BaseAddress; 274 unsigned char transfer_mode_reg; 275 276 //nsp_dbg(NSP_DEBUG_DATA_IO, "enabled=%d", enabled); 277 278 if (enabled != FALSE) { 279 transfer_mode_reg = TRANSFER_GO | BRAIND; 280 } else { 281 transfer_mode_reg = 0; 282 } 283 284 transfer_mode_reg |= data->TransferMode; 285 286 nsp_index_write(base, TRANSFERMODE, transfer_mode_reg); 287 } 288 289 static void nsphw_init_sync(nsp_hw_data *data) 290 { 291 sync_data tmp_sync = { .SyncNegotiation = SYNC_NOT_YET, 292 .SyncPeriod = 0, 293 .SyncOffset = 0 294 }; 295 int i; 296 297 /* setup sync data */ 298 for ( i = 0; i < ARRAY_SIZE(data->Sync); i++ ) { 299 data->Sync[i] = tmp_sync; 300 } 301 } 302 303 /* 304 * Initialize Ninja hardware 305 */ 306 static int nsphw_init(nsp_hw_data *data) 307 { 308 unsigned int base = data->BaseAddress; 309 310 nsp_dbg(NSP_DEBUG_INIT, "in base=0x%x", base); 311 312 data->ScsiClockDiv = CLOCK_40M | FAST_20; 313 data->CurrentSC = NULL; 314 data->FifoCount = 0; 315 data->TransferMode = MODE_IO8; 316 317 nsphw_init_sync(data); 318 319 /* block all interrupts */ 320 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLMASK); 321 322 /* setup SCSI interface */ 323 nsp_write(base, IFSELECT, IF_IFSEL); 324 325 nsp_index_write(base, SCSIIRQMODE, 0); 326 327 nsp_index_write(base, TRANSFERMODE, MODE_IO8); 328 nsp_index_write(base, CLOCKDIV, data->ScsiClockDiv); 329 330 nsp_index_write(base, PARITYCTRL, 0); 331 nsp_index_write(base, POINTERCLR, POINTER_CLEAR | 332 ACK_COUNTER_CLEAR | 333 REQ_COUNTER_CLEAR | 334 HOST_COUNTER_CLEAR); 335 336 /* setup fifo asic */ 337 nsp_write(base, IFSELECT, IF_REGSEL); 338 nsp_index_write(base, TERMPWRCTRL, 0); 339 if ((nsp_index_read(base, OTHERCONTROL) & TPWR_SENSE) == 0) { 340 nsp_msg(KERN_INFO, "terminator power on"); 341 nsp_index_write(base, TERMPWRCTRL, POWER_ON); 342 } 343 344 nsp_index_write(base, TIMERCOUNT, 0); 345 nsp_index_write(base, TIMERCOUNT, 0); /* requires 2 times!! */ 346 347 nsp_index_write(base, SYNCREG, 0); 348 nsp_index_write(base, ACKWIDTH, 0); 349 350 /* enable interrupts and ack them */ 351 nsp_index_write(base, SCSIIRQMODE, SCSI_PHASE_CHANGE_EI | 352 RESELECT_EI | 353 SCSI_RESET_IRQ_EI ); 354 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLCLEAR); 355 356 nsp_setup_fifo(data, FALSE); 357 358 return TRUE; 359 } 360 361 /* 362 * Start selection phase 363 */ 364 static int nsphw_start_selection(struct scsi_cmnd *SCpnt) 365 { 366 unsigned int host_id = SCpnt->device->host->this_id; 367 unsigned int base = SCpnt->device->host->io_port; 368 unsigned char target = scmd_id(SCpnt); 369 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 370 int time_out; 371 unsigned char phase, arbit; 372 373 //nsp_dbg(NSP_DEBUG_RESELECTION, "in"); 374 375 phase = nsp_index_read(base, SCSIBUSMON); 376 if(phase != BUSMON_BUS_FREE) { 377 //nsp_dbg(NSP_DEBUG_RESELECTION, "bus busy"); 378 return FALSE; 379 } 380 381 /* start arbitration */ 382 //nsp_dbg(NSP_DEBUG_RESELECTION, "start arbit"); 383 SCpnt->SCp.phase = PH_ARBSTART; 384 nsp_index_write(base, SETARBIT, ARBIT_GO); 385 386 time_out = 1000; 387 do { 388 /* XXX: what a stupid chip! */ 389 arbit = nsp_index_read(base, ARBITSTATUS); 390 //nsp_dbg(NSP_DEBUG_RESELECTION, "arbit=%d, wait_count=%d", arbit, wait_count); 391 udelay(1); /* hold 1.2us */ 392 } while((arbit & (ARBIT_WIN | ARBIT_FAIL)) == 0 && 393 (time_out-- != 0)); 394 395 if (!(arbit & ARBIT_WIN)) { 396 //nsp_dbg(NSP_DEBUG_RESELECTION, "arbit fail"); 397 nsp_index_write(base, SETARBIT, ARBIT_FLAG_CLEAR); 398 return FALSE; 399 } 400 401 /* assert select line */ 402 //nsp_dbg(NSP_DEBUG_RESELECTION, "assert SEL line"); 403 SCpnt->SCp.phase = PH_SELSTART; 404 udelay(3); /* wait 2.4us */ 405 nsp_index_write(base, SCSIDATALATCH, BIT(host_id) | BIT(target)); 406 nsp_index_write(base, SCSIBUSCTRL, SCSI_SEL | SCSI_BSY | SCSI_ATN); 407 udelay(2); /* wait >1.2us */ 408 nsp_index_write(base, SCSIBUSCTRL, SCSI_SEL | SCSI_BSY | SCSI_DATAOUT_ENB | SCSI_ATN); 409 nsp_index_write(base, SETARBIT, ARBIT_FLAG_CLEAR); 410 /*udelay(1);*/ /* wait >90ns */ 411 nsp_index_write(base, SCSIBUSCTRL, SCSI_SEL | SCSI_DATAOUT_ENB | SCSI_ATN); 412 413 /* check selection timeout */ 414 nsp_start_timer(SCpnt, 1000/51); 415 data->SelectionTimeOut = 1; 416 417 return TRUE; 418 } 419 420 struct nsp_sync_table { 421 unsigned int min_period; 422 unsigned int max_period; 423 unsigned int chip_period; 424 unsigned int ack_width; 425 }; 426 427 static struct nsp_sync_table nsp_sync_table_40M[] = { 428 {0x0c, 0x0c, 0x1, 0}, /* 20MB 50ns*/ 429 {0x19, 0x19, 0x3, 1}, /* 10MB 100ns*/ 430 {0x1a, 0x25, 0x5, 2}, /* 7.5MB 150ns*/ 431 {0x26, 0x32, 0x7, 3}, /* 5MB 200ns*/ 432 { 0, 0, 0, 0}, 433 }; 434 435 static struct nsp_sync_table nsp_sync_table_20M[] = { 436 {0x19, 0x19, 0x1, 0}, /* 10MB 100ns*/ 437 {0x1a, 0x25, 0x2, 0}, /* 7.5MB 150ns*/ 438 {0x26, 0x32, 0x3, 1}, /* 5MB 200ns*/ 439 { 0, 0, 0, 0}, 440 }; 441 442 /* 443 * setup synchronous data transfer mode 444 */ 445 static int nsp_analyze_sdtr(struct scsi_cmnd *SCpnt) 446 { 447 unsigned char target = scmd_id(SCpnt); 448 // unsigned char lun = SCpnt->device->lun; 449 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 450 sync_data *sync = &(data->Sync[target]); 451 struct nsp_sync_table *sync_table; 452 unsigned int period, offset; 453 int i; 454 455 456 nsp_dbg(NSP_DEBUG_SYNC, "in"); 457 458 period = sync->SyncPeriod; 459 offset = sync->SyncOffset; 460 461 nsp_dbg(NSP_DEBUG_SYNC, "period=0x%x, offset=0x%x", period, offset); 462 463 if ((data->ScsiClockDiv & (BIT(0)|BIT(1))) == CLOCK_20M) { 464 sync_table = nsp_sync_table_20M; 465 } else { 466 sync_table = nsp_sync_table_40M; 467 } 468 469 for ( i = 0; sync_table->max_period != 0; i++, sync_table++) { 470 if ( period >= sync_table->min_period && 471 period <= sync_table->max_period ) { 472 break; 473 } 474 } 475 476 if (period != 0 && sync_table->max_period == 0) { 477 /* 478 * No proper period/offset found 479 */ 480 nsp_dbg(NSP_DEBUG_SYNC, "no proper period/offset"); 481 482 sync->SyncPeriod = 0; 483 sync->SyncOffset = 0; 484 sync->SyncRegister = 0; 485 sync->AckWidth = 0; 486 487 return FALSE; 488 } 489 490 sync->SyncRegister = (sync_table->chip_period << SYNCREG_PERIOD_SHIFT) | 491 (offset & SYNCREG_OFFSET_MASK); 492 sync->AckWidth = sync_table->ack_width; 493 494 nsp_dbg(NSP_DEBUG_SYNC, "sync_reg=0x%x, ack_width=0x%x", sync->SyncRegister, sync->AckWidth); 495 496 return TRUE; 497 } 498 499 500 /* 501 * start ninja hardware timer 502 */ 503 static void nsp_start_timer(struct scsi_cmnd *SCpnt, int time) 504 { 505 unsigned int base = SCpnt->device->host->io_port; 506 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 507 508 //nsp_dbg(NSP_DEBUG_INTR, "in SCpnt=0x%p, time=%d", SCpnt, time); 509 data->TimerCount = time; 510 nsp_index_write(base, TIMERCOUNT, time); 511 } 512 513 /* 514 * wait for bus phase change 515 */ 516 static int nsp_negate_signal(struct scsi_cmnd *SCpnt, unsigned char mask, 517 char *str) 518 { 519 unsigned int base = SCpnt->device->host->io_port; 520 unsigned char reg; 521 int time_out; 522 523 //nsp_dbg(NSP_DEBUG_INTR, "in"); 524 525 time_out = 100; 526 527 do { 528 reg = nsp_index_read(base, SCSIBUSMON); 529 if (reg == 0xff) { 530 break; 531 } 532 } while ((--time_out != 0) && (reg & mask) != 0); 533 534 if (time_out == 0) { 535 nsp_msg(KERN_DEBUG, " %s signal off timeout", str); 536 } 537 538 return 0; 539 } 540 541 /* 542 * expect Ninja Irq 543 */ 544 static int nsp_expect_signal(struct scsi_cmnd *SCpnt, 545 unsigned char current_phase, 546 unsigned char mask) 547 { 548 unsigned int base = SCpnt->device->host->io_port; 549 int time_out; 550 unsigned char phase, i_src; 551 552 //nsp_dbg(NSP_DEBUG_INTR, "current_phase=0x%x, mask=0x%x", current_phase, mask); 553 554 time_out = 100; 555 do { 556 phase = nsp_index_read(base, SCSIBUSMON); 557 if (phase == 0xff) { 558 //nsp_dbg(NSP_DEBUG_INTR, "ret -1"); 559 return -1; 560 } 561 i_src = nsp_read(base, IRQSTATUS); 562 if (i_src & IRQSTATUS_SCSI) { 563 //nsp_dbg(NSP_DEBUG_INTR, "ret 0 found scsi signal"); 564 return 0; 565 } 566 if ((phase & mask) != 0 && (phase & BUSMON_PHASE_MASK) == current_phase) { 567 //nsp_dbg(NSP_DEBUG_INTR, "ret 1 phase=0x%x", phase); 568 return 1; 569 } 570 } while(time_out-- != 0); 571 572 //nsp_dbg(NSP_DEBUG_INTR, "timeout"); 573 return -1; 574 } 575 576 /* 577 * transfer SCSI message 578 */ 579 static int nsp_xfer(struct scsi_cmnd *SCpnt, int phase) 580 { 581 unsigned int base = SCpnt->device->host->io_port; 582 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 583 char *buf = data->MsgBuffer; 584 int len = min(MSGBUF_SIZE, data->MsgLen); 585 int ptr; 586 int ret; 587 588 //nsp_dbg(NSP_DEBUG_DATA_IO, "in"); 589 for (ptr = 0; len > 0; len--, ptr++) { 590 591 ret = nsp_expect_signal(SCpnt, phase, BUSMON_REQ); 592 if (ret <= 0) { 593 nsp_dbg(NSP_DEBUG_DATA_IO, "xfer quit"); 594 return 0; 595 } 596 597 /* if last byte, negate ATN */ 598 if (len == 1 && SCpnt->SCp.phase == PH_MSG_OUT) { 599 nsp_index_write(base, SCSIBUSCTRL, AUTODIRECTION | ACKENB); 600 } 601 602 /* read & write message */ 603 if (phase & BUSMON_IO) { 604 nsp_dbg(NSP_DEBUG_DATA_IO, "read msg"); 605 buf[ptr] = nsp_index_read(base, SCSIDATAWITHACK); 606 } else { 607 nsp_dbg(NSP_DEBUG_DATA_IO, "write msg"); 608 nsp_index_write(base, SCSIDATAWITHACK, buf[ptr]); 609 } 610 nsp_negate_signal(SCpnt, BUSMON_ACK, "xfer<ack>"); 611 612 } 613 return len; 614 } 615 616 /* 617 * get extra SCSI data from fifo 618 */ 619 static int nsp_dataphase_bypass(struct scsi_cmnd *SCpnt) 620 { 621 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 622 unsigned int count; 623 624 //nsp_dbg(NSP_DEBUG_DATA_IO, "in"); 625 626 if (SCpnt->SCp.have_data_in != IO_IN) { 627 return 0; 628 } 629 630 count = nsp_fifo_count(SCpnt); 631 if (data->FifoCount == count) { 632 //nsp_dbg(NSP_DEBUG_DATA_IO, "not use bypass quirk"); 633 return 0; 634 } 635 636 /* 637 * XXX: NSP_QUIRK 638 * data phase skip only occures in case of SCSI_LOW_READ 639 */ 640 nsp_dbg(NSP_DEBUG_DATA_IO, "use bypass quirk"); 641 SCpnt->SCp.phase = PH_DATA; 642 nsp_pio_read(SCpnt); 643 nsp_setup_fifo(data, FALSE); 644 645 return 0; 646 } 647 648 /* 649 * accept reselection 650 */ 651 static int nsp_reselected(struct scsi_cmnd *SCpnt) 652 { 653 unsigned int base = SCpnt->device->host->io_port; 654 unsigned int host_id = SCpnt->device->host->this_id; 655 //nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 656 unsigned char bus_reg; 657 unsigned char id_reg, tmp; 658 int target; 659 660 nsp_dbg(NSP_DEBUG_RESELECTION, "in"); 661 662 id_reg = nsp_index_read(base, RESELECTID); 663 tmp = id_reg & (~BIT(host_id)); 664 target = 0; 665 while(tmp != 0) { 666 if (tmp & BIT(0)) { 667 break; 668 } 669 tmp >>= 1; 670 target++; 671 } 672 673 if (scmd_id(SCpnt) != target) { 674 nsp_msg(KERN_ERR, "XXX: reselect ID must be %d in this implementation.", target); 675 } 676 677 nsp_negate_signal(SCpnt, BUSMON_SEL, "reselect<SEL>"); 678 679 nsp_nexus(SCpnt); 680 bus_reg = nsp_index_read(base, SCSIBUSCTRL) & ~(SCSI_BSY | SCSI_ATN); 681 nsp_index_write(base, SCSIBUSCTRL, bus_reg); 682 nsp_index_write(base, SCSIBUSCTRL, bus_reg | AUTODIRECTION | ACKENB); 683 684 return TRUE; 685 } 686 687 /* 688 * count how many data transferd 689 */ 690 static int nsp_fifo_count(struct scsi_cmnd *SCpnt) 691 { 692 unsigned int base = SCpnt->device->host->io_port; 693 unsigned int count; 694 unsigned int l, m, h, dummy; 695 696 nsp_index_write(base, POINTERCLR, POINTER_CLEAR | ACK_COUNTER); 697 698 l = nsp_index_read(base, TRANSFERCOUNT); 699 m = nsp_index_read(base, TRANSFERCOUNT); 700 h = nsp_index_read(base, TRANSFERCOUNT); 701 dummy = nsp_index_read(base, TRANSFERCOUNT); /* required this! */ 702 703 count = (h << 16) | (m << 8) | (l << 0); 704 705 //nsp_dbg(NSP_DEBUG_DATA_IO, "count=0x%x", count); 706 707 return count; 708 } 709 710 /* fifo size */ 711 #define RFIFO_CRIT 64 712 #define WFIFO_CRIT 64 713 714 /* 715 * read data in DATA IN phase 716 */ 717 static void nsp_pio_read(struct scsi_cmnd *SCpnt) 718 { 719 unsigned int base = SCpnt->device->host->io_port; 720 unsigned long mmio_base = SCpnt->device->host->base; 721 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 722 long time_out; 723 int ocount, res; 724 unsigned char stat, fifo_stat; 725 726 ocount = data->FifoCount; 727 728 nsp_dbg(NSP_DEBUG_DATA_IO, "in SCpnt=0x%p resid=%d ocount=%d ptr=0x%p this_residual=%d buffers=0x%p nbuf=%d", 729 SCpnt, scsi_get_resid(SCpnt), ocount, SCpnt->SCp.ptr, 730 SCpnt->SCp.this_residual, SCpnt->SCp.buffer, 731 SCpnt->SCp.buffers_residual); 732 733 time_out = 1000; 734 735 while ((time_out-- != 0) && 736 (SCpnt->SCp.this_residual > 0 || SCpnt->SCp.buffers_residual > 0 ) ) { 737 738 stat = nsp_index_read(base, SCSIBUSMON); 739 stat &= BUSMON_PHASE_MASK; 740 741 742 res = nsp_fifo_count(SCpnt) - ocount; 743 //nsp_dbg(NSP_DEBUG_DATA_IO, "ptr=0x%p this=0x%x ocount=0x%x res=0x%x", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, ocount, res); 744 if (res == 0) { /* if some data available ? */ 745 if (stat == BUSPHASE_DATA_IN) { /* phase changed? */ 746 //nsp_dbg(NSP_DEBUG_DATA_IO, " wait for data this=%d", SCpnt->SCp.this_residual); 747 continue; 748 } else { 749 nsp_dbg(NSP_DEBUG_DATA_IO, "phase changed stat=0x%x", stat); 750 break; 751 } 752 } 753 754 fifo_stat = nsp_read(base, FIFOSTATUS); 755 if ((fifo_stat & FIFOSTATUS_FULL_EMPTY) == 0 && 756 stat == BUSPHASE_DATA_IN) { 757 continue; 758 } 759 760 res = min(res, SCpnt->SCp.this_residual); 761 762 switch (data->TransferMode) { 763 case MODE_IO32: 764 res &= ~(BIT(1)|BIT(0)); /* align 4 */ 765 nsp_fifo32_read(base, SCpnt->SCp.ptr, res >> 2); 766 break; 767 case MODE_IO8: 768 nsp_fifo8_read (base, SCpnt->SCp.ptr, res ); 769 break; 770 771 case MODE_MEM32: 772 res &= ~(BIT(1)|BIT(0)); /* align 4 */ 773 nsp_mmio_fifo32_read(mmio_base, SCpnt->SCp.ptr, res >> 2); 774 break; 775 776 default: 777 nsp_dbg(NSP_DEBUG_DATA_IO, "unknown read mode"); 778 return; 779 } 780 781 nsp_inc_resid(SCpnt, -res); 782 SCpnt->SCp.ptr += res; 783 SCpnt->SCp.this_residual -= res; 784 ocount += res; 785 //nsp_dbg(NSP_DEBUG_DATA_IO, "ptr=0x%p this_residual=0x%x ocount=0x%x", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, ocount); 786 787 /* go to next scatter list if available */ 788 if (SCpnt->SCp.this_residual == 0 && 789 SCpnt->SCp.buffers_residual != 0 ) { 790 //nsp_dbg(NSP_DEBUG_DATA_IO, "scatterlist next timeout=%d", time_out); 791 SCpnt->SCp.buffers_residual--; 792 SCpnt->SCp.buffer++; 793 SCpnt->SCp.ptr = BUFFER_ADDR; 794 SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length; 795 time_out = 1000; 796 797 //nsp_dbg(NSP_DEBUG_DATA_IO, "page: 0x%p, off: 0x%x", SCpnt->SCp.buffer->page, SCpnt->SCp.buffer->offset); 798 } 799 } 800 801 data->FifoCount = ocount; 802 803 if (time_out < 0) { 804 nsp_msg(KERN_DEBUG, "pio read timeout resid=%d this_residual=%d buffers_residual=%d", 805 scsi_get_resid(SCpnt), SCpnt->SCp.this_residual, 806 SCpnt->SCp.buffers_residual); 807 } 808 nsp_dbg(NSP_DEBUG_DATA_IO, "read ocount=0x%x", ocount); 809 nsp_dbg(NSP_DEBUG_DATA_IO, "r cmd=%d resid=0x%x\n", data->CmdId, 810 scsi_get_resid(SCpnt)); 811 } 812 813 /* 814 * write data in DATA OUT phase 815 */ 816 static void nsp_pio_write(struct scsi_cmnd *SCpnt) 817 { 818 unsigned int base = SCpnt->device->host->io_port; 819 unsigned long mmio_base = SCpnt->device->host->base; 820 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 821 int time_out; 822 int ocount, res; 823 unsigned char stat; 824 825 ocount = data->FifoCount; 826 827 nsp_dbg(NSP_DEBUG_DATA_IO, "in fifocount=%d ptr=0x%p this_residual=%d buffers=0x%p nbuf=%d resid=0x%x", 828 data->FifoCount, SCpnt->SCp.ptr, SCpnt->SCp.this_residual, 829 SCpnt->SCp.buffer, SCpnt->SCp.buffers_residual, 830 scsi_get_resid(SCpnt)); 831 832 time_out = 1000; 833 834 while ((time_out-- != 0) && 835 (SCpnt->SCp.this_residual > 0 || SCpnt->SCp.buffers_residual > 0)) { 836 stat = nsp_index_read(base, SCSIBUSMON); 837 stat &= BUSMON_PHASE_MASK; 838 839 if (stat != BUSPHASE_DATA_OUT) { 840 res = ocount - nsp_fifo_count(SCpnt); 841 842 nsp_dbg(NSP_DEBUG_DATA_IO, "phase changed stat=0x%x, res=%d\n", stat, res); 843 /* Put back pointer */ 844 nsp_inc_resid(SCpnt, res); 845 SCpnt->SCp.ptr -= res; 846 SCpnt->SCp.this_residual += res; 847 ocount -= res; 848 849 break; 850 } 851 852 res = ocount - nsp_fifo_count(SCpnt); 853 if (res > 0) { /* write all data? */ 854 nsp_dbg(NSP_DEBUG_DATA_IO, "wait for all data out. ocount=0x%x res=%d", ocount, res); 855 continue; 856 } 857 858 res = min(SCpnt->SCp.this_residual, WFIFO_CRIT); 859 860 //nsp_dbg(NSP_DEBUG_DATA_IO, "ptr=0x%p this=0x%x res=0x%x", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, res); 861 switch (data->TransferMode) { 862 case MODE_IO32: 863 res &= ~(BIT(1)|BIT(0)); /* align 4 */ 864 nsp_fifo32_write(base, SCpnt->SCp.ptr, res >> 2); 865 break; 866 case MODE_IO8: 867 nsp_fifo8_write (base, SCpnt->SCp.ptr, res ); 868 break; 869 870 case MODE_MEM32: 871 res &= ~(BIT(1)|BIT(0)); /* align 4 */ 872 nsp_mmio_fifo32_write(mmio_base, SCpnt->SCp.ptr, res >> 2); 873 break; 874 875 default: 876 nsp_dbg(NSP_DEBUG_DATA_IO, "unknown write mode"); 877 break; 878 } 879 880 nsp_inc_resid(SCpnt, -res); 881 SCpnt->SCp.ptr += res; 882 SCpnt->SCp.this_residual -= res; 883 ocount += res; 884 885 /* go to next scatter list if available */ 886 if (SCpnt->SCp.this_residual == 0 && 887 SCpnt->SCp.buffers_residual != 0 ) { 888 //nsp_dbg(NSP_DEBUG_DATA_IO, "scatterlist next"); 889 SCpnt->SCp.buffers_residual--; 890 SCpnt->SCp.buffer++; 891 SCpnt->SCp.ptr = BUFFER_ADDR; 892 SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length; 893 time_out = 1000; 894 } 895 } 896 897 data->FifoCount = ocount; 898 899 if (time_out < 0) { 900 nsp_msg(KERN_DEBUG, "pio write timeout resid=0x%x", 901 scsi_get_resid(SCpnt)); 902 } 903 nsp_dbg(NSP_DEBUG_DATA_IO, "write ocount=0x%x", ocount); 904 nsp_dbg(NSP_DEBUG_DATA_IO, "w cmd=%d resid=0x%x\n", data->CmdId, 905 scsi_get_resid(SCpnt)); 906 } 907 #undef RFIFO_CRIT 908 #undef WFIFO_CRIT 909 910 /* 911 * setup synchronous/asynchronous data transfer mode 912 */ 913 static int nsp_nexus(struct scsi_cmnd *SCpnt) 914 { 915 unsigned int base = SCpnt->device->host->io_port; 916 unsigned char target = scmd_id(SCpnt); 917 // unsigned char lun = SCpnt->device->lun; 918 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 919 sync_data *sync = &(data->Sync[target]); 920 921 //nsp_dbg(NSP_DEBUG_DATA_IO, "in SCpnt=0x%p", SCpnt); 922 923 /* setup synch transfer registers */ 924 nsp_index_write(base, SYNCREG, sync->SyncRegister); 925 nsp_index_write(base, ACKWIDTH, sync->AckWidth); 926 927 if (scsi_get_resid(SCpnt) % 4 != 0 || 928 scsi_get_resid(SCpnt) <= PAGE_SIZE ) { 929 data->TransferMode = MODE_IO8; 930 } else if (nsp_burst_mode == BURST_MEM32) { 931 data->TransferMode = MODE_MEM32; 932 } else if (nsp_burst_mode == BURST_IO32) { 933 data->TransferMode = MODE_IO32; 934 } else { 935 data->TransferMode = MODE_IO8; 936 } 937 938 /* setup pdma fifo */ 939 nsp_setup_fifo(data, TRUE); 940 941 /* clear ack counter */ 942 data->FifoCount = 0; 943 nsp_index_write(base, POINTERCLR, POINTER_CLEAR | 944 ACK_COUNTER_CLEAR | 945 REQ_COUNTER_CLEAR | 946 HOST_COUNTER_CLEAR); 947 948 return 0; 949 } 950 951 #include "nsp_message.c" 952 /* 953 * interrupt handler 954 */ 955 static irqreturn_t nspintr(int irq, void *dev_id) 956 { 957 unsigned int base; 958 unsigned char irq_status, irq_phase, phase; 959 struct scsi_cmnd *tmpSC; 960 unsigned char target, lun; 961 unsigned int *sync_neg; 962 int i, tmp; 963 nsp_hw_data *data; 964 965 966 //nsp_dbg(NSP_DEBUG_INTR, "dev_id=0x%p", dev_id); 967 //nsp_dbg(NSP_DEBUG_INTR, "host=0x%p", ((scsi_info_t *)dev_id)->host); 968 969 if ( dev_id != NULL && 970 ((scsi_info_t *)dev_id)->host != NULL ) { 971 scsi_info_t *info = (scsi_info_t *)dev_id; 972 973 data = (nsp_hw_data *)info->host->hostdata; 974 } else { 975 nsp_dbg(NSP_DEBUG_INTR, "host data wrong"); 976 return IRQ_NONE; 977 } 978 979 //nsp_dbg(NSP_DEBUG_INTR, "&nsp_data_base=0x%p, dev_id=0x%p", &nsp_data_base, dev_id); 980 981 base = data->BaseAddress; 982 //nsp_dbg(NSP_DEBUG_INTR, "base=0x%x", base); 983 984 /* 985 * interrupt check 986 */ 987 nsp_write(base, IRQCONTROL, IRQCONTROL_IRQDISABLE); 988 irq_status = nsp_read(base, IRQSTATUS); 989 //nsp_dbg(NSP_DEBUG_INTR, "irq_status=0x%x", irq_status); 990 if ((irq_status == 0xff) || ((irq_status & IRQSTATUS_MASK) == 0)) { 991 nsp_write(base, IRQCONTROL, 0); 992 //nsp_dbg(NSP_DEBUG_INTR, "no irq/shared irq"); 993 return IRQ_NONE; 994 } 995 996 /* XXX: IMPORTANT 997 * Do not read an irq_phase register if no scsi phase interrupt. 998 * Unless, you should lose a scsi phase interrupt. 999 */ 1000 phase = nsp_index_read(base, SCSIBUSMON); 1001 if((irq_status & IRQSTATUS_SCSI) != 0) { 1002 irq_phase = nsp_index_read(base, IRQPHASESENCE); 1003 } else { 1004 irq_phase = 0; 1005 } 1006 1007 //nsp_dbg(NSP_DEBUG_INTR, "irq_phase=0x%x", irq_phase); 1008 1009 /* 1010 * timer interrupt handler (scsi vs timer interrupts) 1011 */ 1012 //nsp_dbg(NSP_DEBUG_INTR, "timercount=%d", data->TimerCount); 1013 if (data->TimerCount != 0) { 1014 //nsp_dbg(NSP_DEBUG_INTR, "stop timer"); 1015 nsp_index_write(base, TIMERCOUNT, 0); 1016 nsp_index_write(base, TIMERCOUNT, 0); 1017 data->TimerCount = 0; 1018 } 1019 1020 if ((irq_status & IRQSTATUS_MASK) == IRQSTATUS_TIMER && 1021 data->SelectionTimeOut == 0) { 1022 //nsp_dbg(NSP_DEBUG_INTR, "timer start"); 1023 nsp_write(base, IRQCONTROL, IRQCONTROL_TIMER_CLEAR); 1024 return IRQ_HANDLED; 1025 } 1026 1027 nsp_write(base, IRQCONTROL, IRQCONTROL_TIMER_CLEAR | IRQCONTROL_FIFO_CLEAR); 1028 1029 if ((irq_status & IRQSTATUS_SCSI) && 1030 (irq_phase & SCSI_RESET_IRQ)) { 1031 nsp_msg(KERN_ERR, "bus reset (power off?)"); 1032 1033 nsphw_init(data); 1034 nsp_bus_reset(data); 1035 1036 if(data->CurrentSC != NULL) { 1037 tmpSC = data->CurrentSC; 1038 tmpSC->result = (DID_RESET << 16) | 1039 ((tmpSC->SCp.Message & 0xff) << 8) | 1040 ((tmpSC->SCp.Status & 0xff) << 0); 1041 nsp_scsi_done(tmpSC); 1042 } 1043 return IRQ_HANDLED; 1044 } 1045 1046 if (data->CurrentSC == NULL) { 1047 nsp_msg(KERN_ERR, "CurrentSC==NULL irq_status=0x%x phase=0x%x irq_phase=0x%x this can't be happen. reset everything", irq_status, phase, irq_phase); 1048 nsphw_init(data); 1049 nsp_bus_reset(data); 1050 return IRQ_HANDLED; 1051 } 1052 1053 tmpSC = data->CurrentSC; 1054 target = tmpSC->device->id; 1055 lun = tmpSC->device->lun; 1056 sync_neg = &(data->Sync[target].SyncNegotiation); 1057 1058 /* 1059 * parse hardware SCSI irq reasons register 1060 */ 1061 if (irq_status & IRQSTATUS_SCSI) { 1062 if (irq_phase & RESELECT_IRQ) { 1063 nsp_dbg(NSP_DEBUG_INTR, "reselect"); 1064 nsp_write(base, IRQCONTROL, IRQCONTROL_RESELECT_CLEAR); 1065 if (nsp_reselected(tmpSC) != FALSE) { 1066 return IRQ_HANDLED; 1067 } 1068 } 1069 1070 if ((irq_phase & (PHASE_CHANGE_IRQ | LATCHED_BUS_FREE)) == 0) { 1071 return IRQ_HANDLED; 1072 } 1073 } 1074 1075 //show_phase(tmpSC); 1076 1077 switch(tmpSC->SCp.phase) { 1078 case PH_SELSTART: 1079 // *sync_neg = SYNC_NOT_YET; 1080 if ((phase & BUSMON_BSY) == 0) { 1081 //nsp_dbg(NSP_DEBUG_INTR, "selection count=%d", data->SelectionTimeOut); 1082 if (data->SelectionTimeOut >= NSP_SELTIMEOUT) { 1083 nsp_dbg(NSP_DEBUG_INTR, "selection time out"); 1084 data->SelectionTimeOut = 0; 1085 nsp_index_write(base, SCSIBUSCTRL, 0); 1086 1087 tmpSC->result = DID_TIME_OUT << 16; 1088 nsp_scsi_done(tmpSC); 1089 1090 return IRQ_HANDLED; 1091 } 1092 data->SelectionTimeOut += 1; 1093 nsp_start_timer(tmpSC, 1000/51); 1094 return IRQ_HANDLED; 1095 } 1096 1097 /* attention assert */ 1098 //nsp_dbg(NSP_DEBUG_INTR, "attention assert"); 1099 data->SelectionTimeOut = 0; 1100 tmpSC->SCp.phase = PH_SELECTED; 1101 nsp_index_write(base, SCSIBUSCTRL, SCSI_ATN); 1102 udelay(1); 1103 nsp_index_write(base, SCSIBUSCTRL, SCSI_ATN | AUTODIRECTION | ACKENB); 1104 return IRQ_HANDLED; 1105 1106 break; 1107 1108 case PH_RESELECT: 1109 //nsp_dbg(NSP_DEBUG_INTR, "phase reselect"); 1110 // *sync_neg = SYNC_NOT_YET; 1111 if ((phase & BUSMON_PHASE_MASK) != BUSPHASE_MESSAGE_IN) { 1112 1113 tmpSC->result = DID_ABORT << 16; 1114 nsp_scsi_done(tmpSC); 1115 return IRQ_HANDLED; 1116 } 1117 /* fall thru */ 1118 default: 1119 if ((irq_status & (IRQSTATUS_SCSI | IRQSTATUS_FIFO)) == 0) { 1120 return IRQ_HANDLED; 1121 } 1122 break; 1123 } 1124 1125 /* 1126 * SCSI sequencer 1127 */ 1128 //nsp_dbg(NSP_DEBUG_INTR, "start scsi seq"); 1129 1130 /* normal disconnect */ 1131 if (((tmpSC->SCp.phase == PH_MSG_IN) || (tmpSC->SCp.phase == PH_MSG_OUT)) && 1132 (irq_phase & LATCHED_BUS_FREE) != 0 ) { 1133 nsp_dbg(NSP_DEBUG_INTR, "normal disconnect irq_status=0x%x, phase=0x%x, irq_phase=0x%x", irq_status, phase, irq_phase); 1134 1135 //*sync_neg = SYNC_NOT_YET; 1136 1137 if ((tmpSC->SCp.Message == MSG_COMMAND_COMPLETE)) { /* all command complete and return status */ 1138 tmpSC->result = (DID_OK << 16) | 1139 ((tmpSC->SCp.Message & 0xff) << 8) | 1140 ((tmpSC->SCp.Status & 0xff) << 0); 1141 nsp_dbg(NSP_DEBUG_INTR, "command complete result=0x%x", tmpSC->result); 1142 nsp_scsi_done(tmpSC); 1143 1144 return IRQ_HANDLED; 1145 } 1146 1147 return IRQ_HANDLED; 1148 } 1149 1150 1151 /* check unexpected bus free state */ 1152 if (phase == 0) { 1153 nsp_msg(KERN_DEBUG, "unexpected bus free. irq_status=0x%x, phase=0x%x, irq_phase=0x%x", irq_status, phase, irq_phase); 1154 1155 *sync_neg = SYNC_NG; 1156 tmpSC->result = DID_ERROR << 16; 1157 nsp_scsi_done(tmpSC); 1158 return IRQ_HANDLED; 1159 } 1160 1161 switch (phase & BUSMON_PHASE_MASK) { 1162 case BUSPHASE_COMMAND: 1163 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_COMMAND"); 1164 if ((phase & BUSMON_REQ) == 0) { 1165 nsp_dbg(NSP_DEBUG_INTR, "REQ == 0"); 1166 return IRQ_HANDLED; 1167 } 1168 1169 tmpSC->SCp.phase = PH_COMMAND; 1170 1171 nsp_nexus(tmpSC); 1172 1173 /* write scsi command */ 1174 nsp_dbg(NSP_DEBUG_INTR, "cmd_len=%d", tmpSC->cmd_len); 1175 nsp_index_write(base, COMMANDCTRL, CLEAR_COMMAND_POINTER); 1176 for (i = 0; i < tmpSC->cmd_len; i++) { 1177 nsp_index_write(base, COMMANDDATA, tmpSC->cmnd[i]); 1178 } 1179 nsp_index_write(base, COMMANDCTRL, CLEAR_COMMAND_POINTER | AUTO_COMMAND_GO); 1180 break; 1181 1182 case BUSPHASE_DATA_OUT: 1183 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_DATA_OUT"); 1184 1185 tmpSC->SCp.phase = PH_DATA; 1186 tmpSC->SCp.have_data_in = IO_OUT; 1187 1188 nsp_pio_write(tmpSC); 1189 1190 break; 1191 1192 case BUSPHASE_DATA_IN: 1193 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_DATA_IN"); 1194 1195 tmpSC->SCp.phase = PH_DATA; 1196 tmpSC->SCp.have_data_in = IO_IN; 1197 1198 nsp_pio_read(tmpSC); 1199 1200 break; 1201 1202 case BUSPHASE_STATUS: 1203 nsp_dataphase_bypass(tmpSC); 1204 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_STATUS"); 1205 1206 tmpSC->SCp.phase = PH_STATUS; 1207 1208 tmpSC->SCp.Status = nsp_index_read(base, SCSIDATAWITHACK); 1209 nsp_dbg(NSP_DEBUG_INTR, "message=0x%x status=0x%x", tmpSC->SCp.Message, tmpSC->SCp.Status); 1210 1211 break; 1212 1213 case BUSPHASE_MESSAGE_OUT: 1214 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_MESSAGE_OUT"); 1215 if ((phase & BUSMON_REQ) == 0) { 1216 goto timer_out; 1217 } 1218 1219 tmpSC->SCp.phase = PH_MSG_OUT; 1220 1221 //*sync_neg = SYNC_NOT_YET; 1222 1223 data->MsgLen = i = 0; 1224 data->MsgBuffer[i] = IDENTIFY(TRUE, lun); i++; 1225 1226 if (*sync_neg == SYNC_NOT_YET) { 1227 data->Sync[target].SyncPeriod = 0; 1228 data->Sync[target].SyncOffset = 0; 1229 1230 /**/ 1231 data->MsgBuffer[i] = MSG_EXTENDED; i++; 1232 data->MsgBuffer[i] = 3; i++; 1233 data->MsgBuffer[i] = MSG_EXT_SDTR; i++; 1234 data->MsgBuffer[i] = 0x0c; i++; 1235 data->MsgBuffer[i] = 15; i++; 1236 /**/ 1237 } 1238 data->MsgLen = i; 1239 1240 nsp_analyze_sdtr(tmpSC); 1241 show_message(data); 1242 nsp_message_out(tmpSC); 1243 break; 1244 1245 case BUSPHASE_MESSAGE_IN: 1246 nsp_dataphase_bypass(tmpSC); 1247 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_MESSAGE_IN"); 1248 if ((phase & BUSMON_REQ) == 0) { 1249 goto timer_out; 1250 } 1251 1252 tmpSC->SCp.phase = PH_MSG_IN; 1253 nsp_message_in(tmpSC); 1254 1255 /**/ 1256 if (*sync_neg == SYNC_NOT_YET) { 1257 //nsp_dbg(NSP_DEBUG_INTR, "sync target=%d,lun=%d",target,lun); 1258 1259 if (data->MsgLen >= 5 && 1260 data->MsgBuffer[0] == MSG_EXTENDED && 1261 data->MsgBuffer[1] == 3 && 1262 data->MsgBuffer[2] == MSG_EXT_SDTR ) { 1263 data->Sync[target].SyncPeriod = data->MsgBuffer[3]; 1264 data->Sync[target].SyncOffset = data->MsgBuffer[4]; 1265 //nsp_dbg(NSP_DEBUG_INTR, "sync ok, %d %d", data->MsgBuffer[3], data->MsgBuffer[4]); 1266 *sync_neg = SYNC_OK; 1267 } else { 1268 data->Sync[target].SyncPeriod = 0; 1269 data->Sync[target].SyncOffset = 0; 1270 *sync_neg = SYNC_NG; 1271 } 1272 nsp_analyze_sdtr(tmpSC); 1273 } 1274 /**/ 1275 1276 /* search last messeage byte */ 1277 tmp = -1; 1278 for (i = 0; i < data->MsgLen; i++) { 1279 tmp = data->MsgBuffer[i]; 1280 if (data->MsgBuffer[i] == MSG_EXTENDED) { 1281 i += (1 + data->MsgBuffer[i+1]); 1282 } 1283 } 1284 tmpSC->SCp.Message = tmp; 1285 1286 nsp_dbg(NSP_DEBUG_INTR, "message=0x%x len=%d", tmpSC->SCp.Message, data->MsgLen); 1287 show_message(data); 1288 1289 break; 1290 1291 case BUSPHASE_SELECT: 1292 default: 1293 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE other"); 1294 1295 break; 1296 } 1297 1298 //nsp_dbg(NSP_DEBUG_INTR, "out"); 1299 return IRQ_HANDLED; 1300 1301 timer_out: 1302 nsp_start_timer(tmpSC, 1000/102); 1303 return IRQ_HANDLED; 1304 } 1305 1306 #ifdef NSP_DEBUG 1307 #include "nsp_debug.c" 1308 #endif /* NSP_DEBUG */ 1309 1310 /*----------------------------------------------------------------*/ 1311 /* look for ninja3 card and init if found */ 1312 /*----------------------------------------------------------------*/ 1313 static struct Scsi_Host *nsp_detect(struct scsi_host_template *sht) 1314 { 1315 struct Scsi_Host *host; /* registered host structure */ 1316 nsp_hw_data *data_b = &nsp_data_base, *data; 1317 1318 nsp_dbg(NSP_DEBUG_INIT, "this_id=%d", sht->this_id); 1319 host = scsi_host_alloc(&nsp_driver_template, sizeof(nsp_hw_data)); 1320 if (host == NULL) { 1321 nsp_dbg(NSP_DEBUG_INIT, "host failed"); 1322 return NULL; 1323 } 1324 1325 memcpy(host->hostdata, data_b, sizeof(nsp_hw_data)); 1326 data = (nsp_hw_data *)host->hostdata; 1327 data->ScsiInfo->host = host; 1328 #ifdef NSP_DEBUG 1329 data->CmdId = 0; 1330 #endif 1331 1332 nsp_dbg(NSP_DEBUG_INIT, "irq=%d,%d", data_b->IrqNumber, ((nsp_hw_data *)host->hostdata)->IrqNumber); 1333 1334 host->unique_id = data->BaseAddress; 1335 host->io_port = data->BaseAddress; 1336 host->n_io_port = data->NumAddress; 1337 host->irq = data->IrqNumber; 1338 host->base = data->MmioAddress; 1339 1340 spin_lock_init(&(data->Lock)); 1341 1342 snprintf(data->nspinfo, 1343 sizeof(data->nspinfo), 1344 "NinjaSCSI-3/32Bi Driver $Revision: 1.23 $ IO:0x%04lx-0x%04lx MMIO(virt addr):0x%04lx IRQ:%02d", 1345 host->io_port, host->io_port + host->n_io_port - 1, 1346 host->base, 1347 host->irq); 1348 sht->name = data->nspinfo; 1349 1350 nsp_dbg(NSP_DEBUG_INIT, "end"); 1351 1352 1353 return host; /* detect done. */ 1354 } 1355 1356 /*----------------------------------------------------------------*/ 1357 /* return info string */ 1358 /*----------------------------------------------------------------*/ 1359 static const char *nsp_info(struct Scsi_Host *shpnt) 1360 { 1361 nsp_hw_data *data = (nsp_hw_data *)shpnt->hostdata; 1362 1363 return data->nspinfo; 1364 } 1365 1366 static int nsp_show_info(struct seq_file *m, struct Scsi_Host *host) 1367 { 1368 int id; 1369 int speed; 1370 unsigned long flags; 1371 nsp_hw_data *data; 1372 int hostno; 1373 1374 hostno = host->host_no; 1375 data = (nsp_hw_data *)host->hostdata; 1376 1377 seq_puts(m, "NinjaSCSI status\n\n" 1378 "Driver version: $Revision: 1.23 $\n"); 1379 seq_printf(m, "SCSI host No.: %d\n", hostno); 1380 seq_printf(m, "IRQ: %d\n", host->irq); 1381 seq_printf(m, "IO: 0x%lx-0x%lx\n", host->io_port, host->io_port + host->n_io_port - 1); 1382 seq_printf(m, "MMIO(virtual address): 0x%lx-0x%lx\n", host->base, host->base + data->MmioLength - 1); 1383 seq_printf(m, "sg_tablesize: %d\n", host->sg_tablesize); 1384 1385 seq_puts(m, "burst transfer mode: "); 1386 switch (nsp_burst_mode) { 1387 case BURST_IO8: 1388 seq_puts(m, "io8"); 1389 break; 1390 case BURST_IO32: 1391 seq_puts(m, "io32"); 1392 break; 1393 case BURST_MEM32: 1394 seq_puts(m, "mem32"); 1395 break; 1396 default: 1397 seq_puts(m, "???"); 1398 break; 1399 } 1400 seq_putc(m, '\n'); 1401 1402 1403 spin_lock_irqsave(&(data->Lock), flags); 1404 seq_printf(m, "CurrentSC: 0x%p\n\n", data->CurrentSC); 1405 spin_unlock_irqrestore(&(data->Lock), flags); 1406 1407 seq_puts(m, "SDTR status\n"); 1408 for(id = 0; id < ARRAY_SIZE(data->Sync); id++) { 1409 1410 seq_printf(m, "id %d: ", id); 1411 1412 if (id == host->this_id) { 1413 seq_puts(m, "----- NinjaSCSI-3 host adapter\n"); 1414 continue; 1415 } 1416 1417 switch(data->Sync[id].SyncNegotiation) { 1418 case SYNC_OK: 1419 seq_puts(m, " sync"); 1420 break; 1421 case SYNC_NG: 1422 seq_puts(m, "async"); 1423 break; 1424 case SYNC_NOT_YET: 1425 seq_puts(m, " none"); 1426 break; 1427 default: 1428 seq_puts(m, "?????"); 1429 break; 1430 } 1431 1432 if (data->Sync[id].SyncPeriod != 0) { 1433 speed = 1000000 / (data->Sync[id].SyncPeriod * 4); 1434 1435 seq_printf(m, " transfer %d.%dMB/s, offset %d", 1436 speed / 1000, 1437 speed % 1000, 1438 data->Sync[id].SyncOffset 1439 ); 1440 } 1441 seq_putc(m, '\n'); 1442 } 1443 return 0; 1444 } 1445 1446 /*---------------------------------------------------------------*/ 1447 /* error handler */ 1448 /*---------------------------------------------------------------*/ 1449 1450 /* 1451 static int nsp_eh_abort(struct scsi_cmnd *SCpnt) 1452 { 1453 nsp_dbg(NSP_DEBUG_BUSRESET, "SCpnt=0x%p", SCpnt); 1454 1455 return nsp_eh_bus_reset(SCpnt); 1456 }*/ 1457 1458 static int nsp_bus_reset(nsp_hw_data *data) 1459 { 1460 unsigned int base = data->BaseAddress; 1461 int i; 1462 1463 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLMASK); 1464 1465 nsp_index_write(base, SCSIBUSCTRL, SCSI_RST); 1466 mdelay(100); /* 100ms */ 1467 nsp_index_write(base, SCSIBUSCTRL, 0); 1468 for(i = 0; i < 5; i++) { 1469 nsp_index_read(base, IRQPHASESENCE); /* dummy read */ 1470 } 1471 1472 nsphw_init_sync(data); 1473 1474 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLCLEAR); 1475 1476 return SUCCESS; 1477 } 1478 1479 static int nsp_eh_bus_reset(struct scsi_cmnd *SCpnt) 1480 { 1481 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 1482 1483 nsp_dbg(NSP_DEBUG_BUSRESET, "SCpnt=0x%p", SCpnt); 1484 1485 return nsp_bus_reset(data); 1486 } 1487 1488 static int nsp_eh_host_reset(struct scsi_cmnd *SCpnt) 1489 { 1490 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata; 1491 1492 nsp_dbg(NSP_DEBUG_BUSRESET, "in"); 1493 1494 nsphw_init(data); 1495 1496 return SUCCESS; 1497 } 1498 1499 1500 /********************************************************************** 1501 PCMCIA functions 1502 **********************************************************************/ 1503 1504 static int nsp_cs_probe(struct pcmcia_device *link) 1505 { 1506 scsi_info_t *info; 1507 nsp_hw_data *data = &nsp_data_base; 1508 int ret; 1509 1510 nsp_dbg(NSP_DEBUG_INIT, "in"); 1511 1512 /* Create new SCSI device */ 1513 info = kzalloc(sizeof(*info), GFP_KERNEL); 1514 if (info == NULL) { return -ENOMEM; } 1515 info->p_dev = link; 1516 link->priv = info; 1517 data->ScsiInfo = info; 1518 1519 nsp_dbg(NSP_DEBUG_INIT, "info=0x%p", info); 1520 1521 ret = nsp_cs_config(link); 1522 1523 nsp_dbg(NSP_DEBUG_INIT, "link=0x%p", link); 1524 return ret; 1525 } /* nsp_cs_attach */ 1526 1527 1528 static void nsp_cs_detach(struct pcmcia_device *link) 1529 { 1530 nsp_dbg(NSP_DEBUG_INIT, "in, link=0x%p", link); 1531 1532 ((scsi_info_t *)link->priv)->stop = 1; 1533 nsp_cs_release(link); 1534 1535 kfree(link->priv); 1536 link->priv = NULL; 1537 } /* nsp_cs_detach */ 1538 1539 1540 static int nsp_cs_config_check(struct pcmcia_device *p_dev, void *priv_data) 1541 { 1542 nsp_hw_data *data = priv_data; 1543 1544 if (p_dev->config_index == 0) 1545 return -ENODEV; 1546 1547 /* This reserves IO space but doesn't actually enable it */ 1548 if (pcmcia_request_io(p_dev) != 0) 1549 goto next_entry; 1550 1551 if (resource_size(p_dev->resource[2])) { 1552 p_dev->resource[2]->flags |= (WIN_DATA_WIDTH_16 | 1553 WIN_MEMORY_TYPE_CM | 1554 WIN_ENABLE); 1555 if (p_dev->resource[2]->end < 0x1000) 1556 p_dev->resource[2]->end = 0x1000; 1557 if (pcmcia_request_window(p_dev, p_dev->resource[2], 0) != 0) 1558 goto next_entry; 1559 if (pcmcia_map_mem_page(p_dev, p_dev->resource[2], 1560 p_dev->card_addr) != 0) 1561 goto next_entry; 1562 1563 data->MmioAddress = (unsigned long) 1564 ioremap_nocache(p_dev->resource[2]->start, 1565 resource_size(p_dev->resource[2])); 1566 data->MmioLength = resource_size(p_dev->resource[2]); 1567 } 1568 /* If we got this far, we're cool! */ 1569 return 0; 1570 1571 next_entry: 1572 nsp_dbg(NSP_DEBUG_INIT, "next"); 1573 pcmcia_disable_device(p_dev); 1574 return -ENODEV; 1575 } 1576 1577 static int nsp_cs_config(struct pcmcia_device *link) 1578 { 1579 int ret; 1580 scsi_info_t *info = link->priv; 1581 struct Scsi_Host *host; 1582 nsp_hw_data *data = &nsp_data_base; 1583 1584 nsp_dbg(NSP_DEBUG_INIT, "in"); 1585 1586 link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_CHECK_VCC | 1587 CONF_AUTO_SET_VPP | CONF_AUTO_AUDIO | CONF_AUTO_SET_IOMEM | 1588 CONF_AUTO_SET_IO; 1589 1590 ret = pcmcia_loop_config(link, nsp_cs_config_check, data); 1591 if (ret) 1592 goto cs_failed; 1593 1594 if (pcmcia_request_irq(link, nspintr)) 1595 goto cs_failed; 1596 1597 ret = pcmcia_enable_device(link); 1598 if (ret) 1599 goto cs_failed; 1600 1601 if (free_ports) { 1602 if (link->resource[0]) { 1603 release_region(link->resource[0]->start, 1604 resource_size(link->resource[0])); 1605 } 1606 if (link->resource[1]) { 1607 release_region(link->resource[1]->start, 1608 resource_size(link->resource[1])); 1609 } 1610 } 1611 1612 /* Set port and IRQ */ 1613 data->BaseAddress = link->resource[0]->start; 1614 data->NumAddress = resource_size(link->resource[0]); 1615 data->IrqNumber = link->irq; 1616 1617 nsp_dbg(NSP_DEBUG_INIT, "I/O[0x%x+0x%x] IRQ %d", 1618 data->BaseAddress, data->NumAddress, data->IrqNumber); 1619 1620 if(nsphw_init(data) == FALSE) { 1621 goto cs_failed; 1622 } 1623 1624 host = nsp_detect(&nsp_driver_template); 1625 1626 if (host == NULL) { 1627 nsp_dbg(NSP_DEBUG_INIT, "detect failed"); 1628 goto cs_failed; 1629 } 1630 1631 1632 ret = scsi_add_host (host, NULL); 1633 if (ret) 1634 goto cs_failed; 1635 1636 scsi_scan_host(host); 1637 1638 info->host = host; 1639 1640 return 0; 1641 1642 cs_failed: 1643 nsp_dbg(NSP_DEBUG_INIT, "config fail"); 1644 nsp_cs_release(link); 1645 1646 return -ENODEV; 1647 } /* nsp_cs_config */ 1648 1649 1650 static void nsp_cs_release(struct pcmcia_device *link) 1651 { 1652 scsi_info_t *info = link->priv; 1653 nsp_hw_data *data = NULL; 1654 1655 if (info->host == NULL) { 1656 nsp_msg(KERN_DEBUG, "unexpected card release call."); 1657 } else { 1658 data = (nsp_hw_data *)info->host->hostdata; 1659 } 1660 1661 nsp_dbg(NSP_DEBUG_INIT, "link=0x%p", link); 1662 1663 /* Unlink the device chain */ 1664 if (info->host != NULL) { 1665 scsi_remove_host(info->host); 1666 } 1667 1668 if (resource_size(link->resource[2])) { 1669 if (data != NULL) { 1670 iounmap((void *)(data->MmioAddress)); 1671 } 1672 } 1673 pcmcia_disable_device(link); 1674 1675 if (info->host != NULL) { 1676 scsi_host_put(info->host); 1677 } 1678 } /* nsp_cs_release */ 1679 1680 static int nsp_cs_suspend(struct pcmcia_device *link) 1681 { 1682 scsi_info_t *info = link->priv; 1683 nsp_hw_data *data; 1684 1685 nsp_dbg(NSP_DEBUG_INIT, "event: suspend"); 1686 1687 if (info->host != NULL) { 1688 nsp_msg(KERN_INFO, "clear SDTR status"); 1689 1690 data = (nsp_hw_data *)info->host->hostdata; 1691 1692 nsphw_init_sync(data); 1693 } 1694 1695 info->stop = 1; 1696 1697 return 0; 1698 } 1699 1700 static int nsp_cs_resume(struct pcmcia_device *link) 1701 { 1702 scsi_info_t *info = link->priv; 1703 nsp_hw_data *data; 1704 1705 nsp_dbg(NSP_DEBUG_INIT, "event: resume"); 1706 1707 info->stop = 0; 1708 1709 if (info->host != NULL) { 1710 nsp_msg(KERN_INFO, "reset host and bus"); 1711 1712 data = (nsp_hw_data *)info->host->hostdata; 1713 1714 nsphw_init (data); 1715 nsp_bus_reset(data); 1716 } 1717 1718 return 0; 1719 } 1720 1721 /*======================================================================* 1722 * module entry point 1723 *====================================================================*/ 1724 static const struct pcmcia_device_id nsp_cs_ids[] = { 1725 PCMCIA_DEVICE_PROD_ID123("IO DATA", "CBSC16 ", "1", 0x547e66dc, 0x0d63a3fd, 0x51de003a), 1726 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-001", "1", 0x534c02bc, 0x52008408, 0x51de003a), 1727 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-002", "1", 0x534c02bc, 0xcb09d5b2, 0x51de003a), 1728 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-003", "1", 0x534c02bc, 0xbc0ee524, 0x51de003a), 1729 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-004", "1", 0x534c02bc, 0x226a7087, 0x51de003a), 1730 PCMCIA_DEVICE_PROD_ID123("WBT", "NinjaSCSI-3", "R1.0", 0xc7ba805f, 0xfdc7c97d, 0x6973710e), 1731 PCMCIA_DEVICE_PROD_ID123("WORKBIT", "UltraNinja-16", "1", 0x28191418, 0xb70f4b09, 0x51de003a), 1732 PCMCIA_DEVICE_NULL 1733 }; 1734 MODULE_DEVICE_TABLE(pcmcia, nsp_cs_ids); 1735 1736 static struct pcmcia_driver nsp_driver = { 1737 .owner = THIS_MODULE, 1738 .name = "nsp_cs", 1739 .probe = nsp_cs_probe, 1740 .remove = nsp_cs_detach, 1741 .id_table = nsp_cs_ids, 1742 .suspend = nsp_cs_suspend, 1743 .resume = nsp_cs_resume, 1744 }; 1745 1746 static int __init nsp_cs_init(void) 1747 { 1748 return pcmcia_register_driver(&nsp_driver); 1749 } 1750 1751 static void __exit nsp_cs_exit(void) 1752 { 1753 pcmcia_unregister_driver(&nsp_driver); 1754 } 1755 1756 1757 module_init(nsp_cs_init) 1758 module_exit(nsp_cs_exit) 1759 1760 /* end */ 1761