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