[PATCH] W1: w1_netlink: New init/fini netlink callbacks.
[linux-2.6/verdex.git] / drivers / scsi / pcmcia / nsp_cs.c
blob3cd3b40b1a4c154ab7df9ca9b6dd86cbbe101fe8
1 /*======================================================================
3 NinjaSCSI-3 / NinjaSCSI-32Bi PCMCIA SCSI host adapter card driver
4 By: YOKOTA Hiroshi <yokota@netlab.is.tsukuba.ac.jp>
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
13 This software may be used and distributed according to the terms of
14 the GNU General Public License.
16 ======================================================================*/
18 /***********************************************************************
19 This driver is for these PCcards.
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"
26 ***********************************************************************/
28 /* $Id: nsp_cs.c,v 1.23 2003/08/18 11:09:19 elca Exp $ */
30 #include <linux/version.h>
31 #include <linux/module.h>
32 #include <linux/kernel.h>
33 #include <linux/init.h>
34 #include <linux/sched.h>
35 #include <linux/slab.h>
36 #include <linux/string.h>
37 #include <linux/timer.h>
38 #include <linux/ioport.h>
39 #include <linux/delay.h>
40 #include <linux/interrupt.h>
41 #include <linux/major.h>
42 #include <linux/blkdev.h>
43 #include <linux/stat.h>
45 #include <asm/io.h>
46 #include <asm/irq.h>
48 #include <../drivers/scsi/scsi.h>
49 #include <scsi/scsi_host.h>
51 #include <scsi/scsi.h>
52 #include <scsi/scsi_ioctl.h>
54 #include <pcmcia/cs_types.h>
55 #include <pcmcia/cs.h>
56 #include <pcmcia/cistpl.h>
57 #include <pcmcia/cisreg.h>
58 #include <pcmcia/ds.h>
60 #include "nsp_cs.h"
62 MODULE_AUTHOR("YOKOTA Hiroshi <yokota@netlab.is.tsukuba.ac.jp>");
63 MODULE_DESCRIPTION("WorkBit NinjaSCSI-3 / NinjaSCSI-32Bi(16bit) PCMCIA SCSI host adapter module $Revision: 1.23 $");
64 MODULE_SUPPORTED_DEVICE("sd,sr,sg,st");
65 #ifdef MODULE_LICENSE
66 MODULE_LICENSE("GPL");
67 #endif
69 #include "nsp_io.h"
71 /*====================================================================*/
72 /* Parameters that can be set with 'insmod' */
74 static int nsp_burst_mode = BURST_MEM32;
75 module_param(nsp_burst_mode, int, 0);
76 MODULE_PARM_DESC(nsp_burst_mode, "Burst transfer mode (0=io8, 1=io32, 2=mem32(default))");
78 /* Release IO ports after configuration? */
79 static int free_ports = 0;
80 module_param(free_ports, bool, 0);
81 MODULE_PARM_DESC(free_ports, "Release IO ports after configuration? (default: 0 (=no))");
83 /* /usr/src/linux/drivers/scsi/hosts.h */
84 static Scsi_Host_Template nsp_driver_template = {
85 .proc_name = "nsp_cs",
86 .proc_info = nsp_proc_info,
87 .name = "WorkBit NinjaSCSI-3/32Bi(16bit)",
88 #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
89 .detect = nsp_detect_old,
90 .release = nsp_release_old,
91 #endif
92 .info = nsp_info,
93 .queuecommand = nsp_queuecommand,
94 /* .eh_abort_handler = nsp_eh_abort,*/
95 .eh_bus_reset_handler = nsp_eh_bus_reset,
96 .eh_host_reset_handler = nsp_eh_host_reset,
97 .can_queue = 1,
98 .this_id = NSP_INITIATOR_ID,
99 .sg_tablesize = SG_ALL,
100 .cmd_per_lun = 1,
101 .use_clustering = DISABLE_CLUSTERING,
102 #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,2))
103 .use_new_eh_code = 1,
104 #endif
107 static dev_link_t *dev_list = NULL;
108 static dev_info_t dev_info = {"nsp_cs"};
110 static nsp_hw_data nsp_data_base; /* attach <-> detect glue */
115 * debug, error print
117 #ifndef NSP_DEBUG
118 # define NSP_DEBUG_MASK 0x000000
119 # define nsp_msg(type, args...) nsp_cs_message("", 0, (type), args)
120 # define nsp_dbg(mask, args...) /* */
121 #else
122 # define NSP_DEBUG_MASK 0xffffff
123 # define nsp_msg(type, args...) \
124 nsp_cs_message (__FUNCTION__, __LINE__, (type), args)
125 # define nsp_dbg(mask, args...) \
126 nsp_cs_dmessage(__FUNCTION__, __LINE__, (mask), args)
127 #endif
129 #define NSP_DEBUG_QUEUECOMMAND BIT(0)
130 #define NSP_DEBUG_REGISTER BIT(1)
131 #define NSP_DEBUG_AUTOSCSI BIT(2)
132 #define NSP_DEBUG_INTR BIT(3)
133 #define NSP_DEBUG_SGLIST BIT(4)
134 #define NSP_DEBUG_BUSFREE BIT(5)
135 #define NSP_DEBUG_CDB_CONTENTS BIT(6)
136 #define NSP_DEBUG_RESELECTION BIT(7)
137 #define NSP_DEBUG_MSGINOCCUR BIT(8)
138 #define NSP_DEBUG_EEPROM BIT(9)
139 #define NSP_DEBUG_MSGOUTOCCUR BIT(10)
140 #define NSP_DEBUG_BUSRESET BIT(11)
141 #define NSP_DEBUG_RESTART BIT(12)
142 #define NSP_DEBUG_SYNC BIT(13)
143 #define NSP_DEBUG_WAIT BIT(14)
144 #define NSP_DEBUG_TARGETFLAG BIT(15)
145 #define NSP_DEBUG_PROC BIT(16)
146 #define NSP_DEBUG_INIT BIT(17)
147 #define NSP_DEBUG_DATA_IO BIT(18)
148 #define NSP_SPECIAL_PRINT_REGISTER BIT(20)
150 #define NSP_DEBUG_BUF_LEN 150
152 static void nsp_cs_message(const char *func, int line, char *type, char *fmt, ...)
154 va_list args;
155 char buf[NSP_DEBUG_BUF_LEN];
157 va_start(args, fmt);
158 vsnprintf(buf, sizeof(buf), fmt, args);
159 va_end(args);
161 #ifndef NSP_DEBUG
162 printk("%snsp_cs: %s\n", type, buf);
163 #else
164 printk("%snsp_cs: %s (%d): %s\n", type, func, line, buf);
165 #endif
168 #ifdef NSP_DEBUG
169 static void nsp_cs_dmessage(const char *func, int line, int mask, char *fmt, ...)
171 va_list args;
172 char buf[NSP_DEBUG_BUF_LEN];
174 va_start(args, fmt);
175 vsnprintf(buf, sizeof(buf), fmt, args);
176 va_end(args);
178 if (mask & NSP_DEBUG_MASK) {
179 printk("nsp_cs-debug: 0x%x %s (%d): %s\n", mask, func, line, buf);
182 #endif
184 /***********************************************************/
186 /*====================================================
187 * Clenaup parameters and call done() functions.
188 * You must be set SCpnt->result before call this function.
190 static void nsp_scsi_done(Scsi_Cmnd *SCpnt)
192 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
194 data->CurrentSC = NULL;
196 SCpnt->scsi_done(SCpnt);
199 static int nsp_queuecommand(Scsi_Cmnd *SCpnt, void (*done)(Scsi_Cmnd *))
201 #ifdef NSP_DEBUG
202 /*unsigned int host_id = SCpnt->device->host->this_id;*/
203 /*unsigned int base = SCpnt->device->host->io_port;*/
204 unsigned char target = SCpnt->device->id;
205 #endif
206 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
208 nsp_dbg(NSP_DEBUG_QUEUECOMMAND, "SCpnt=0x%p target=%d lun=%d buff=0x%p bufflen=%d use_sg=%d",
209 SCpnt, target, SCpnt->device->lun, SCpnt->request_buffer, SCpnt->request_bufflen, SCpnt->use_sg);
210 //nsp_dbg(NSP_DEBUG_QUEUECOMMAND, "before CurrentSC=0x%p", data->CurrentSC);
212 SCpnt->scsi_done = done;
214 if (data->CurrentSC != NULL) {
215 nsp_msg(KERN_DEBUG, "CurrentSC!=NULL this can't be happen");
216 SCpnt->result = DID_BAD_TARGET << 16;
217 nsp_scsi_done(SCpnt);
218 return 0;
221 #if 0
222 /* XXX: pcmcia-cs generates SCSI command with "scsi_info" utility.
223 This makes kernel crash when suspending... */
224 if (data->ScsiInfo->stop != 0) {
225 nsp_msg(KERN_INFO, "suspending device. reject command.");
226 SCpnt->result = DID_BAD_TARGET << 16;
227 nsp_scsi_done(SCpnt);
228 return SCSI_MLQUEUE_HOST_BUSY;
230 #endif
232 show_command(SCpnt);
234 data->CurrentSC = SCpnt;
236 SCpnt->SCp.Status = CHECK_CONDITION;
237 SCpnt->SCp.Message = 0;
238 SCpnt->SCp.have_data_in = IO_UNKNOWN;
239 SCpnt->SCp.sent_command = 0;
240 SCpnt->SCp.phase = PH_UNDETERMINED;
241 SCpnt->resid = SCpnt->request_bufflen;
243 /* setup scratch area
244 SCp.ptr : buffer pointer
245 SCp.this_residual : buffer length
246 SCp.buffer : next buffer
247 SCp.buffers_residual : left buffers in list
248 SCp.phase : current state of the command */
249 if (SCpnt->use_sg) {
250 SCpnt->SCp.buffer = (struct scatterlist *) SCpnt->request_buffer;
251 SCpnt->SCp.ptr = BUFFER_ADDR;
252 SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length;
253 SCpnt->SCp.buffers_residual = SCpnt->use_sg - 1;
254 } else {
255 SCpnt->SCp.ptr = (char *) SCpnt->request_buffer;
256 SCpnt->SCp.this_residual = SCpnt->request_bufflen;
257 SCpnt->SCp.buffer = NULL;
258 SCpnt->SCp.buffers_residual = 0;
261 if (nsphw_start_selection(SCpnt) == FALSE) {
262 nsp_dbg(NSP_DEBUG_QUEUECOMMAND, "selection fail");
263 SCpnt->result = DID_BUS_BUSY << 16;
264 nsp_scsi_done(SCpnt);
265 return 0;
269 //nsp_dbg(NSP_DEBUG_QUEUECOMMAND, "out");
270 #ifdef NSP_DEBUG
271 data->CmdId++;
272 #endif
273 return 0;
277 * setup PIO FIFO transfer mode and enable/disable to data out
279 static void nsp_setup_fifo(nsp_hw_data *data, int enabled)
281 unsigned int base = data->BaseAddress;
282 unsigned char transfer_mode_reg;
284 //nsp_dbg(NSP_DEBUG_DATA_IO, "enabled=%d", enabled);
286 if (enabled != FALSE) {
287 transfer_mode_reg = TRANSFER_GO | BRAIND;
288 } else {
289 transfer_mode_reg = 0;
292 transfer_mode_reg |= data->TransferMode;
294 nsp_index_write(base, TRANSFERMODE, transfer_mode_reg);
297 static void nsphw_init_sync(nsp_hw_data *data)
299 sync_data tmp_sync = { .SyncNegotiation = SYNC_NOT_YET,
300 .SyncPeriod = 0,
301 .SyncOffset = 0
303 int i;
305 /* setup sync data */
306 for ( i = 0; i < ARRAY_SIZE(data->Sync); i++ ) {
307 data->Sync[i] = tmp_sync;
312 * Initialize Ninja hardware
314 static int nsphw_init(nsp_hw_data *data)
316 unsigned int base = data->BaseAddress;
318 nsp_dbg(NSP_DEBUG_INIT, "in base=0x%x", base);
320 data->ScsiClockDiv = CLOCK_40M | FAST_20;
321 data->CurrentSC = NULL;
322 data->FifoCount = 0;
323 data->TransferMode = MODE_IO8;
325 nsphw_init_sync(data);
327 /* block all interrupts */
328 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLMASK);
330 /* setup SCSI interface */
331 nsp_write(base, IFSELECT, IF_IFSEL);
333 nsp_index_write(base, SCSIIRQMODE, 0);
335 nsp_index_write(base, TRANSFERMODE, MODE_IO8);
336 nsp_index_write(base, CLOCKDIV, data->ScsiClockDiv);
338 nsp_index_write(base, PARITYCTRL, 0);
339 nsp_index_write(base, POINTERCLR, POINTER_CLEAR |
340 ACK_COUNTER_CLEAR |
341 REQ_COUNTER_CLEAR |
342 HOST_COUNTER_CLEAR);
344 /* setup fifo asic */
345 nsp_write(base, IFSELECT, IF_REGSEL);
346 nsp_index_write(base, TERMPWRCTRL, 0);
347 if ((nsp_index_read(base, OTHERCONTROL) & TPWR_SENSE) == 0) {
348 nsp_msg(KERN_INFO, "terminator power on");
349 nsp_index_write(base, TERMPWRCTRL, POWER_ON);
352 nsp_index_write(base, TIMERCOUNT, 0);
353 nsp_index_write(base, TIMERCOUNT, 0); /* requires 2 times!! */
355 nsp_index_write(base, SYNCREG, 0);
356 nsp_index_write(base, ACKWIDTH, 0);
358 /* enable interrupts and ack them */
359 nsp_index_write(base, SCSIIRQMODE, SCSI_PHASE_CHANGE_EI |
360 RESELECT_EI |
361 SCSI_RESET_IRQ_EI );
362 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLCLEAR);
364 nsp_setup_fifo(data, FALSE);
366 return TRUE;
370 * Start selection phase
372 static int nsphw_start_selection(Scsi_Cmnd *SCpnt)
374 unsigned int host_id = SCpnt->device->host->this_id;
375 unsigned int base = SCpnt->device->host->io_port;
376 unsigned char target = SCpnt->device->id;
377 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
378 int time_out;
379 unsigned char phase, arbit;
381 //nsp_dbg(NSP_DEBUG_RESELECTION, "in");
383 phase = nsp_index_read(base, SCSIBUSMON);
384 if(phase != BUSMON_BUS_FREE) {
385 //nsp_dbg(NSP_DEBUG_RESELECTION, "bus busy");
386 return FALSE;
389 /* start arbitration */
390 //nsp_dbg(NSP_DEBUG_RESELECTION, "start arbit");
391 SCpnt->SCp.phase = PH_ARBSTART;
392 nsp_index_write(base, SETARBIT, ARBIT_GO);
394 time_out = 1000;
395 do {
396 /* XXX: what a stupid chip! */
397 arbit = nsp_index_read(base, ARBITSTATUS);
398 //nsp_dbg(NSP_DEBUG_RESELECTION, "arbit=%d, wait_count=%d", arbit, wait_count);
399 udelay(1); /* hold 1.2us */
400 } while((arbit & (ARBIT_WIN | ARBIT_FAIL)) == 0 &&
401 (time_out-- != 0));
403 if (!(arbit & ARBIT_WIN)) {
404 //nsp_dbg(NSP_DEBUG_RESELECTION, "arbit fail");
405 nsp_index_write(base, SETARBIT, ARBIT_FLAG_CLEAR);
406 return FALSE;
409 /* assert select line */
410 //nsp_dbg(NSP_DEBUG_RESELECTION, "assert SEL line");
411 SCpnt->SCp.phase = PH_SELSTART;
412 udelay(3); /* wait 2.4us */
413 nsp_index_write(base, SCSIDATALATCH, BIT(host_id) | BIT(target));
414 nsp_index_write(base, SCSIBUSCTRL, SCSI_SEL | SCSI_BSY | SCSI_ATN);
415 udelay(2); /* wait >1.2us */
416 nsp_index_write(base, SCSIBUSCTRL, SCSI_SEL | SCSI_BSY | SCSI_DATAOUT_ENB | SCSI_ATN);
417 nsp_index_write(base, SETARBIT, ARBIT_FLAG_CLEAR);
418 /*udelay(1);*/ /* wait >90ns */
419 nsp_index_write(base, SCSIBUSCTRL, SCSI_SEL | SCSI_DATAOUT_ENB | SCSI_ATN);
421 /* check selection timeout */
422 nsp_start_timer(SCpnt, 1000/51);
423 data->SelectionTimeOut = 1;
425 return TRUE;
428 struct nsp_sync_table {
429 unsigned int min_period;
430 unsigned int max_period;
431 unsigned int chip_period;
432 unsigned int ack_width;
435 static struct nsp_sync_table nsp_sync_table_40M[] = {
436 {0x0c, 0x0c, 0x1, 0}, /* 20MB 50ns*/
437 {0x19, 0x19, 0x3, 1}, /* 10MB 100ns*/
438 {0x1a, 0x25, 0x5, 2}, /* 7.5MB 150ns*/
439 {0x26, 0x32, 0x7, 3}, /* 5MB 200ns*/
440 { 0, 0, 0, 0},
443 static struct nsp_sync_table nsp_sync_table_20M[] = {
444 {0x19, 0x19, 0x1, 0}, /* 10MB 100ns*/
445 {0x1a, 0x25, 0x2, 0}, /* 7.5MB 150ns*/
446 {0x26, 0x32, 0x3, 1}, /* 5MB 200ns*/
447 { 0, 0, 0, 0},
451 * setup synchronous data transfer mode
453 static int nsp_analyze_sdtr(Scsi_Cmnd *SCpnt)
455 unsigned char target = SCpnt->device->id;
456 // unsigned char lun = SCpnt->device->lun;
457 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
458 sync_data *sync = &(data->Sync[target]);
459 struct nsp_sync_table *sync_table;
460 unsigned int period, offset;
461 int i;
464 nsp_dbg(NSP_DEBUG_SYNC, "in");
466 period = sync->SyncPeriod;
467 offset = sync->SyncOffset;
469 nsp_dbg(NSP_DEBUG_SYNC, "period=0x%x, offset=0x%x", period, offset);
471 if ((data->ScsiClockDiv & (BIT(0)|BIT(1))) == CLOCK_20M) {
472 sync_table = nsp_sync_table_20M;
473 } else {
474 sync_table = nsp_sync_table_40M;
477 for ( i = 0; sync_table->max_period != 0; i++, sync_table++) {
478 if ( period >= sync_table->min_period &&
479 period <= sync_table->max_period ) {
480 break;
484 if (period != 0 && sync_table->max_period == 0) {
486 * No proper period/offset found
488 nsp_dbg(NSP_DEBUG_SYNC, "no proper period/offset");
490 sync->SyncPeriod = 0;
491 sync->SyncOffset = 0;
492 sync->SyncRegister = 0;
493 sync->AckWidth = 0;
495 return FALSE;
498 sync->SyncRegister = (sync_table->chip_period << SYNCREG_PERIOD_SHIFT) |
499 (offset & SYNCREG_OFFSET_MASK);
500 sync->AckWidth = sync_table->ack_width;
502 nsp_dbg(NSP_DEBUG_SYNC, "sync_reg=0x%x, ack_width=0x%x", sync->SyncRegister, sync->AckWidth);
504 return TRUE;
509 * start ninja hardware timer
511 static void nsp_start_timer(Scsi_Cmnd *SCpnt, int time)
513 unsigned int base = SCpnt->device->host->io_port;
514 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
516 //nsp_dbg(NSP_DEBUG_INTR, "in SCpnt=0x%p, time=%d", SCpnt, time);
517 data->TimerCount = time;
518 nsp_index_write(base, TIMERCOUNT, time);
522 * wait for bus phase change
524 static int nsp_negate_signal(Scsi_Cmnd *SCpnt, unsigned char mask, char *str)
526 unsigned int base = SCpnt->device->host->io_port;
527 unsigned char reg;
528 int time_out;
530 //nsp_dbg(NSP_DEBUG_INTR, "in");
532 time_out = 100;
534 do {
535 reg = nsp_index_read(base, SCSIBUSMON);
536 if (reg == 0xff) {
537 break;
539 } while ((time_out-- != 0) && (reg & mask) != 0);
541 if (time_out == 0) {
542 nsp_msg(KERN_DEBUG, " %s signal off timeut", str);
545 return 0;
549 * expect Ninja Irq
551 static int nsp_expect_signal(Scsi_Cmnd *SCpnt,
552 unsigned char current_phase,
553 unsigned char mask)
555 unsigned int base = SCpnt->device->host->io_port;
556 int time_out;
557 unsigned char phase, i_src;
559 //nsp_dbg(NSP_DEBUG_INTR, "current_phase=0x%x, mask=0x%x", current_phase, mask);
561 time_out = 100;
562 do {
563 phase = nsp_index_read(base, SCSIBUSMON);
564 if (phase == 0xff) {
565 //nsp_dbg(NSP_DEBUG_INTR, "ret -1");
566 return -1;
568 i_src = nsp_read(base, IRQSTATUS);
569 if (i_src & IRQSTATUS_SCSI) {
570 //nsp_dbg(NSP_DEBUG_INTR, "ret 0 found scsi signal");
571 return 0;
573 if ((phase & mask) != 0 && (phase & BUSMON_PHASE_MASK) == current_phase) {
574 //nsp_dbg(NSP_DEBUG_INTR, "ret 1 phase=0x%x", phase);
575 return 1;
577 } while(time_out-- != 0);
579 //nsp_dbg(NSP_DEBUG_INTR, "timeout");
580 return -1;
584 * transfer SCSI message
586 static int nsp_xfer(Scsi_Cmnd *SCpnt, int phase)
588 unsigned int base = SCpnt->device->host->io_port;
589 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
590 char *buf = data->MsgBuffer;
591 int len = min(MSGBUF_SIZE, data->MsgLen);
592 int ptr;
593 int ret;
595 //nsp_dbg(NSP_DEBUG_DATA_IO, "in");
596 for (ptr = 0; len > 0; len--, ptr++) {
598 ret = nsp_expect_signal(SCpnt, phase, BUSMON_REQ);
599 if (ret <= 0) {
600 nsp_dbg(NSP_DEBUG_DATA_IO, "xfer quit");
601 return 0;
604 /* if last byte, negate ATN */
605 if (len == 1 && SCpnt->SCp.phase == PH_MSG_OUT) {
606 nsp_index_write(base, SCSIBUSCTRL, AUTODIRECTION | ACKENB);
609 /* read & write message */
610 if (phase & BUSMON_IO) {
611 nsp_dbg(NSP_DEBUG_DATA_IO, "read msg");
612 buf[ptr] = nsp_index_read(base, SCSIDATAWITHACK);
613 } else {
614 nsp_dbg(NSP_DEBUG_DATA_IO, "write msg");
615 nsp_index_write(base, SCSIDATAWITHACK, buf[ptr]);
617 nsp_negate_signal(SCpnt, BUSMON_ACK, "xfer<ack>");
620 return len;
624 * get extra SCSI data from fifo
626 static int nsp_dataphase_bypass(Scsi_Cmnd *SCpnt)
628 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
629 unsigned int count;
631 //nsp_dbg(NSP_DEBUG_DATA_IO, "in");
633 if (SCpnt->SCp.have_data_in != IO_IN) {
634 return 0;
637 count = nsp_fifo_count(SCpnt);
638 if (data->FifoCount == count) {
639 //nsp_dbg(NSP_DEBUG_DATA_IO, "not use bypass quirk");
640 return 0;
644 * XXX: NSP_QUIRK
645 * data phase skip only occures in case of SCSI_LOW_READ
647 nsp_dbg(NSP_DEBUG_DATA_IO, "use bypass quirk");
648 SCpnt->SCp.phase = PH_DATA;
649 nsp_pio_read(SCpnt);
650 nsp_setup_fifo(data, FALSE);
652 return 0;
656 * accept reselection
658 static int nsp_reselected(Scsi_Cmnd *SCpnt)
660 unsigned int base = SCpnt->device->host->io_port;
661 unsigned int host_id = SCpnt->device->host->this_id;
662 //nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
663 unsigned char bus_reg;
664 unsigned char id_reg, tmp;
665 int target;
667 nsp_dbg(NSP_DEBUG_RESELECTION, "in");
669 id_reg = nsp_index_read(base, RESELECTID);
670 tmp = id_reg & (~BIT(host_id));
671 target = 0;
672 while(tmp != 0) {
673 if (tmp & BIT(0)) {
674 break;
676 tmp >>= 1;
677 target++;
680 if (SCpnt->device->id != target) {
681 nsp_msg(KERN_ERR, "XXX: reselect ID must be %d in this implementation.", target);
684 nsp_negate_signal(SCpnt, BUSMON_SEL, "reselect<SEL>");
686 nsp_nexus(SCpnt);
687 bus_reg = nsp_index_read(base, SCSIBUSCTRL) & ~(SCSI_BSY | SCSI_ATN);
688 nsp_index_write(base, SCSIBUSCTRL, bus_reg);
689 nsp_index_write(base, SCSIBUSCTRL, bus_reg | AUTODIRECTION | ACKENB);
691 return TRUE;
695 * count how many data transferd
697 static int nsp_fifo_count(Scsi_Cmnd *SCpnt)
699 unsigned int base = SCpnt->device->host->io_port;
700 unsigned int count;
701 unsigned int l, m, h, dummy;
703 nsp_index_write(base, POINTERCLR, POINTER_CLEAR | ACK_COUNTER);
705 l = nsp_index_read(base, TRANSFERCOUNT);
706 m = nsp_index_read(base, TRANSFERCOUNT);
707 h = nsp_index_read(base, TRANSFERCOUNT);
708 dummy = nsp_index_read(base, TRANSFERCOUNT); /* required this! */
710 count = (h << 16) | (m << 8) | (l << 0);
712 //nsp_dbg(NSP_DEBUG_DATA_IO, "count=0x%x", count);
714 return count;
717 /* fifo size */
718 #define RFIFO_CRIT 64
719 #define WFIFO_CRIT 64
722 * read data in DATA IN phase
724 static void nsp_pio_read(Scsi_Cmnd *SCpnt)
726 unsigned int base = SCpnt->device->host->io_port;
727 unsigned long mmio_base = SCpnt->device->host->base;
728 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
729 long time_out;
730 int ocount, res;
731 unsigned char stat, fifo_stat;
733 ocount = data->FifoCount;
735 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",
736 SCpnt, SCpnt->resid, ocount, SCpnt->SCp.ptr, SCpnt->SCp.this_residual, SCpnt->SCp.buffer, SCpnt->SCp.buffers_residual);
738 time_out = 1000;
740 while ((time_out-- != 0) &&
741 (SCpnt->SCp.this_residual > 0 || SCpnt->SCp.buffers_residual > 0 ) ) {
743 stat = nsp_index_read(base, SCSIBUSMON);
744 stat &= BUSMON_PHASE_MASK;
747 res = nsp_fifo_count(SCpnt) - ocount;
748 //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);
749 if (res == 0) { /* if some data avilable ? */
750 if (stat == BUSPHASE_DATA_IN) { /* phase changed? */
751 //nsp_dbg(NSP_DEBUG_DATA_IO, " wait for data this=%d", SCpnt->SCp.this_residual);
752 continue;
753 } else {
754 nsp_dbg(NSP_DEBUG_DATA_IO, "phase changed stat=0x%x", stat);
755 break;
759 fifo_stat = nsp_read(base, FIFOSTATUS);
760 if ((fifo_stat & FIFOSTATUS_FULL_EMPTY) == 0 &&
761 stat == BUSPHASE_DATA_IN) {
762 continue;
765 res = min(res, SCpnt->SCp.this_residual);
767 switch (data->TransferMode) {
768 case MODE_IO32:
769 res &= ~(BIT(1)|BIT(0)); /* align 4 */
770 nsp_fifo32_read(base, SCpnt->SCp.ptr, res >> 2);
771 break;
772 case MODE_IO8:
773 nsp_fifo8_read (base, SCpnt->SCp.ptr, res );
774 break;
776 case MODE_MEM32:
777 res &= ~(BIT(1)|BIT(0)); /* align 4 */
778 nsp_mmio_fifo32_read(mmio_base, SCpnt->SCp.ptr, res >> 2);
779 break;
781 default:
782 nsp_dbg(NSP_DEBUG_DATA_IO, "unknown read mode");
783 return;
786 SCpnt->resid -= res;
787 SCpnt->SCp.ptr += res;
788 SCpnt->SCp.this_residual -= res;
789 ocount += res;
790 //nsp_dbg(NSP_DEBUG_DATA_IO, "ptr=0x%p this_residual=0x%x ocount=0x%x", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, ocount);
792 /* go to next scatter list if available */
793 if (SCpnt->SCp.this_residual == 0 &&
794 SCpnt->SCp.buffers_residual != 0 ) {
795 //nsp_dbg(NSP_DEBUG_DATA_IO, "scatterlist next timeout=%d", time_out);
796 SCpnt->SCp.buffers_residual--;
797 SCpnt->SCp.buffer++;
798 SCpnt->SCp.ptr = BUFFER_ADDR;
799 SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length;
800 time_out = 1000;
802 //nsp_dbg(NSP_DEBUG_DATA_IO, "page: 0x%p, off: 0x%x", SCpnt->SCp.buffer->page, SCpnt->SCp.buffer->offset);
806 data->FifoCount = ocount;
808 if (time_out == 0) {
809 nsp_msg(KERN_DEBUG, "pio read timeout resid=%d this_residual=%d buffers_residual=%d",
810 SCpnt->resid, SCpnt->SCp.this_residual, SCpnt->SCp.buffers_residual);
812 nsp_dbg(NSP_DEBUG_DATA_IO, "read ocount=0x%x", ocount);
813 nsp_dbg(NSP_DEBUG_DATA_IO, "r cmd=%d resid=0x%x\n", data->CmdId, SCpnt->resid);
817 * write data in DATA OUT phase
819 static void nsp_pio_write(Scsi_Cmnd *SCpnt)
821 unsigned int base = SCpnt->device->host->io_port;
822 unsigned long mmio_base = SCpnt->device->host->base;
823 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
824 int time_out;
825 int ocount, res;
826 unsigned char stat;
828 ocount = data->FifoCount;
830 nsp_dbg(NSP_DEBUG_DATA_IO, "in fifocount=%d ptr=0x%p this_residual=%d buffers=0x%p nbuf=%d resid=0x%x",
831 data->FifoCount, SCpnt->SCp.ptr, SCpnt->SCp.this_residual, SCpnt->SCp.buffer, SCpnt->SCp.buffers_residual, SCpnt->resid);
833 time_out = 1000;
835 while ((time_out-- != 0) &&
836 (SCpnt->SCp.this_residual > 0 || SCpnt->SCp.buffers_residual > 0)) {
837 stat = nsp_index_read(base, SCSIBUSMON);
838 stat &= BUSMON_PHASE_MASK;
840 if (stat != BUSPHASE_DATA_OUT) {
841 res = ocount - nsp_fifo_count(SCpnt);
843 nsp_dbg(NSP_DEBUG_DATA_IO, "phase changed stat=0x%x, res=%d\n", stat, res);
844 /* Put back pointer */
845 SCpnt->resid += res;
846 SCpnt->SCp.ptr -= res;
847 SCpnt->SCp.this_residual += res;
848 ocount -= res;
850 break;
853 res = ocount - nsp_fifo_count(SCpnt);
854 if (res > 0) { /* write all data? */
855 nsp_dbg(NSP_DEBUG_DATA_IO, "wait for all data out. ocount=0x%x res=%d", ocount, res);
856 continue;
859 res = min(SCpnt->SCp.this_residual, WFIFO_CRIT);
861 //nsp_dbg(NSP_DEBUG_DATA_IO, "ptr=0x%p this=0x%x res=0x%x", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, res);
862 switch (data->TransferMode) {
863 case MODE_IO32:
864 res &= ~(BIT(1)|BIT(0)); /* align 4 */
865 nsp_fifo32_write(base, SCpnt->SCp.ptr, res >> 2);
866 break;
867 case MODE_IO8:
868 nsp_fifo8_write (base, SCpnt->SCp.ptr, res );
869 break;
871 case MODE_MEM32:
872 res &= ~(BIT(1)|BIT(0)); /* align 4 */
873 nsp_mmio_fifo32_write(mmio_base, SCpnt->SCp.ptr, res >> 2);
874 break;
876 default:
877 nsp_dbg(NSP_DEBUG_DATA_IO, "unknown write mode");
878 break;
881 SCpnt->resid -= res;
882 SCpnt->SCp.ptr += res;
883 SCpnt->SCp.this_residual -= res;
884 ocount += res;
886 /* go to next scatter list if available */
887 if (SCpnt->SCp.this_residual == 0 &&
888 SCpnt->SCp.buffers_residual != 0 ) {
889 //nsp_dbg(NSP_DEBUG_DATA_IO, "scatterlist next");
890 SCpnt->SCp.buffers_residual--;
891 SCpnt->SCp.buffer++;
892 SCpnt->SCp.ptr = BUFFER_ADDR;
893 SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length;
894 time_out = 1000;
898 data->FifoCount = ocount;
900 if (time_out == 0) {
901 nsp_msg(KERN_DEBUG, "pio write timeout resid=0x%x", SCpnt->resid);
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, SCpnt->resid);
906 #undef RFIFO_CRIT
907 #undef WFIFO_CRIT
910 * setup synchronous/asynchronous data transfer mode
912 static int nsp_nexus(Scsi_Cmnd *SCpnt)
914 unsigned int base = SCpnt->device->host->io_port;
915 unsigned char target = SCpnt->device->id;
916 // unsigned char lun = SCpnt->device->lun;
917 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
918 sync_data *sync = &(data->Sync[target]);
920 //nsp_dbg(NSP_DEBUG_DATA_IO, "in SCpnt=0x%p", SCpnt);
922 /* setup synch transfer registers */
923 nsp_index_write(base, SYNCREG, sync->SyncRegister);
924 nsp_index_write(base, ACKWIDTH, sync->AckWidth);
926 if (SCpnt->use_sg == 0 ||
927 SCpnt->resid % 4 != 0 ||
928 SCpnt->resid <= 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;
938 /* setup pdma fifo */
939 nsp_setup_fifo(data, TRUE);
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);
948 return 0;
951 #include "nsp_message.c"
953 * interrupt handler
955 static irqreturn_t nspintr(int irq, void *dev_id, struct pt_regs *regs)
957 unsigned int base;
958 unsigned char irq_status, irq_phase, phase;
959 Scsi_Cmnd *tmpSC;
960 unsigned char target, lun;
961 unsigned int *sync_neg;
962 int i, tmp;
963 nsp_hw_data *data;
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);
969 if ( dev_id != NULL &&
970 ((scsi_info_t *)dev_id)->host != NULL ) {
971 scsi_info_t *info = (scsi_info_t *)dev_id;
973 data = (nsp_hw_data *)info->host->hostdata;
974 } else {
975 nsp_dbg(NSP_DEBUG_INTR, "host data wrong");
976 return IRQ_NONE;
979 //nsp_dbg(NSP_DEBUG_INTR, "&nsp_data_base=0x%p, dev_id=0x%p", &nsp_data_base, dev_id);
981 base = data->BaseAddress;
982 //nsp_dbg(NSP_DEBUG_INTR, "base=0x%x", base);
985 * interrupt check
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;
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.
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;
1007 //nsp_dbg(NSP_DEBUG_INTR, "irq_phase=0x%x", irq_phase);
1010 * timer interrupt handler (scsi vs timer interrupts)
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;
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;
1027 nsp_write(base, IRQCONTROL, IRQCONTROL_TIMER_CLEAR | IRQCONTROL_FIFO_CLEAR);
1029 if ((irq_status & IRQSTATUS_SCSI) &&
1030 (irq_phase & SCSI_RESET_IRQ)) {
1031 nsp_msg(KERN_ERR, "bus reset (power off?)");
1033 nsphw_init(data);
1034 nsp_bus_reset(data);
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);
1043 return IRQ_HANDLED;
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;
1053 tmpSC = data->CurrentSC;
1054 target = tmpSC->device->id;
1055 lun = tmpSC->device->lun;
1056 sync_neg = &(data->Sync[target].SyncNegotiation);
1059 * parse hardware SCSI irq reasons register
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;
1070 if ((irq_phase & (PHASE_CHANGE_IRQ | LATCHED_BUS_FREE)) == 0) {
1071 return IRQ_HANDLED;
1075 //show_phase(tmpSC);
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);
1087 tmpSC->result = DID_TIME_OUT << 16;
1088 nsp_scsi_done(tmpSC);
1090 return IRQ_HANDLED;
1092 data->SelectionTimeOut += 1;
1093 nsp_start_timer(tmpSC, 1000/51);
1094 return IRQ_HANDLED;
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;
1106 break;
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) {
1113 tmpSC->result = DID_ABORT << 16;
1114 nsp_scsi_done(tmpSC);
1115 return IRQ_HANDLED;
1117 /* fall thru */
1118 default:
1119 if ((irq_status & (IRQSTATUS_SCSI | IRQSTATUS_FIFO)) == 0) {
1120 return IRQ_HANDLED;
1122 break;
1126 * SCSI sequencer
1128 //nsp_dbg(NSP_DEBUG_INTR, "start scsi seq");
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);
1135 //*sync_neg = SYNC_NOT_YET;
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);
1144 return IRQ_HANDLED;
1147 return IRQ_HANDLED;
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);
1155 *sync_neg = SYNC_NG;
1156 tmpSC->result = DID_ERROR << 16;
1157 nsp_scsi_done(tmpSC);
1158 return IRQ_HANDLED;
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;
1169 tmpSC->SCp.phase = PH_COMMAND;
1171 nsp_nexus(tmpSC);
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]);
1179 nsp_index_write(base, COMMANDCTRL, CLEAR_COMMAND_POINTER | AUTO_COMMAND_GO);
1180 break;
1182 case BUSPHASE_DATA_OUT:
1183 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_DATA_OUT");
1185 tmpSC->SCp.phase = PH_DATA;
1186 tmpSC->SCp.have_data_in = IO_OUT;
1188 nsp_pio_write(tmpSC);
1190 break;
1192 case BUSPHASE_DATA_IN:
1193 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_DATA_IN");
1195 tmpSC->SCp.phase = PH_DATA;
1196 tmpSC->SCp.have_data_in = IO_IN;
1198 nsp_pio_read(tmpSC);
1200 break;
1202 case BUSPHASE_STATUS:
1203 nsp_dataphase_bypass(tmpSC);
1204 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_STATUS");
1206 tmpSC->SCp.phase = PH_STATUS;
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);
1211 break;
1213 case BUSPHASE_MESSAGE_OUT:
1214 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE_MESSAGE_OUT");
1215 if ((phase & BUSMON_REQ) == 0) {
1216 goto timer_out;
1219 tmpSC->SCp.phase = PH_MSG_OUT;
1221 //*sync_neg = SYNC_NOT_YET;
1223 data->MsgLen = i = 0;
1224 data->MsgBuffer[i] = IDENTIFY(TRUE, lun); i++;
1226 if (*sync_neg == SYNC_NOT_YET) {
1227 data->Sync[target].SyncPeriod = 0;
1228 data->Sync[target].SyncOffset = 0;
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 /**/
1238 data->MsgLen = i;
1240 nsp_analyze_sdtr(tmpSC);
1241 show_message(data);
1242 nsp_message_out(tmpSC);
1243 break;
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;
1252 tmpSC->SCp.phase = PH_MSG_IN;
1253 nsp_message_in(tmpSC);
1255 /**/
1256 if (*sync_neg == SYNC_NOT_YET) {
1257 //nsp_dbg(NSP_DEBUG_INTR, "sync target=%d,lun=%d",target,lun);
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;
1272 nsp_analyze_sdtr(tmpSC);
1274 /**/
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]);
1284 tmpSC->SCp.Message = tmp;
1286 nsp_dbg(NSP_DEBUG_INTR, "message=0x%x len=%d", tmpSC->SCp.Message, data->MsgLen);
1287 show_message(data);
1289 break;
1291 case BUSPHASE_SELECT:
1292 default:
1293 nsp_dbg(NSP_DEBUG_INTR, "BUSPHASE other");
1295 break;
1298 //nsp_dbg(NSP_DEBUG_INTR, "out");
1299 return IRQ_HANDLED;
1301 timer_out:
1302 nsp_start_timer(tmpSC, 1000/102);
1303 return IRQ_HANDLED;
1306 #ifdef NSP_DEBUG
1307 #include "nsp_debug.c"
1308 #endif /* NSP_DEBUG */
1310 /*----------------------------------------------------------------*/
1311 /* look for ninja3 card and init if found */
1312 /*----------------------------------------------------------------*/
1313 static struct Scsi_Host *nsp_detect(Scsi_Host_Template *sht)
1315 struct Scsi_Host *host; /* registered host structure */
1316 nsp_hw_data *data_b = &nsp_data_base, *data;
1318 nsp_dbg(NSP_DEBUG_INIT, "this_id=%d", sht->this_id);
1319 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,73))
1320 host = scsi_host_alloc(&nsp_driver_template, sizeof(nsp_hw_data));
1321 #else
1322 host = scsi_register(sht, sizeof(nsp_hw_data));
1323 #endif
1324 if (host == NULL) {
1325 nsp_dbg(NSP_DEBUG_INIT, "host failed");
1326 return NULL;
1329 memcpy(host->hostdata, data_b, sizeof(nsp_hw_data));
1330 data = (nsp_hw_data *)host->hostdata;
1331 data->ScsiInfo->host = host;
1332 #ifdef NSP_DEBUG
1333 data->CmdId = 0;
1334 #endif
1336 nsp_dbg(NSP_DEBUG_INIT, "irq=%d,%d", data_b->IrqNumber, ((nsp_hw_data *)host->hostdata)->IrqNumber);
1338 host->unique_id = data->BaseAddress;
1339 host->io_port = data->BaseAddress;
1340 host->n_io_port = data->NumAddress;
1341 host->irq = data->IrqNumber;
1342 host->base = data->MmioAddress;
1344 spin_lock_init(&(data->Lock));
1346 snprintf(data->nspinfo,
1347 sizeof(data->nspinfo),
1348 "NinjaSCSI-3/32Bi Driver $Revision: 1.23 $ IO:0x%04lx-0x%04lx MMIO(virt addr):0x%04lx IRQ:%02d",
1349 host->io_port, host->io_port + host->n_io_port - 1,
1350 host->base,
1351 host->irq);
1352 sht->name = data->nspinfo;
1354 nsp_dbg(NSP_DEBUG_INIT, "end");
1357 return host; /* detect done. */
1360 #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
1361 static int nsp_detect_old(Scsi_Host_Template *sht)
1363 if (nsp_detect(sht) == NULL) {
1364 return 0;
1365 } else {
1366 //MOD_INC_USE_COUNT;
1367 return 1;
1372 static int nsp_release_old(struct Scsi_Host *shpnt)
1374 //nsp_hw_data *data = (nsp_hw_data *)shpnt->hostdata;
1376 /* PCMCIA Card Service dose same things below. */
1377 /* So we do nothing. */
1378 //if (shpnt->irq) {
1379 // free_irq(shpnt->irq, data->ScsiInfo);
1381 //if (shpnt->io_port) {
1382 // release_region(shpnt->io_port, shpnt->n_io_port);
1385 //MOD_DEC_USE_COUNT;
1387 return 0;
1389 #endif
1391 /*----------------------------------------------------------------*/
1392 /* return info string */
1393 /*----------------------------------------------------------------*/
1394 static const char *nsp_info(struct Scsi_Host *shpnt)
1396 nsp_hw_data *data = (nsp_hw_data *)shpnt->hostdata;
1398 return data->nspinfo;
1401 #undef SPRINTF
1402 #define SPRINTF(args...) \
1403 do { \
1404 if(length > (pos - buffer)) { \
1405 pos += snprintf(pos, length - (pos - buffer) + 1, ## args); \
1406 nsp_dbg(NSP_DEBUG_PROC, "buffer=0x%p pos=0x%p length=%d %d\n", buffer, pos, length, length - (pos - buffer));\
1408 } while(0)
1409 static int
1410 nsp_proc_info(
1411 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,73))
1412 struct Scsi_Host *host,
1413 #endif
1414 char *buffer,
1415 char **start,
1416 off_t offset,
1417 int length,
1418 #if !(LINUX_VERSION_CODE > KERNEL_VERSION(2,5,73))
1419 int hostno,
1420 #endif
1421 int inout)
1423 int id;
1424 char *pos = buffer;
1425 int thislength;
1426 int speed;
1427 unsigned long flags;
1428 nsp_hw_data *data;
1429 #if !(LINUX_VERSION_CODE > KERNEL_VERSION(2,5,73))
1430 struct Scsi_Host *host;
1431 #else
1432 int hostno;
1433 #endif
1434 if (inout) {
1435 return -EINVAL;
1438 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,73))
1439 hostno = host->host_no;
1440 #else
1441 /* search this HBA host */
1442 host = scsi_host_hn_get(hostno);
1443 if (host == NULL) {
1444 return -ESRCH;
1446 #endif
1447 data = (nsp_hw_data *)host->hostdata;
1450 SPRINTF("NinjaSCSI status\n\n");
1451 SPRINTF("Driver version: $Revision: 1.23 $\n");
1452 SPRINTF("SCSI host No.: %d\n", hostno);
1453 SPRINTF("IRQ: %d\n", host->irq);
1454 SPRINTF("IO: 0x%lx-0x%lx\n", host->io_port, host->io_port + host->n_io_port - 1);
1455 SPRINTF("MMIO(virtual address): 0x%lx-0x%lx\n", host->base, host->base + data->MmioLength - 1);
1456 SPRINTF("sg_tablesize: %d\n", host->sg_tablesize);
1458 SPRINTF("burst transfer mode: ");
1459 switch (nsp_burst_mode) {
1460 case BURST_IO8:
1461 SPRINTF("io8");
1462 break;
1463 case BURST_IO32:
1464 SPRINTF("io32");
1465 break;
1466 case BURST_MEM32:
1467 SPRINTF("mem32");
1468 break;
1469 default:
1470 SPRINTF("???");
1471 break;
1473 SPRINTF("\n");
1476 spin_lock_irqsave(&(data->Lock), flags);
1477 SPRINTF("CurrentSC: 0x%p\n\n", data->CurrentSC);
1478 spin_unlock_irqrestore(&(data->Lock), flags);
1480 SPRINTF("SDTR status\n");
1481 for(id = 0; id < ARRAY_SIZE(data->Sync); id++) {
1483 SPRINTF("id %d: ", id);
1485 if (id == host->this_id) {
1486 SPRINTF("----- NinjaSCSI-3 host adapter\n");
1487 continue;
1490 switch(data->Sync[id].SyncNegotiation) {
1491 case SYNC_OK:
1492 SPRINTF(" sync");
1493 break;
1494 case SYNC_NG:
1495 SPRINTF("async");
1496 break;
1497 case SYNC_NOT_YET:
1498 SPRINTF(" none");
1499 break;
1500 default:
1501 SPRINTF("?????");
1502 break;
1505 if (data->Sync[id].SyncPeriod != 0) {
1506 speed = 1000000 / (data->Sync[id].SyncPeriod * 4);
1508 SPRINTF(" transfer %d.%dMB/s, offset %d",
1509 speed / 1000,
1510 speed % 1000,
1511 data->Sync[id].SyncOffset
1514 SPRINTF("\n");
1517 thislength = pos - (buffer + offset);
1519 if(thislength < 0) {
1520 *start = NULL;
1521 return 0;
1525 thislength = min(thislength, length);
1526 *start = buffer + offset;
1528 return thislength;
1530 #undef SPRINTF
1532 /*---------------------------------------------------------------*/
1533 /* error handler */
1534 /*---------------------------------------------------------------*/
1537 static int nsp_eh_abort(Scsi_Cmnd *SCpnt)
1539 nsp_dbg(NSP_DEBUG_BUSRESET, "SCpnt=0x%p", SCpnt);
1541 return nsp_eh_bus_reset(SCpnt);
1544 static int nsp_bus_reset(nsp_hw_data *data)
1546 unsigned int base = data->BaseAddress;
1547 int i;
1549 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLMASK);
1551 nsp_index_write(base, SCSIBUSCTRL, SCSI_RST);
1552 mdelay(100); /* 100ms */
1553 nsp_index_write(base, SCSIBUSCTRL, 0);
1554 for(i = 0; i < 5; i++) {
1555 nsp_index_read(base, IRQPHASESENCE); /* dummy read */
1558 nsphw_init_sync(data);
1560 nsp_write(base, IRQCONTROL, IRQCONTROL_ALLCLEAR);
1562 return SUCCESS;
1565 static int nsp_eh_bus_reset(Scsi_Cmnd *SCpnt)
1567 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
1569 nsp_dbg(NSP_DEBUG_BUSRESET, "SCpnt=0x%p", SCpnt);
1571 return nsp_bus_reset(data);
1574 static int nsp_eh_host_reset(Scsi_Cmnd *SCpnt)
1576 nsp_hw_data *data = (nsp_hw_data *)SCpnt->device->host->hostdata;
1578 nsp_dbg(NSP_DEBUG_BUSRESET, "in");
1580 nsphw_init(data);
1582 return SUCCESS;
1586 /**********************************************************************
1587 PCMCIA functions
1588 **********************************************************************/
1590 /*======================================================================
1591 nsp_cs_attach() creates an "instance" of the driver, allocating
1592 local data structures for one device. The device is registered
1593 with Card Services.
1595 The dev_link structure is initialized, but we don't actually
1596 configure the card at this point -- we wait until we receive a
1597 card insertion event.
1598 ======================================================================*/
1599 static dev_link_t *nsp_cs_attach(void)
1601 scsi_info_t *info;
1602 client_reg_t client_reg;
1603 dev_link_t *link;
1604 int ret;
1605 nsp_hw_data *data = &nsp_data_base;
1607 nsp_dbg(NSP_DEBUG_INIT, "in");
1609 /* Create new SCSI device */
1610 info = kmalloc(sizeof(*info), GFP_KERNEL);
1611 if (info == NULL) { return NULL; }
1612 memset(info, 0, sizeof(*info));
1613 link = &info->link;
1614 link->priv = info;
1615 data->ScsiInfo = info;
1617 nsp_dbg(NSP_DEBUG_INIT, "info=0x%p", info);
1619 /* The io structure describes IO port mapping */
1620 link->io.NumPorts1 = 0x10;
1621 link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
1622 link->io.IOAddrLines = 10; /* not used */
1624 /* Interrupt setup */
1625 link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
1626 link->irq.IRQInfo1 = IRQ_LEVEL_ID;
1628 /* Interrupt handler */
1629 link->irq.Handler = &nspintr;
1630 link->irq.Instance = info;
1631 link->irq.Attributes |= (SA_SHIRQ | SA_SAMPLE_RANDOM);
1633 /* General socket configuration */
1634 link->conf.Attributes = CONF_ENABLE_IRQ;
1635 link->conf.Vcc = 50;
1636 link->conf.IntType = INT_MEMORY_AND_IO;
1637 link->conf.Present = PRESENT_OPTION;
1640 /* Register with Card Services */
1641 link->next = dev_list;
1642 dev_list = link;
1643 client_reg.dev_info = &dev_info;
1644 client_reg.Version = 0x0210;
1645 client_reg.event_callback_args.client_data = link;
1646 ret = pcmcia_register_client(&link->handle, &client_reg);
1647 if (ret != CS_SUCCESS) {
1648 cs_error(link->handle, RegisterClient, ret);
1649 nsp_cs_detach(link);
1650 return NULL;
1654 nsp_dbg(NSP_DEBUG_INIT, "link=0x%p", link);
1655 return link;
1656 } /* nsp_cs_attach */
1659 /*======================================================================
1660 This deletes a driver "instance". The device is de-registered
1661 with Card Services. If it has been released, all local data
1662 structures are freed. Otherwise, the structures will be freed
1663 when the device is released.
1664 ======================================================================*/
1665 static void nsp_cs_detach(dev_link_t *link)
1667 dev_link_t **linkp;
1669 nsp_dbg(NSP_DEBUG_INIT, "in, link=0x%p", link);
1671 /* Locate device structure */
1672 for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next) {
1673 if (*linkp == link) {
1674 break;
1677 if (*linkp == NULL) {
1678 return;
1681 if (link->state & DEV_CONFIG)
1682 nsp_cs_release(link);
1684 /* Break the link with Card Services */
1685 if (link->handle) {
1686 pcmcia_deregister_client(link->handle);
1689 /* Unlink device structure, free bits */
1690 *linkp = link->next;
1691 kfree(link->priv);
1692 link->priv = NULL;
1694 } /* nsp_cs_detach */
1697 /*======================================================================
1698 nsp_cs_config() is scheduled to run after a CARD_INSERTION event
1699 is received, to configure the PCMCIA socket, and to make the
1700 ethernet device available to the system.
1701 ======================================================================*/
1702 #define CS_CHECK(fn, ret) \
1703 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
1704 /*====================================================================*/
1705 static void nsp_cs_config(dev_link_t *link)
1707 client_handle_t handle = link->handle;
1708 scsi_info_t *info = link->priv;
1709 tuple_t tuple;
1710 cisparse_t parse;
1711 int last_ret, last_fn;
1712 unsigned char tuple_data[64];
1713 config_info_t conf;
1714 win_req_t req;
1715 memreq_t map;
1716 cistpl_cftable_entry_t dflt = { 0 };
1717 struct Scsi_Host *host;
1718 nsp_hw_data *data = &nsp_data_base;
1719 #if !(LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,74))
1720 Scsi_Device *dev;
1721 dev_node_t **tail, *node;
1722 #endif
1724 nsp_dbg(NSP_DEBUG_INIT, "in");
1726 tuple.DesiredTuple = CISTPL_CONFIG;
1727 tuple.Attributes = 0;
1728 tuple.TupleData = tuple_data;
1729 tuple.TupleDataMax = sizeof(tuple_data);
1730 tuple.TupleOffset = 0;
1731 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
1732 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(handle, &tuple));
1733 CS_CHECK(ParseTuple, pcmcia_parse_tuple(handle, &tuple, &parse));
1734 link->conf.ConfigBase = parse.config.base;
1735 link->conf.Present = parse.config.rmask[0];
1737 /* Configure card */
1738 link->state |= DEV_CONFIG;
1740 /* Look up the current Vcc */
1741 CS_CHECK(GetConfigurationInfo, pcmcia_get_configuration_info(handle, &conf));
1742 link->conf.Vcc = conf.Vcc;
1744 tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
1745 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
1746 while (1) {
1747 cistpl_cftable_entry_t *cfg = &(parse.cftable_entry);
1749 if (pcmcia_get_tuple_data(handle, &tuple) != 0 ||
1750 pcmcia_parse_tuple(handle, &tuple, &parse) != 0)
1751 goto next_entry;
1753 if (cfg->flags & CISTPL_CFTABLE_DEFAULT) { dflt = *cfg; }
1754 if (cfg->index == 0) { goto next_entry; }
1755 link->conf.ConfigIndex = cfg->index;
1757 /* Does this card need audio output? */
1758 if (cfg->flags & CISTPL_CFTABLE_AUDIO) {
1759 link->conf.Attributes |= CONF_ENABLE_SPKR;
1760 link->conf.Status = CCSR_AUDIO_ENA;
1763 /* Use power settings for Vcc and Vpp if present */
1764 /* Note that the CIS values need to be rescaled */
1765 if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
1766 if (conf.Vcc != cfg->vcc.param[CISTPL_POWER_VNOM]/10000) {
1767 goto next_entry;
1769 } else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
1770 if (conf.Vcc != dflt.vcc.param[CISTPL_POWER_VNOM]/10000) {
1771 goto next_entry;
1775 if (cfg->vpp1.present & (1 << CISTPL_POWER_VNOM)) {
1776 link->conf.Vpp1 = link->conf.Vpp2 =
1777 cfg->vpp1.param[CISTPL_POWER_VNOM] / 10000;
1778 } else if (dflt.vpp1.present & (1 << CISTPL_POWER_VNOM)) {
1779 link->conf.Vpp1 = link->conf.Vpp2 =
1780 dflt.vpp1.param[CISTPL_POWER_VNOM] / 10000;
1783 /* Do we need to allocate an interrupt? */
1784 if (cfg->irq.IRQInfo1 || dflt.irq.IRQInfo1) {
1785 link->conf.Attributes |= CONF_ENABLE_IRQ;
1788 /* IO window settings */
1789 link->io.NumPorts1 = link->io.NumPorts2 = 0;
1790 if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
1791 cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
1792 link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
1793 if (!(io->flags & CISTPL_IO_8BIT))
1794 link->io.Attributes1 = IO_DATA_PATH_WIDTH_16;
1795 if (!(io->flags & CISTPL_IO_16BIT))
1796 link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
1797 link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
1798 link->io.BasePort1 = io->win[0].base;
1799 link->io.NumPorts1 = io->win[0].len;
1800 if (io->nwin > 1) {
1801 link->io.Attributes2 = link->io.Attributes1;
1802 link->io.BasePort2 = io->win[1].base;
1803 link->io.NumPorts2 = io->win[1].len;
1805 /* This reserves IO space but doesn't actually enable it */
1806 if (pcmcia_request_io(link->handle, &link->io) != 0)
1807 goto next_entry;
1810 if ((cfg->mem.nwin > 0) || (dflt.mem.nwin > 0)) {
1811 cistpl_mem_t *mem =
1812 (cfg->mem.nwin) ? &cfg->mem : &dflt.mem;
1813 req.Attributes = WIN_DATA_WIDTH_16|WIN_MEMORY_TYPE_CM;
1814 req.Attributes |= WIN_ENABLE;
1815 req.Base = mem->win[0].host_addr;
1816 req.Size = mem->win[0].len;
1817 if (req.Size < 0x1000) {
1818 req.Size = 0x1000;
1820 req.AccessSpeed = 0;
1821 if (pcmcia_request_window(&link->handle, &req, &link->win) != 0)
1822 goto next_entry;
1823 map.Page = 0; map.CardOffset = mem->win[0].card_addr;
1824 if (pcmcia_map_mem_page(link->win, &map) != 0)
1825 goto next_entry;
1827 data->MmioAddress = (unsigned long)ioremap_nocache(req.Base, req.Size);
1828 data->MmioLength = req.Size;
1830 /* If we got this far, we're cool! */
1831 break;
1833 next_entry:
1834 nsp_dbg(NSP_DEBUG_INIT, "next");
1836 if (link->io.NumPorts1) {
1837 pcmcia_release_io(link->handle, &link->io);
1839 CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(handle, &tuple));
1842 if (link->conf.Attributes & CONF_ENABLE_IRQ) {
1843 CS_CHECK(RequestIRQ, pcmcia_request_irq(link->handle, &link->irq));
1845 CS_CHECK(RequestConfiguration, pcmcia_request_configuration(handle, &link->conf));
1847 if (free_ports) {
1848 if (link->io.BasePort1) {
1849 release_region(link->io.BasePort1, link->io.NumPorts1);
1851 if (link->io.BasePort2) {
1852 release_region(link->io.BasePort2, link->io.NumPorts2);
1856 /* Set port and IRQ */
1857 data->BaseAddress = link->io.BasePort1;
1858 data->NumAddress = link->io.NumPorts1;
1859 data->IrqNumber = link->irq.AssignedIRQ;
1861 nsp_dbg(NSP_DEBUG_INIT, "I/O[0x%x+0x%x] IRQ %d",
1862 data->BaseAddress, data->NumAddress, data->IrqNumber);
1864 if(nsphw_init(data) == FALSE) {
1865 goto cs_failed;
1868 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,2))
1869 host = nsp_detect(&nsp_driver_template);
1870 #else
1871 scsi_register_host(&nsp_driver_template);
1872 for (host = scsi_host_get_next(NULL); host != NULL;
1873 host = scsi_host_get_next(host)) {
1874 if (host->hostt == &nsp_driver_template) {
1875 break;
1878 #endif
1880 if (host == NULL) {
1881 nsp_dbg(NSP_DEBUG_INIT, "detect failed");
1882 goto cs_failed;
1886 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,74))
1887 scsi_add_host (host, NULL);
1888 scsi_scan_host(host);
1890 snprintf(info->node.dev_name, sizeof(info->node.dev_name), "scsi%d", host->host_no);
1891 link->dev = &info->node;
1892 info->host = host;
1894 #else
1895 nsp_dbg(NSP_DEBUG_INIT, "GET_SCSI_INFO");
1896 tail = &link->dev;
1897 info->ndev = 0;
1899 nsp_dbg(NSP_DEBUG_INIT, "host=0x%p", host);
1901 for (dev = host->host_queue; dev != NULL; dev = dev->next) {
1902 unsigned long id;
1903 id = (dev->id & 0x0f) + ((dev->lun & 0x0f) << 4) +
1904 ((dev->channel & 0x0f) << 8) +
1905 ((dev->host->host_no & 0x0f) << 12);
1906 node = &info->node[info->ndev];
1907 node->minor = 0;
1908 switch (dev->type) {
1909 case TYPE_TAPE:
1910 node->major = SCSI_TAPE_MAJOR;
1911 snprintf(node->dev_name, sizeof(node->dev_name), "st#%04lx", id);
1912 break;
1913 case TYPE_DISK:
1914 case TYPE_MOD:
1915 node->major = SCSI_DISK0_MAJOR;
1916 snprintf(node->dev_name, sizeof(node->dev_name), "sd#%04lx", id);
1917 break;
1918 case TYPE_ROM:
1919 case TYPE_WORM:
1920 node->major = SCSI_CDROM_MAJOR;
1921 snprintf(node->dev_name, sizeof(node->dev_name), "sr#%04lx", id);
1922 break;
1923 default:
1924 node->major = SCSI_GENERIC_MAJOR;
1925 snprintf(node->dev_name, sizeof(node->dev_name), "sg#%04lx", id);
1926 break;
1928 *tail = node; tail = &node->next;
1929 info->ndev++;
1930 info->host = dev->host;
1933 *tail = NULL;
1934 if (info->ndev == 0) {
1935 nsp_msg(KERN_INFO, "no SCSI devices found");
1937 nsp_dbg(NSP_DEBUG_INIT, "host=0x%p", host);
1938 #endif
1940 /* Finally, report what we've done */
1941 printk(KERN_INFO "nsp_cs: index 0x%02x: Vcc %d.%d",
1942 link->conf.ConfigIndex,
1943 link->conf.Vcc/10, link->conf.Vcc%10);
1944 if (link->conf.Vpp1) {
1945 printk(", Vpp %d.%d", link->conf.Vpp1/10, link->conf.Vpp1%10);
1947 if (link->conf.Attributes & CONF_ENABLE_IRQ) {
1948 printk(", irq %d", link->irq.AssignedIRQ);
1950 if (link->io.NumPorts1) {
1951 printk(", io 0x%04x-0x%04x", link->io.BasePort1,
1952 link->io.BasePort1+link->io.NumPorts1-1);
1954 if (link->io.NumPorts2)
1955 printk(" & 0x%04x-0x%04x", link->io.BasePort2,
1956 link->io.BasePort2+link->io.NumPorts2-1);
1957 if (link->win)
1958 printk(", mem 0x%06lx-0x%06lx", req.Base,
1959 req.Base+req.Size-1);
1960 printk("\n");
1962 link->state &= ~DEV_CONFIG_PENDING;
1963 return;
1965 cs_failed:
1966 nsp_dbg(NSP_DEBUG_INIT, "config fail");
1967 cs_error(link->handle, last_fn, last_ret);
1968 nsp_cs_release(link);
1970 return;
1971 } /* nsp_cs_config */
1972 #undef CS_CHECK
1975 /*======================================================================
1976 After a card is removed, nsp_cs_release() will unregister the net
1977 device, and release the PCMCIA configuration. If the device is
1978 still open, this will be postponed until it is closed.
1979 ======================================================================*/
1980 static void nsp_cs_release(dev_link_t *link)
1982 scsi_info_t *info = link->priv;
1983 nsp_hw_data *data = NULL;
1985 if (info->host == NULL) {
1986 nsp_msg(KERN_DEBUG, "unexpected card release call.");
1987 } else {
1988 data = (nsp_hw_data *)info->host->hostdata;
1991 nsp_dbg(NSP_DEBUG_INIT, "link=0x%p", link);
1993 /* Unlink the device chain */
1994 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,2))
1995 if (info->host != NULL) {
1996 scsi_remove_host(info->host);
1998 #else
1999 scsi_unregister_host(&nsp_driver_template);
2000 #endif
2001 link->dev = NULL;
2003 if (link->win) {
2004 if (data != NULL) {
2005 iounmap((void *)(data->MmioAddress));
2007 pcmcia_release_window(link->win);
2009 pcmcia_release_configuration(link->handle);
2010 if (link->io.NumPorts1) {
2011 pcmcia_release_io(link->handle, &link->io);
2013 if (link->irq.AssignedIRQ) {
2014 pcmcia_release_irq(link->handle, &link->irq);
2016 link->state &= ~DEV_CONFIG;
2017 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,2))
2018 if (info->host != NULL) {
2019 scsi_host_put(info->host);
2021 #endif
2022 } /* nsp_cs_release */
2024 /*======================================================================
2026 The card status event handler. Mostly, this schedules other
2027 stuff to run after an event is received. A CARD_REMOVAL event
2028 also sets some flags to discourage the net drivers from trying
2029 to talk to the card any more.
2031 When a CARD_REMOVAL event is received, we immediately set a flag
2032 to block future accesses to this device. All the functions that
2033 actually access the device should check this flag to make sure
2034 the card is still present.
2036 ======================================================================*/
2037 static int nsp_cs_event(event_t event,
2038 int priority,
2039 event_callback_args_t *args)
2041 dev_link_t *link = args->client_data;
2042 scsi_info_t *info = link->priv;
2043 nsp_hw_data *data;
2045 nsp_dbg(NSP_DEBUG_INIT, "in, event=0x%08x", event);
2047 switch (event) {
2048 case CS_EVENT_CARD_REMOVAL:
2049 nsp_dbg(NSP_DEBUG_INIT, "event: remove");
2050 link->state &= ~DEV_PRESENT;
2051 if (link->state & DEV_CONFIG) {
2052 ((scsi_info_t *)link->priv)->stop = 1;
2053 nsp_cs_release(link);
2055 break;
2057 case CS_EVENT_CARD_INSERTION:
2058 nsp_dbg(NSP_DEBUG_INIT, "event: insert");
2059 link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
2060 #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,68))
2061 info->bus = args->bus;
2062 #endif
2063 nsp_cs_config(link);
2064 break;
2066 case CS_EVENT_PM_SUSPEND:
2067 nsp_dbg(NSP_DEBUG_INIT, "event: suspend");
2068 link->state |= DEV_SUSPEND;
2069 /* Fall through... */
2070 case CS_EVENT_RESET_PHYSICAL:
2071 /* Mark the device as stopped, to block IO until later */
2072 nsp_dbg(NSP_DEBUG_INIT, "event: reset physical");
2074 if (info->host != NULL) {
2075 nsp_msg(KERN_INFO, "clear SDTR status");
2077 data = (nsp_hw_data *)info->host->hostdata;
2079 nsphw_init_sync(data);
2082 info->stop = 1;
2083 if (link->state & DEV_CONFIG) {
2084 pcmcia_release_configuration(link->handle);
2086 break;
2088 case CS_EVENT_PM_RESUME:
2089 nsp_dbg(NSP_DEBUG_INIT, "event: resume");
2090 link->state &= ~DEV_SUSPEND;
2091 /* Fall through... */
2092 case CS_EVENT_CARD_RESET:
2093 nsp_dbg(NSP_DEBUG_INIT, "event: reset");
2094 if (link->state & DEV_CONFIG) {
2095 pcmcia_request_configuration(link->handle, &link->conf);
2097 info->stop = 0;
2099 if (info->host != NULL) {
2100 nsp_msg(KERN_INFO, "reset host and bus");
2102 data = (nsp_hw_data *)info->host->hostdata;
2104 nsphw_init (data);
2105 nsp_bus_reset(data);
2108 break;
2110 default:
2111 nsp_dbg(NSP_DEBUG_INIT, "event: unknown");
2112 break;
2114 nsp_dbg(NSP_DEBUG_INIT, "end");
2115 return 0;
2116 } /* nsp_cs_event */
2118 /*======================================================================*
2119 * module entry point
2120 *====================================================================*/
2121 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,68))
2122 static struct pcmcia_device_id nsp_cs_ids[] = {
2123 PCMCIA_DEVICE_PROD_ID123("IO DATA", "CBSC16 ", "1", 0x547e66dc, 0x0d63a3fd, 0x51de003a),
2124 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-001", "1", 0x534c02bc, 0x52008408, 0x51de003a),
2125 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-002", "1", 0x534c02bc, 0xcb09d5b2, 0x51de003a),
2126 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-003", "1", 0x534c02bc, 0xbc0ee524, 0x51de003a),
2127 PCMCIA_DEVICE_PROD_ID123("KME ", "SCSI-CARD-004", "1", 0x534c02bc, 0x226a7087, 0x51de003a),
2128 PCMCIA_DEVICE_PROD_ID123("WBT", "NinjaSCSI-3", "R1.0", 0xc7ba805f, 0xfdc7c97d, 0x6973710e),
2129 PCMCIA_DEVICE_PROD_ID123("WORKBIT", "UltraNinja-16", "1", 0x28191418, 0xb70f4b09, 0x51de003a),
2130 PCMCIA_DEVICE_NULL
2132 MODULE_DEVICE_TABLE(pcmcia, nsp_cs_ids);
2134 static struct pcmcia_driver nsp_driver = {
2135 .owner = THIS_MODULE,
2136 .drv = {
2137 .name = "nsp_cs",
2139 .attach = nsp_cs_attach,
2140 .event = nsp_cs_event,
2141 .detach = nsp_cs_detach,
2142 .id_table = nsp_cs_ids,
2144 #endif
2146 static int __init nsp_cs_init(void)
2148 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,68))
2149 nsp_msg(KERN_INFO, "loading...");
2151 return pcmcia_register_driver(&nsp_driver);
2152 #else
2153 servinfo_t serv;
2155 nsp_msg(KERN_INFO, "loading...");
2156 pcmcia_get_card_services_info(&serv);
2157 if (serv.Revision != CS_RELEASE_CODE) {
2158 nsp_msg(KERN_DEBUG, "Card Services release does not match!");
2159 return -EINVAL;
2161 register_pcmcia_driver(&dev_info, &nsp_cs_attach, &nsp_cs_detach);
2163 nsp_dbg(NSP_DEBUG_INIT, "out");
2164 return 0;
2165 #endif
2168 static void __exit nsp_cs_exit(void)
2170 nsp_msg(KERN_INFO, "unloading...");
2172 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,68))
2173 pcmcia_unregister_driver(&nsp_driver);
2174 BUG_ON(dev_list != NULL);
2175 #else
2176 unregister_pcmcia_driver(&dev_info);
2177 /* XXX: this really needs to move into generic code.. */
2178 while (dev_list != NULL) {
2179 if (dev_list->state & DEV_CONFIG) {
2180 nsp_cs_release(dev_list);
2182 nsp_cs_detach(dev_list);
2184 #endif
2188 module_init(nsp_cs_init)
2189 module_exit(nsp_cs_exit)
2191 /* end */