?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
mic: vop: Fix use-after-free on remove
[linux/fpc-iii.git] / drivers / scsi / pcmcia / nsp_cs.c
blob1bd6825a4f142680feb0f2d6e2dbeb84fc85feb5
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 .dma_boundary = PAGE_SIZE - 1,
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 module_pcmcia_driver(nsp_driver);
1746
1747 /* end */
Linux with added FPC-III support