]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * linux/drivers/acorn/scsi/fas216.c | |
3 | * | |
4 | * Copyright (C) 1997-2003 Russell King | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License version 2 as | |
8 | * published by the Free Software Foundation. | |
9 | * | |
10 | * Based on information in qlogicfas.c by Tom Zerucha, Michael Griffith, and | |
11 | * other sources, including: | |
12 | * the AMD Am53CF94 data sheet | |
13 | * the AMD Am53C94 data sheet | |
14 | * | |
15 | * This is a generic driver. To use it, have a look at cumana_2.c. You | |
16 | * should define your own structure that overlays FAS216_Info, eg: | |
17 | * struct my_host_data { | |
18 | * FAS216_Info info; | |
19 | * ... my host specific data ... | |
20 | * }; | |
21 | * | |
22 | * Changelog: | |
23 | * 30-08-1997 RMK Created | |
24 | * 14-09-1997 RMK Started disconnect support | |
25 | * 08-02-1998 RMK Corrected real DMA support | |
26 | * 15-02-1998 RMK Started sync xfer support | |
27 | * 06-04-1998 RMK Tightened conditions for printing incomplete | |
28 | * transfers | |
29 | * 02-05-1998 RMK Added extra checks in fas216_reset | |
30 | * 24-05-1998 RMK Fixed synchronous transfers with period >= 200ns | |
31 | * 27-06-1998 RMK Changed asm/delay.h to linux/delay.h | |
32 | * 26-08-1998 RMK Improved message support wrt MESSAGE_REJECT | |
33 | * 02-04-2000 RMK Converted to use the new error handling, and | |
34 | * automatically request sense data upon check | |
35 | * condition status from targets. | |
36 | */ | |
37 | #include <linux/module.h> | |
38 | #include <linux/blkdev.h> | |
39 | #include <linux/kernel.h> | |
40 | #include <linux/string.h> | |
41 | #include <linux/ioport.h> | |
1da177e4 LT |
42 | #include <linux/proc_fs.h> |
43 | #include <linux/delay.h> | |
44 | #include <linux/bitops.h> | |
45 | #include <linux/init.h> | |
46 | #include <linux/interrupt.h> | |
47 | ||
48 | #include <asm/dma.h> | |
49 | #include <asm/io.h> | |
50 | #include <asm/irq.h> | |
51 | #include <asm/ecard.h> | |
52 | ||
53 | #include "../scsi.h" | |
db9dff36 | 54 | #include <scsi/scsi_dbg.h> |
1da177e4 LT |
55 | #include <scsi/scsi_host.h> |
56 | #include "fas216.h" | |
57 | #include "scsi.h" | |
58 | ||
59 | /* NOTE: SCSI2 Synchronous transfers *require* DMA according to | |
60 | * the data sheet. This restriction is crazy, especially when | |
61 | * you only want to send 16 bytes! What were the guys who | |
62 | * designed this chip on at that time? Did they read the SCSI2 | |
63 | * spec at all? The following sections are taken from the SCSI2 | |
64 | * standard (s2r10) concerning this: | |
65 | * | |
66 | * > IMPLEMENTORS NOTES: | |
67 | * > (1) Re-negotiation at every selection is not recommended, since a | |
68 | * > significant performance impact is likely. | |
69 | * | |
70 | * > The implied synchronous agreement shall remain in effect until a BUS DEVICE | |
71 | * > RESET message is received, until a hard reset condition occurs, or until one | |
72 | * > of the two SCSI devices elects to modify the agreement. The default data | |
73 | * > transfer mode is asynchronous data transfer mode. The default data transfer | |
74 | * > mode is entered at power on, after a BUS DEVICE RESET message, or after a hard | |
75 | * > reset condition. | |
76 | * | |
77 | * In total, this means that once you have elected to use synchronous | |
78 | * transfers, you must always use DMA. | |
79 | * | |
80 | * I was thinking that this was a good chip until I found this restriction ;( | |
81 | */ | |
82 | #define SCSI2_SYNC | |
83 | #undef SCSI2_TAG | |
84 | ||
85 | #undef DEBUG_CONNECT | |
86 | #undef DEBUG_MESSAGES | |
87 | ||
88 | #undef CHECK_STRUCTURE | |
89 | ||
90 | #define LOG_CONNECT (1 << 0) | |
91 | #define LOG_BUSSERVICE (1 << 1) | |
92 | #define LOG_FUNCTIONDONE (1 << 2) | |
93 | #define LOG_MESSAGES (1 << 3) | |
94 | #define LOG_BUFFER (1 << 4) | |
95 | #define LOG_ERROR (1 << 8) | |
96 | ||
97 | static int level_mask = LOG_ERROR; | |
98 | ||
99 | module_param(level_mask, int, 0644); | |
100 | ||
101 | static int __init fas216_log_setup(char *str) | |
102 | { | |
103 | char *s; | |
104 | ||
105 | level_mask = 0; | |
106 | ||
107 | while ((s = strsep(&str, ",")) != NULL) { | |
108 | switch (s[0]) { | |
109 | case 'a': | |
110 | if (strcmp(s, "all") == 0) | |
111 | level_mask |= -1; | |
112 | break; | |
113 | case 'b': | |
114 | if (strncmp(s, "bus", 3) == 0) | |
115 | level_mask |= LOG_BUSSERVICE; | |
116 | if (strncmp(s, "buf", 3) == 0) | |
117 | level_mask |= LOG_BUFFER; | |
118 | break; | |
119 | case 'c': | |
120 | level_mask |= LOG_CONNECT; | |
121 | break; | |
122 | case 'e': | |
123 | level_mask |= LOG_ERROR; | |
124 | break; | |
125 | case 'm': | |
126 | level_mask |= LOG_MESSAGES; | |
127 | break; | |
128 | case 'n': | |
129 | if (strcmp(s, "none") == 0) | |
130 | level_mask = 0; | |
131 | break; | |
132 | case 's': | |
133 | level_mask |= LOG_FUNCTIONDONE; | |
134 | break; | |
135 | } | |
136 | } | |
137 | return 1; | |
138 | } | |
139 | ||
140 | __setup("fas216_logging=", fas216_log_setup); | |
141 | ||
142 | static inline unsigned char fas216_readb(FAS216_Info *info, unsigned int reg) | |
143 | { | |
144 | unsigned int off = reg << info->scsi.io_shift; | |
145 | return readb(info->scsi.io_base + off); | |
146 | } | |
147 | ||
148 | static inline void fas216_writeb(FAS216_Info *info, unsigned int reg, unsigned int val) | |
149 | { | |
150 | unsigned int off = reg << info->scsi.io_shift; | |
151 | writeb(val, info->scsi.io_base + off); | |
152 | } | |
153 | ||
154 | static void fas216_dumpstate(FAS216_Info *info) | |
155 | { | |
156 | unsigned char is, stat, inst; | |
157 | ||
158 | is = fas216_readb(info, REG_IS); | |
159 | stat = fas216_readb(info, REG_STAT); | |
160 | inst = fas216_readb(info, REG_INST); | |
161 | ||
162 | printk("FAS216: CTCL=%02X CTCM=%02X CMD=%02X STAT=%02X" | |
163 | " INST=%02X IS=%02X CFIS=%02X", | |
164 | fas216_readb(info, REG_CTCL), | |
165 | fas216_readb(info, REG_CTCM), | |
166 | fas216_readb(info, REG_CMD), stat, inst, is, | |
167 | fas216_readb(info, REG_CFIS)); | |
168 | printk(" CNTL1=%02X CNTL2=%02X CNTL3=%02X CTCH=%02X\n", | |
169 | fas216_readb(info, REG_CNTL1), | |
170 | fas216_readb(info, REG_CNTL2), | |
171 | fas216_readb(info, REG_CNTL3), | |
172 | fas216_readb(info, REG_CTCH)); | |
173 | } | |
174 | ||
0a04137e | 175 | static void print_SCp(struct scsi_pointer *SCp, const char *prefix, const char *suffix) |
1da177e4 LT |
176 | { |
177 | printk("%sptr %p this_residual 0x%x buffer %p buffers_residual 0x%x%s", | |
178 | prefix, SCp->ptr, SCp->this_residual, SCp->buffer, | |
179 | SCp->buffers_residual, suffix); | |
180 | } | |
181 | ||
48968177 | 182 | #ifdef CHECK_STRUCTURE |
1da177e4 LT |
183 | static void fas216_dumpinfo(FAS216_Info *info) |
184 | { | |
185 | static int used = 0; | |
186 | int i; | |
187 | ||
188 | if (used++) | |
189 | return; | |
190 | ||
191 | printk("FAS216_Info=\n"); | |
192 | printk(" { magic_start=%lX host=%p SCpnt=%p origSCpnt=%p\n", | |
193 | info->magic_start, info->host, info->SCpnt, | |
194 | info->origSCpnt); | |
195 | printk(" scsi={ io_shift=%X irq=%X cfg={ %X %X %X %X }\n", | |
196 | info->scsi.io_shift, info->scsi.irq, | |
197 | info->scsi.cfg[0], info->scsi.cfg[1], info->scsi.cfg[2], | |
198 | info->scsi.cfg[3]); | |
199 | printk(" type=%p phase=%X\n", | |
200 | info->scsi.type, info->scsi.phase); | |
201 | print_SCp(&info->scsi.SCp, " SCp={ ", " }\n"); | |
202 | printk(" msgs async_stp=%X disconnectable=%d aborting=%d }\n", | |
203 | info->scsi.async_stp, | |
204 | info->scsi.disconnectable, info->scsi.aborting); | |
205 | printk(" stats={ queues=%X removes=%X fins=%X reads=%X writes=%X miscs=%X\n" | |
206 | " disconnects=%X aborts=%X bus_resets=%X host_resets=%X}\n", | |
207 | info->stats.queues, info->stats.removes, info->stats.fins, | |
208 | info->stats.reads, info->stats.writes, info->stats.miscs, | |
209 | info->stats.disconnects, info->stats.aborts, info->stats.bus_resets, | |
210 | info->stats.host_resets); | |
211 | printk(" ifcfg={ clockrate=%X select_timeout=%X asyncperiod=%X sync_max_depth=%X }\n", | |
212 | info->ifcfg.clockrate, info->ifcfg.select_timeout, | |
213 | info->ifcfg.asyncperiod, info->ifcfg.sync_max_depth); | |
214 | for (i = 0; i < 8; i++) { | |
215 | printk(" busyluns[%d]=%08lx dev[%d]={ disconnect_ok=%d stp=%X sof=%X sync_state=%X }\n", | |
216 | i, info->busyluns[i], i, | |
217 | info->device[i].disconnect_ok, info->device[i].stp, | |
218 | info->device[i].sof, info->device[i].sync_state); | |
219 | } | |
220 | printk(" dma={ transfer_type=%X setup=%p pseudo=%p stop=%p }\n", | |
221 | info->dma.transfer_type, info->dma.setup, | |
222 | info->dma.pseudo, info->dma.stop); | |
223 | printk(" internal_done=%X magic_end=%lX }\n", | |
224 | info->internal_done, info->magic_end); | |
225 | } | |
226 | ||
1da177e4 LT |
227 | static void __fas216_checkmagic(FAS216_Info *info, const char *func) |
228 | { | |
229 | int corruption = 0; | |
230 | if (info->magic_start != MAGIC) { | |
231 | printk(KERN_CRIT "FAS216 Error: magic at start corrupted\n"); | |
232 | corruption++; | |
233 | } | |
234 | if (info->magic_end != MAGIC) { | |
235 | printk(KERN_CRIT "FAS216 Error: magic at end corrupted\n"); | |
236 | corruption++; | |
237 | } | |
238 | if (corruption) { | |
239 | fas216_dumpinfo(info); | |
240 | panic("scsi memory space corrupted in %s", func); | |
241 | } | |
242 | } | |
cadbd4a5 | 243 | #define fas216_checkmagic(info) __fas216_checkmagic((info), __func__) |
1da177e4 LT |
244 | #else |
245 | #define fas216_checkmagic(info) | |
246 | #endif | |
247 | ||
248 | static const char *fas216_bus_phase(int stat) | |
249 | { | |
250 | static const char *phases[] = { | |
251 | "DATA OUT", "DATA IN", | |
252 | "COMMAND", "STATUS", | |
253 | "MISC OUT", "MISC IN", | |
254 | "MESG OUT", "MESG IN" | |
255 | }; | |
256 | ||
257 | return phases[stat & STAT_BUSMASK]; | |
258 | } | |
259 | ||
260 | static const char *fas216_drv_phase(FAS216_Info *info) | |
261 | { | |
262 | static const char *phases[] = { | |
263 | [PHASE_IDLE] = "idle", | |
264 | [PHASE_SELECTION] = "selection", | |
265 | [PHASE_COMMAND] = "command", | |
266 | [PHASE_DATAOUT] = "data out", | |
267 | [PHASE_DATAIN] = "data in", | |
268 | [PHASE_MSGIN] = "message in", | |
269 | [PHASE_MSGIN_DISCONNECT]= "disconnect", | |
270 | [PHASE_MSGOUT_EXPECT] = "expect message out", | |
271 | [PHASE_MSGOUT] = "message out", | |
272 | [PHASE_STATUS] = "status", | |
273 | [PHASE_DONE] = "done", | |
274 | }; | |
275 | ||
276 | if (info->scsi.phase < ARRAY_SIZE(phases) && | |
277 | phases[info->scsi.phase]) | |
278 | return phases[info->scsi.phase]; | |
279 | return "???"; | |
280 | } | |
281 | ||
282 | static char fas216_target(FAS216_Info *info) | |
283 | { | |
284 | if (info->SCpnt) | |
285 | return '0' + info->SCpnt->device->id; | |
286 | else | |
287 | return 'H'; | |
288 | } | |
289 | ||
290 | static void | |
291 | fas216_do_log(FAS216_Info *info, char target, char *fmt, va_list ap) | |
292 | { | |
293 | static char buf[1024]; | |
294 | ||
295 | vsnprintf(buf, sizeof(buf), fmt, ap); | |
296 | printk("scsi%d.%c: %s", info->host->host_no, target, buf); | |
297 | } | |
298 | ||
ee0ca6ba HK |
299 | static void fas216_log_command(FAS216_Info *info, int level, |
300 | struct scsi_cmnd *SCpnt, char *fmt, ...) | |
1da177e4 LT |
301 | { |
302 | va_list args; | |
303 | ||
304 | if (level != 0 && !(level & level_mask)) | |
305 | return; | |
306 | ||
307 | va_start(args, fmt); | |
308 | fas216_do_log(info, '0' + SCpnt->device->id, fmt, args); | |
309 | va_end(args); | |
310 | ||
e04ca907 | 311 | scsi_print_command(SCpnt); |
1da177e4 LT |
312 | } |
313 | ||
314 | static void | |
315 | fas216_log_target(FAS216_Info *info, int level, int target, char *fmt, ...) | |
316 | { | |
317 | va_list args; | |
318 | ||
319 | if (level != 0 && !(level & level_mask)) | |
320 | return; | |
321 | ||
322 | if (target < 0) | |
323 | target = 'H'; | |
324 | else | |
325 | target += '0'; | |
326 | ||
327 | va_start(args, fmt); | |
328 | fas216_do_log(info, target, fmt, args); | |
329 | va_end(args); | |
330 | ||
331 | printk("\n"); | |
332 | } | |
333 | ||
334 | static void fas216_log(FAS216_Info *info, int level, char *fmt, ...) | |
335 | { | |
336 | va_list args; | |
337 | ||
338 | if (level != 0 && !(level & level_mask)) | |
339 | return; | |
340 | ||
341 | va_start(args, fmt); | |
342 | fas216_do_log(info, fas216_target(info), fmt, args); | |
343 | va_end(args); | |
344 | ||
345 | printk("\n"); | |
346 | } | |
347 | ||
348 | #define PH_SIZE 32 | |
349 | ||
350 | static struct { int stat, ssr, isr, ph; } ph_list[PH_SIZE]; | |
351 | static int ph_ptr; | |
352 | ||
353 | static void add_debug_list(int stat, int ssr, int isr, int ph) | |
354 | { | |
355 | ph_list[ph_ptr].stat = stat; | |
356 | ph_list[ph_ptr].ssr = ssr; | |
357 | ph_list[ph_ptr].isr = isr; | |
358 | ph_list[ph_ptr].ph = ph; | |
359 | ||
360 | ph_ptr = (ph_ptr + 1) & (PH_SIZE-1); | |
361 | } | |
362 | ||
363 | static struct { int command; void *from; } cmd_list[8]; | |
364 | static int cmd_ptr; | |
365 | ||
366 | static void fas216_cmd(FAS216_Info *info, unsigned int command) | |
367 | { | |
368 | cmd_list[cmd_ptr].command = command; | |
369 | cmd_list[cmd_ptr].from = __builtin_return_address(0); | |
370 | ||
371 | cmd_ptr = (cmd_ptr + 1) & 7; | |
372 | ||
373 | fas216_writeb(info, REG_CMD, command); | |
374 | } | |
375 | ||
376 | static void print_debug_list(void) | |
377 | { | |
378 | int i; | |
379 | ||
380 | i = ph_ptr; | |
381 | ||
382 | printk(KERN_ERR "SCSI IRQ trail\n"); | |
383 | do { | |
384 | printk(" %02x:%02x:%02x:%1x", | |
385 | ph_list[i].stat, ph_list[i].ssr, | |
386 | ph_list[i].isr, ph_list[i].ph); | |
387 | i = (i + 1) & (PH_SIZE - 1); | |
388 | if (((i ^ ph_ptr) & 7) == 0) | |
389 | printk("\n"); | |
390 | } while (i != ph_ptr); | |
391 | if ((i ^ ph_ptr) & 7) | |
392 | printk("\n"); | |
393 | ||
394 | i = cmd_ptr; | |
395 | printk(KERN_ERR "FAS216 commands: "); | |
396 | do { | |
397 | printk("%02x:%p ", cmd_list[i].command, cmd_list[i].from); | |
398 | i = (i + 1) & 7; | |
399 | } while (i != cmd_ptr); | |
400 | printk("\n"); | |
401 | } | |
402 | ||
403 | static void fas216_done(FAS216_Info *info, unsigned int result); | |
404 | ||
405 | /** | |
406 | * fas216_get_last_msg - retrive last message from the list | |
407 | * @info: interface to search | |
408 | * @pos: current fifo position | |
409 | * | |
410 | * Retrieve a last message from the list, using position in fifo. | |
411 | */ | |
412 | static inline unsigned short | |
413 | fas216_get_last_msg(FAS216_Info *info, int pos) | |
414 | { | |
415 | unsigned short packed_msg = NOP; | |
416 | struct message *msg; | |
417 | int msgnr = 0; | |
418 | ||
419 | while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) { | |
420 | if (pos >= msg->fifo) | |
421 | break; | |
422 | } | |
423 | ||
424 | if (msg) { | |
425 | if (msg->msg[0] == EXTENDED_MESSAGE) | |
426 | packed_msg = EXTENDED_MESSAGE | msg->msg[2] << 8; | |
427 | else | |
428 | packed_msg = msg->msg[0]; | |
429 | } | |
430 | ||
431 | fas216_log(info, LOG_MESSAGES, | |
432 | "Message: %04x found at position %02x\n", packed_msg, pos); | |
433 | ||
434 | return packed_msg; | |
435 | } | |
436 | ||
437 | /** | |
438 | * fas216_syncperiod - calculate STP register value | |
439 | * @info: state structure for interface connected to device | |
440 | * @ns: period in ns (between subsequent bytes) | |
441 | * | |
442 | * Calculate value to be loaded into the STP register for a given period | |
443 | * in ns. Returns a value suitable for REG_STP. | |
444 | */ | |
445 | static int fas216_syncperiod(FAS216_Info *info, int ns) | |
446 | { | |
447 | int value = (info->ifcfg.clockrate * ns) / 1000; | |
448 | ||
449 | fas216_checkmagic(info); | |
450 | ||
451 | if (value < 4) | |
452 | value = 4; | |
453 | else if (value > 35) | |
454 | value = 35; | |
455 | ||
456 | return value & 31; | |
457 | } | |
458 | ||
459 | /** | |
460 | * fas216_set_sync - setup FAS216 chip for specified transfer period. | |
461 | * @info: state structure for interface connected to device | |
462 | * @target: target | |
463 | * | |
464 | * Correctly setup FAS216 chip for specified transfer period. | |
465 | * Notes : we need to switch the chip out of FASTSCSI mode if we have | |
466 | * a transfer period >= 200ns - otherwise the chip will violate | |
467 | * the SCSI timings. | |
468 | */ | |
469 | static void fas216_set_sync(FAS216_Info *info, int target) | |
470 | { | |
471 | unsigned int cntl3; | |
472 | ||
473 | fas216_writeb(info, REG_SOF, info->device[target].sof); | |
474 | fas216_writeb(info, REG_STP, info->device[target].stp); | |
475 | ||
476 | cntl3 = info->scsi.cfg[2]; | |
477 | if (info->device[target].period >= (200 / 4)) | |
478 | cntl3 = cntl3 & ~CNTL3_FASTSCSI; | |
479 | ||
480 | fas216_writeb(info, REG_CNTL3, cntl3); | |
481 | } | |
482 | ||
483 | /* Synchronous transfer support | |
484 | * | |
485 | * Note: The SCSI II r10 spec says (5.6.12): | |
486 | * | |
487 | * (2) Due to historical problems with early host adapters that could | |
488 | * not accept an SDTR message, some targets may not initiate synchronous | |
489 | * negotiation after a power cycle as required by this standard. Host | |
490 | * adapters that support synchronous mode may avoid the ensuing failure | |
491 | * modes when the target is independently power cycled by initiating a | |
492 | * synchronous negotiation on each REQUEST SENSE and INQUIRY command. | |
493 | * This approach increases the SCSI bus overhead and is not recommended | |
494 | * for new implementations. The correct method is to respond to an | |
495 | * SDTR message with a MESSAGE REJECT message if the either the | |
496 | * initiator or target devices does not support synchronous transfers | |
497 | * or does not want to negotiate for synchronous transfers at the time. | |
498 | * Using the correct method assures compatibility with wide data | |
499 | * transfers and future enhancements. | |
500 | * | |
501 | * We will always initiate a synchronous transfer negotiation request on | |
502 | * every INQUIRY or REQUEST SENSE message, unless the target itself has | |
503 | * at some point performed a synchronous transfer negotiation request, or | |
504 | * we have synchronous transfers disabled for this device. | |
505 | */ | |
506 | ||
507 | /** | |
508 | * fas216_handlesync - Handle a synchronous transfer message | |
509 | * @info: state structure for interface | |
510 | * @msg: message from target | |
511 | * | |
512 | * Handle a synchronous transfer message from the target | |
513 | */ | |
514 | static void fas216_handlesync(FAS216_Info *info, char *msg) | |
515 | { | |
516 | struct fas216_device *dev = &info->device[info->SCpnt->device->id]; | |
517 | enum { sync, async, none, reject } res = none; | |
518 | ||
519 | #ifdef SCSI2_SYNC | |
520 | switch (msg[0]) { | |
521 | case MESSAGE_REJECT: | |
522 | /* Synchronous transfer request failed. | |
523 | * Note: SCSI II r10: | |
524 | * | |
525 | * SCSI devices that are capable of synchronous | |
526 | * data transfers shall not respond to an SDTR | |
527 | * message with a MESSAGE REJECT message. | |
528 | * | |
529 | * Hence, if we get this condition, we disable | |
530 | * negotiation for this device. | |
531 | */ | |
532 | if (dev->sync_state == neg_inprogress) { | |
533 | dev->sync_state = neg_invalid; | |
534 | res = async; | |
535 | } | |
536 | break; | |
537 | ||
538 | case EXTENDED_MESSAGE: | |
539 | switch (dev->sync_state) { | |
540 | /* We don't accept synchronous transfer requests. | |
541 | * Respond with a MESSAGE_REJECT to prevent a | |
542 | * synchronous transfer agreement from being reached. | |
543 | */ | |
544 | case neg_invalid: | |
545 | res = reject; | |
546 | break; | |
547 | ||
548 | /* We were not negotiating a synchronous transfer, | |
549 | * but the device sent us a negotiation request. | |
550 | * Honour the request by sending back a SDTR | |
551 | * message containing our capability, limited by | |
552 | * the targets capability. | |
553 | */ | |
554 | default: | |
555 | fas216_cmd(info, CMD_SETATN); | |
556 | if (msg[4] > info->ifcfg.sync_max_depth) | |
557 | msg[4] = info->ifcfg.sync_max_depth; | |
558 | if (msg[3] < 1000 / info->ifcfg.clockrate) | |
559 | msg[3] = 1000 / info->ifcfg.clockrate; | |
560 | ||
561 | msgqueue_flush(&info->scsi.msgs); | |
562 | msgqueue_addmsg(&info->scsi.msgs, 5, | |
563 | EXTENDED_MESSAGE, 3, EXTENDED_SDTR, | |
564 | msg[3], msg[4]); | |
565 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
566 | ||
567 | /* This is wrong. The agreement is not in effect | |
568 | * until this message is accepted by the device | |
569 | */ | |
570 | dev->sync_state = neg_targcomplete; | |
571 | res = sync; | |
572 | break; | |
573 | ||
574 | /* We initiated the synchronous transfer negotiation, | |
575 | * and have successfully received a response from the | |
576 | * target. The synchronous transfer agreement has been | |
577 | * reached. Note: if the values returned are out of our | |
578 | * bounds, we must reject the message. | |
579 | */ | |
580 | case neg_inprogress: | |
581 | res = reject; | |
582 | if (msg[4] <= info->ifcfg.sync_max_depth && | |
583 | msg[3] >= 1000 / info->ifcfg.clockrate) { | |
584 | dev->sync_state = neg_complete; | |
585 | res = sync; | |
586 | } | |
587 | break; | |
588 | } | |
589 | } | |
590 | #else | |
591 | res = reject; | |
592 | #endif | |
593 | ||
594 | switch (res) { | |
595 | case sync: | |
596 | dev->period = msg[3]; | |
597 | dev->sof = msg[4]; | |
598 | dev->stp = fas216_syncperiod(info, msg[3] * 4); | |
599 | fas216_set_sync(info, info->SCpnt->device->id); | |
600 | break; | |
601 | ||
602 | case reject: | |
603 | fas216_cmd(info, CMD_SETATN); | |
604 | msgqueue_flush(&info->scsi.msgs); | |
605 | msgqueue_addmsg(&info->scsi.msgs, 1, MESSAGE_REJECT); | |
606 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
607 | ||
608 | case async: | |
609 | dev->period = info->ifcfg.asyncperiod / 4; | |
610 | dev->sof = 0; | |
611 | dev->stp = info->scsi.async_stp; | |
612 | fas216_set_sync(info, info->SCpnt->device->id); | |
613 | break; | |
614 | ||
615 | case none: | |
616 | break; | |
617 | } | |
618 | } | |
619 | ||
620 | /** | |
621 | * fas216_updateptrs - update data pointers after transfer suspended/paused | |
622 | * @info: interface's local pointer to update | |
623 | * @bytes_transferred: number of bytes transferred | |
624 | * | |
625 | * Update data pointers after transfer suspended/paused | |
626 | */ | |
627 | static void fas216_updateptrs(FAS216_Info *info, int bytes_transferred) | |
628 | { | |
0a04137e | 629 | struct scsi_pointer *SCp = &info->scsi.SCp; |
1da177e4 LT |
630 | |
631 | fas216_checkmagic(info); | |
632 | ||
633 | BUG_ON(bytes_transferred < 0); | |
634 | ||
6b4df7ee | 635 | SCp->phase -= bytes_transferred; |
1da177e4 LT |
636 | |
637 | while (bytes_transferred != 0) { | |
638 | if (SCp->this_residual > bytes_transferred) | |
639 | break; | |
640 | /* | |
641 | * We have used up this buffer. Move on to the | |
642 | * next buffer. | |
643 | */ | |
644 | bytes_transferred -= SCp->this_residual; | |
645 | if (!next_SCp(SCp) && bytes_transferred) { | |
646 | printk(KERN_WARNING "scsi%d.%c: out of buffers\n", | |
647 | info->host->host_no, '0' + info->SCpnt->device->id); | |
648 | return; | |
649 | } | |
650 | } | |
651 | ||
652 | SCp->this_residual -= bytes_transferred; | |
653 | if (SCp->this_residual) | |
654 | SCp->ptr += bytes_transferred; | |
655 | else | |
656 | SCp->ptr = NULL; | |
657 | } | |
658 | ||
659 | /** | |
660 | * fas216_pio - transfer data off of/on to card using programmed IO | |
661 | * @info: interface to transfer data to/from | |
662 | * @direction: direction to transfer data (DMA_OUT/DMA_IN) | |
663 | * | |
664 | * Transfer data off of/on to card using programmed IO. | |
665 | * Notes: this is incredibly slow. | |
666 | */ | |
667 | static void fas216_pio(FAS216_Info *info, fasdmadir_t direction) | |
668 | { | |
0a04137e | 669 | struct scsi_pointer *SCp = &info->scsi.SCp; |
1da177e4 LT |
670 | |
671 | fas216_checkmagic(info); | |
672 | ||
673 | if (direction == DMA_OUT) | |
674 | fas216_writeb(info, REG_FF, get_next_SCp_byte(SCp)); | |
675 | else | |
676 | put_next_SCp_byte(SCp, fas216_readb(info, REG_FF)); | |
677 | ||
678 | if (SCp->this_residual == 0) | |
679 | next_SCp(SCp); | |
680 | } | |
681 | ||
682 | static void fas216_set_stc(FAS216_Info *info, unsigned int length) | |
683 | { | |
684 | fas216_writeb(info, REG_STCL, length); | |
685 | fas216_writeb(info, REG_STCM, length >> 8); | |
686 | fas216_writeb(info, REG_STCH, length >> 16); | |
687 | } | |
688 | ||
689 | static unsigned int fas216_get_ctc(FAS216_Info *info) | |
690 | { | |
691 | return fas216_readb(info, REG_CTCL) + | |
692 | (fas216_readb(info, REG_CTCM) << 8) + | |
693 | (fas216_readb(info, REG_CTCH) << 16); | |
694 | } | |
695 | ||
696 | /** | |
697 | * fas216_cleanuptransfer - clean up after a transfer has completed. | |
698 | * @info: interface to clean up | |
699 | * | |
700 | * Update the data pointers according to the number of bytes transferred | |
701 | * on the SCSI bus. | |
702 | */ | |
703 | static void fas216_cleanuptransfer(FAS216_Info *info) | |
704 | { | |
705 | unsigned long total, residual, fifo; | |
706 | fasdmatype_t dmatype = info->dma.transfer_type; | |
707 | ||
708 | info->dma.transfer_type = fasdma_none; | |
709 | ||
710 | /* | |
711 | * PIO transfers do not need to be cleaned up. | |
712 | */ | |
713 | if (dmatype == fasdma_pio || dmatype == fasdma_none) | |
714 | return; | |
715 | ||
716 | if (dmatype == fasdma_real_all) | |
6b4df7ee | 717 | total = info->scsi.SCp.phase; |
1da177e4 LT |
718 | else |
719 | total = info->scsi.SCp.this_residual; | |
720 | ||
721 | residual = fas216_get_ctc(info); | |
722 | ||
723 | fifo = fas216_readb(info, REG_CFIS) & CFIS_CF; | |
724 | ||
725 | fas216_log(info, LOG_BUFFER, "cleaning up from previous " | |
726 | "transfer: length 0x%06x, residual 0x%x, fifo %d", | |
727 | total, residual, fifo); | |
728 | ||
729 | /* | |
730 | * If we were performing Data-Out, the transfer counter | |
731 | * counts down each time a byte is transferred by the | |
732 | * host to the FIFO. This means we must include the | |
733 | * bytes left in the FIFO from the transfer counter. | |
734 | */ | |
735 | if (info->scsi.phase == PHASE_DATAOUT) | |
736 | residual += fifo; | |
737 | ||
738 | fas216_updateptrs(info, total - residual); | |
739 | } | |
740 | ||
741 | /** | |
742 | * fas216_transfer - Perform a DMA/PIO transfer off of/on to card | |
743 | * @info: interface from which device disconnected from | |
744 | * | |
745 | * Start a DMA/PIO transfer off of/on to card | |
746 | */ | |
747 | static void fas216_transfer(FAS216_Info *info) | |
748 | { | |
749 | fasdmadir_t direction; | |
750 | fasdmatype_t dmatype; | |
751 | ||
752 | fas216_log(info, LOG_BUFFER, | |
753 | "starttransfer: buffer %p length 0x%06x reqlen 0x%06x", | |
754 | info->scsi.SCp.ptr, info->scsi.SCp.this_residual, | |
6b4df7ee | 755 | info->scsi.SCp.phase); |
1da177e4 LT |
756 | |
757 | if (!info->scsi.SCp.ptr) { | |
758 | fas216_log(info, LOG_ERROR, "null buffer passed to " | |
759 | "fas216_starttransfer"); | |
760 | print_SCp(&info->scsi.SCp, "SCp: ", "\n"); | |
761 | print_SCp(&info->SCpnt->SCp, "Cmnd SCp: ", "\n"); | |
762 | return; | |
763 | } | |
764 | ||
765 | /* | |
766 | * If we have a synchronous transfer agreement in effect, we must | |
767 | * use DMA mode. If we are using asynchronous transfers, we may | |
768 | * use DMA mode or PIO mode. | |
769 | */ | |
770 | if (info->device[info->SCpnt->device->id].sof) | |
771 | dmatype = fasdma_real_all; | |
772 | else | |
773 | dmatype = fasdma_pio; | |
774 | ||
775 | if (info->scsi.phase == PHASE_DATAOUT) | |
776 | direction = DMA_OUT; | |
777 | else | |
778 | direction = DMA_IN; | |
779 | ||
780 | if (info->dma.setup) | |
781 | dmatype = info->dma.setup(info->host, &info->scsi.SCp, | |
782 | direction, dmatype); | |
783 | info->dma.transfer_type = dmatype; | |
784 | ||
785 | if (dmatype == fasdma_real_all) | |
6b4df7ee | 786 | fas216_set_stc(info, info->scsi.SCp.phase); |
1da177e4 LT |
787 | else |
788 | fas216_set_stc(info, info->scsi.SCp.this_residual); | |
789 | ||
790 | switch (dmatype) { | |
791 | case fasdma_pio: | |
792 | fas216_log(info, LOG_BUFFER, "PIO transfer"); | |
793 | fas216_writeb(info, REG_SOF, 0); | |
794 | fas216_writeb(info, REG_STP, info->scsi.async_stp); | |
795 | fas216_cmd(info, CMD_TRANSFERINFO); | |
796 | fas216_pio(info, direction); | |
797 | break; | |
798 | ||
799 | case fasdma_pseudo: | |
800 | fas216_log(info, LOG_BUFFER, "pseudo transfer"); | |
801 | fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA); | |
802 | info->dma.pseudo(info->host, &info->scsi.SCp, | |
803 | direction, info->SCpnt->transfersize); | |
804 | break; | |
805 | ||
806 | case fasdma_real_block: | |
807 | fas216_log(info, LOG_BUFFER, "block dma transfer"); | |
808 | fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA); | |
809 | break; | |
810 | ||
811 | case fasdma_real_all: | |
812 | fas216_log(info, LOG_BUFFER, "total dma transfer"); | |
813 | fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA); | |
814 | break; | |
815 | ||
816 | default: | |
817 | fas216_log(info, LOG_BUFFER | LOG_ERROR, | |
818 | "invalid FAS216 DMA type"); | |
819 | break; | |
820 | } | |
821 | } | |
822 | ||
823 | /** | |
824 | * fas216_stoptransfer - Stop a DMA transfer onto / off of the card | |
825 | * @info: interface from which device disconnected from | |
826 | * | |
827 | * Called when we switch away from DATA IN or DATA OUT phases. | |
828 | */ | |
829 | static void fas216_stoptransfer(FAS216_Info *info) | |
830 | { | |
831 | fas216_checkmagic(info); | |
832 | ||
833 | if (info->dma.transfer_type == fasdma_real_all || | |
834 | info->dma.transfer_type == fasdma_real_block) | |
835 | info->dma.stop(info->host, &info->scsi.SCp); | |
836 | ||
837 | fas216_cleanuptransfer(info); | |
838 | ||
839 | if (info->scsi.phase == PHASE_DATAIN) { | |
840 | unsigned int fifo; | |
841 | ||
842 | /* | |
843 | * If we were performing Data-In, then the FIFO counter | |
844 | * contains the number of bytes not transferred via DMA | |
845 | * from the on-board FIFO. Read them manually. | |
846 | */ | |
847 | fifo = fas216_readb(info, REG_CFIS) & CFIS_CF; | |
848 | while (fifo && info->scsi.SCp.ptr) { | |
849 | *info->scsi.SCp.ptr = fas216_readb(info, REG_FF); | |
850 | fas216_updateptrs(info, 1); | |
851 | fifo--; | |
852 | } | |
853 | } else { | |
854 | /* | |
855 | * After a Data-Out phase, there may be unsent | |
856 | * bytes left in the FIFO. Flush them out. | |
857 | */ | |
858 | fas216_cmd(info, CMD_FLUSHFIFO); | |
859 | } | |
860 | } | |
861 | ||
862 | static void fas216_aborttransfer(FAS216_Info *info) | |
863 | { | |
864 | fas216_checkmagic(info); | |
865 | ||
866 | if (info->dma.transfer_type == fasdma_real_all || | |
867 | info->dma.transfer_type == fasdma_real_block) | |
868 | info->dma.stop(info->host, &info->scsi.SCp); | |
869 | ||
870 | info->dma.transfer_type = fasdma_none; | |
871 | fas216_cmd(info, CMD_FLUSHFIFO); | |
872 | } | |
873 | ||
874 | static void fas216_kick(FAS216_Info *info); | |
875 | ||
876 | /** | |
877 | * fas216_disconnected_intr - handle device disconnection | |
878 | * @info: interface from which device disconnected from | |
879 | * | |
880 | * Handle device disconnection | |
881 | */ | |
882 | static void fas216_disconnect_intr(FAS216_Info *info) | |
883 | { | |
884 | unsigned long flags; | |
885 | ||
886 | fas216_checkmagic(info); | |
887 | ||
888 | fas216_log(info, LOG_CONNECT, "disconnect phase=%02x", | |
889 | info->scsi.phase); | |
890 | ||
891 | msgqueue_flush(&info->scsi.msgs); | |
892 | ||
893 | switch (info->scsi.phase) { | |
894 | case PHASE_SELECTION: /* while selecting - no target */ | |
895 | case PHASE_SELSTEPS: | |
896 | fas216_done(info, DID_NO_CONNECT); | |
897 | break; | |
898 | ||
899 | case PHASE_MSGIN_DISCONNECT: /* message in - disconnecting */ | |
900 | info->scsi.disconnectable = 1; | |
901 | info->scsi.phase = PHASE_IDLE; | |
902 | info->stats.disconnects += 1; | |
903 | spin_lock_irqsave(&info->host_lock, flags); | |
904 | if (info->scsi.phase == PHASE_IDLE) | |
905 | fas216_kick(info); | |
906 | spin_unlock_irqrestore(&info->host_lock, flags); | |
907 | break; | |
908 | ||
909 | case PHASE_DONE: /* at end of command - complete */ | |
910 | fas216_done(info, DID_OK); | |
911 | break; | |
912 | ||
913 | case PHASE_MSGOUT: /* message out - possible ABORT message */ | |
914 | if (fas216_get_last_msg(info, info->scsi.msgin_fifo) == ABORT) { | |
915 | info->scsi.aborting = 0; | |
916 | fas216_done(info, DID_ABORT); | |
917 | break; | |
918 | } | |
919 | ||
920 | default: /* huh? */ | |
921 | printk(KERN_ERR "scsi%d.%c: unexpected disconnect in phase %s\n", | |
922 | info->host->host_no, fas216_target(info), fas216_drv_phase(info)); | |
923 | print_debug_list(); | |
924 | fas216_stoptransfer(info); | |
925 | fas216_done(info, DID_ERROR); | |
926 | break; | |
927 | } | |
928 | } | |
929 | ||
930 | /** | |
931 | * fas216_reselected_intr - start reconnection of a device | |
932 | * @info: interface which was reselected | |
933 | * | |
934 | * Start reconnection of a device | |
935 | */ | |
936 | static void | |
937 | fas216_reselected_intr(FAS216_Info *info) | |
938 | { | |
939 | unsigned int cfis, i; | |
940 | unsigned char msg[4]; | |
941 | unsigned char target, lun, tag; | |
942 | ||
943 | fas216_checkmagic(info); | |
944 | ||
945 | WARN_ON(info->scsi.phase == PHASE_SELECTION || | |
946 | info->scsi.phase == PHASE_SELSTEPS); | |
947 | ||
948 | cfis = fas216_readb(info, REG_CFIS); | |
949 | ||
950 | fas216_log(info, LOG_CONNECT, "reconnect phase=%02x cfis=%02x", | |
951 | info->scsi.phase, cfis); | |
952 | ||
953 | cfis &= CFIS_CF; | |
954 | ||
955 | if (cfis < 2 || cfis > 4) { | |
956 | printk(KERN_ERR "scsi%d.H: incorrect number of bytes after reselect\n", | |
957 | info->host->host_no); | |
958 | goto bad_message; | |
959 | } | |
960 | ||
961 | for (i = 0; i < cfis; i++) | |
962 | msg[i] = fas216_readb(info, REG_FF); | |
963 | ||
964 | if (!(msg[0] & (1 << info->host->this_id)) || | |
965 | !(msg[1] & 0x80)) | |
966 | goto initiator_error; | |
967 | ||
968 | target = msg[0] & ~(1 << info->host->this_id); | |
969 | target = ffs(target) - 1; | |
970 | lun = msg[1] & 7; | |
971 | tag = 0; | |
972 | ||
973 | if (cfis >= 3) { | |
974 | if (msg[2] != SIMPLE_QUEUE_TAG) | |
975 | goto initiator_error; | |
976 | ||
977 | tag = msg[3]; | |
978 | } | |
979 | ||
980 | /* set up for synchronous transfers */ | |
981 | fas216_writeb(info, REG_SDID, target); | |
982 | fas216_set_sync(info, target); | |
983 | msgqueue_flush(&info->scsi.msgs); | |
984 | ||
985 | fas216_log(info, LOG_CONNECT, "Reconnected: target %1x lun %1x tag %02x", | |
986 | target, lun, tag); | |
987 | ||
988 | if (info->scsi.disconnectable && info->SCpnt) { | |
989 | info->scsi.disconnectable = 0; | |
990 | if (info->SCpnt->device->id == target && | |
991 | info->SCpnt->device->lun == lun && | |
992 | info->SCpnt->tag == tag) { | |
993 | fas216_log(info, LOG_CONNECT, "reconnected previously executing command"); | |
994 | } else { | |
995 | queue_add_cmd_tail(&info->queues.disconnected, info->SCpnt); | |
996 | fas216_log(info, LOG_CONNECT, "had to move command to disconnected queue"); | |
997 | info->SCpnt = NULL; | |
998 | } | |
999 | } | |
1000 | if (!info->SCpnt) { | |
1001 | info->SCpnt = queue_remove_tgtluntag(&info->queues.disconnected, | |
1002 | target, lun, tag); | |
1003 | fas216_log(info, LOG_CONNECT, "had to get command"); | |
1004 | } | |
1005 | ||
1006 | if (info->SCpnt) { | |
1007 | /* | |
1008 | * Restore data pointer from SAVED data pointer | |
1009 | */ | |
1010 | info->scsi.SCp = info->SCpnt->SCp; | |
1011 | ||
1012 | fas216_log(info, LOG_CONNECT, "data pointers: [%p, %X]", | |
1013 | info->scsi.SCp.ptr, info->scsi.SCp.this_residual); | |
1014 | info->scsi.phase = PHASE_MSGIN; | |
1015 | } else { | |
1016 | /* | |
1017 | * Our command structure not found - abort the | |
1018 | * command on the target. Since we have no | |
1019 | * record of this command, we can't send | |
1020 | * an INITIATOR DETECTED ERROR message. | |
1021 | */ | |
1022 | fas216_cmd(info, CMD_SETATN); | |
1023 | ||
1024 | #if 0 | |
1025 | if (tag) | |
1026 | msgqueue_addmsg(&info->scsi.msgs, 2, ABORT_TAG, tag); | |
1027 | else | |
1028 | #endif | |
1029 | msgqueue_addmsg(&info->scsi.msgs, 1, ABORT); | |
1030 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
1031 | info->scsi.aborting = 1; | |
1032 | } | |
1033 | ||
1034 | fas216_cmd(info, CMD_MSGACCEPTED); | |
1035 | return; | |
1036 | ||
1037 | initiator_error: | |
1038 | printk(KERN_ERR "scsi%d.H: error during reselection: bytes", | |
1039 | info->host->host_no); | |
1040 | for (i = 0; i < cfis; i++) | |
1041 | printk(" %02x", msg[i]); | |
1042 | printk("\n"); | |
1043 | bad_message: | |
1044 | fas216_cmd(info, CMD_SETATN); | |
1045 | msgqueue_flush(&info->scsi.msgs); | |
1046 | msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR); | |
1047 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
1048 | fas216_cmd(info, CMD_MSGACCEPTED); | |
1049 | } | |
1050 | ||
1051 | static void fas216_parse_message(FAS216_Info *info, unsigned char *message, int msglen) | |
1052 | { | |
1053 | int i; | |
1054 | ||
1055 | switch (message[0]) { | |
1056 | case COMMAND_COMPLETE: | |
1057 | if (msglen != 1) | |
1058 | goto unrecognised; | |
1059 | ||
1060 | printk(KERN_ERR "scsi%d.%c: command complete with no " | |
1061 | "status in MESSAGE_IN?\n", | |
1062 | info->host->host_no, fas216_target(info)); | |
1063 | break; | |
1064 | ||
1065 | case SAVE_POINTERS: | |
1066 | if (msglen != 1) | |
1067 | goto unrecognised; | |
1068 | ||
1069 | /* | |
1070 | * Save current data pointer to SAVED data pointer | |
1071 | * SCSI II standard says that we must not acknowledge | |
1072 | * this until we have really saved pointers. | |
1073 | * NOTE: we DO NOT save the command nor status pointers | |
1074 | * as required by the SCSI II standard. These always | |
1075 | * point to the start of their respective areas. | |
1076 | */ | |
1077 | info->SCpnt->SCp = info->scsi.SCp; | |
1078 | info->SCpnt->SCp.sent_command = 0; | |
1079 | fas216_log(info, LOG_CONNECT | LOG_MESSAGES | LOG_BUFFER, | |
1080 | "save data pointers: [%p, %X]", | |
1081 | info->scsi.SCp.ptr, info->scsi.SCp.this_residual); | |
1082 | break; | |
1083 | ||
1084 | case RESTORE_POINTERS: | |
1085 | if (msglen != 1) | |
1086 | goto unrecognised; | |
1087 | ||
1088 | /* | |
1089 | * Restore current data pointer from SAVED data pointer | |
1090 | */ | |
1091 | info->scsi.SCp = info->SCpnt->SCp; | |
1092 | fas216_log(info, LOG_CONNECT | LOG_MESSAGES | LOG_BUFFER, | |
1093 | "restore data pointers: [%p, 0x%x]", | |
1094 | info->scsi.SCp.ptr, info->scsi.SCp.this_residual); | |
1095 | break; | |
1096 | ||
1097 | case DISCONNECT: | |
1098 | if (msglen != 1) | |
1099 | goto unrecognised; | |
1100 | ||
1101 | info->scsi.phase = PHASE_MSGIN_DISCONNECT; | |
1102 | break; | |
1103 | ||
1104 | case MESSAGE_REJECT: | |
1105 | if (msglen != 1) | |
1106 | goto unrecognised; | |
1107 | ||
1108 | switch (fas216_get_last_msg(info, info->scsi.msgin_fifo)) { | |
1109 | case EXTENDED_MESSAGE | EXTENDED_SDTR << 8: | |
1110 | fas216_handlesync(info, message); | |
1111 | break; | |
1112 | ||
1113 | default: | |
1114 | fas216_log(info, 0, "reject, last message 0x%04x", | |
1115 | fas216_get_last_msg(info, info->scsi.msgin_fifo)); | |
1116 | } | |
1117 | break; | |
1118 | ||
1119 | case NOP: | |
1120 | break; | |
1121 | ||
1122 | case EXTENDED_MESSAGE: | |
1123 | if (msglen < 3) | |
1124 | goto unrecognised; | |
1125 | ||
1126 | switch (message[2]) { | |
1127 | case EXTENDED_SDTR: /* Sync transfer negotiation request/reply */ | |
1128 | fas216_handlesync(info, message); | |
1129 | break; | |
1130 | ||
1131 | default: | |
1132 | goto unrecognised; | |
1133 | } | |
1134 | break; | |
1135 | ||
1136 | default: | |
1137 | goto unrecognised; | |
1138 | } | |
1139 | return; | |
1140 | ||
1141 | unrecognised: | |
1142 | fas216_log(info, 0, "unrecognised message, rejecting"); | |
1143 | printk("scsi%d.%c: message was", info->host->host_no, fas216_target(info)); | |
1144 | for (i = 0; i < msglen; i++) | |
1145 | printk("%s%02X", i & 31 ? " " : "\n ", message[i]); | |
1146 | printk("\n"); | |
1147 | ||
1148 | /* | |
1149 | * Something strange seems to be happening here - | |
1150 | * I can't use SETATN since the chip gives me an | |
1151 | * invalid command interrupt when I do. Weird. | |
1152 | */ | |
1153 | fas216_cmd(info, CMD_NOP); | |
1154 | fas216_dumpstate(info); | |
1155 | fas216_cmd(info, CMD_SETATN); | |
1156 | msgqueue_flush(&info->scsi.msgs); | |
1157 | msgqueue_addmsg(&info->scsi.msgs, 1, MESSAGE_REJECT); | |
1158 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
1159 | fas216_dumpstate(info); | |
1160 | } | |
1161 | ||
1162 | static int fas216_wait_cmd(FAS216_Info *info, int cmd) | |
1163 | { | |
1164 | int tout; | |
1165 | int stat; | |
1166 | ||
1167 | fas216_cmd(info, cmd); | |
1168 | ||
1169 | for (tout = 1000; tout; tout -= 1) { | |
1170 | stat = fas216_readb(info, REG_STAT); | |
1171 | if (stat & (STAT_INT|STAT_PARITYERROR)) | |
1172 | break; | |
1173 | udelay(1); | |
1174 | } | |
1175 | ||
1176 | return stat; | |
1177 | } | |
1178 | ||
1179 | static int fas216_get_msg_byte(FAS216_Info *info) | |
1180 | { | |
1181 | unsigned int stat = fas216_wait_cmd(info, CMD_MSGACCEPTED); | |
1182 | ||
1183 | if ((stat & STAT_INT) == 0) | |
1184 | goto timedout; | |
1185 | ||
1186 | if ((stat & STAT_BUSMASK) != STAT_MESGIN) | |
1187 | goto unexpected_phase_change; | |
1188 | ||
1189 | fas216_readb(info, REG_INST); | |
1190 | ||
1191 | stat = fas216_wait_cmd(info, CMD_TRANSFERINFO); | |
1192 | ||
1193 | if ((stat & STAT_INT) == 0) | |
1194 | goto timedout; | |
1195 | ||
1196 | if (stat & STAT_PARITYERROR) | |
1197 | goto parity_error; | |
1198 | ||
1199 | if ((stat & STAT_BUSMASK) != STAT_MESGIN) | |
1200 | goto unexpected_phase_change; | |
1201 | ||
1202 | fas216_readb(info, REG_INST); | |
1203 | ||
1204 | return fas216_readb(info, REG_FF); | |
1205 | ||
1206 | timedout: | |
1207 | fas216_log(info, LOG_ERROR, "timed out waiting for message byte"); | |
1208 | return -1; | |
1209 | ||
1210 | unexpected_phase_change: | |
1211 | fas216_log(info, LOG_ERROR, "unexpected phase change: status = %02x", stat); | |
1212 | return -2; | |
1213 | ||
1214 | parity_error: | |
1215 | fas216_log(info, LOG_ERROR, "parity error during message in phase"); | |
1216 | return -3; | |
1217 | } | |
1218 | ||
1219 | /** | |
1220 | * fas216_message - handle a function done interrupt from FAS216 chip | |
1221 | * @info: interface which caused function done interrupt | |
1222 | * | |
1223 | * Handle a function done interrupt from FAS216 chip | |
1224 | */ | |
1225 | static void fas216_message(FAS216_Info *info) | |
1226 | { | |
1227 | unsigned char *message = info->scsi.message; | |
1228 | unsigned int msglen = 1; | |
1229 | int msgbyte = 0; | |
1230 | ||
1231 | fas216_checkmagic(info); | |
1232 | ||
1233 | message[0] = fas216_readb(info, REG_FF); | |
1234 | ||
1235 | if (message[0] == EXTENDED_MESSAGE) { | |
1236 | msgbyte = fas216_get_msg_byte(info); | |
1237 | ||
1238 | if (msgbyte >= 0) { | |
1239 | message[1] = msgbyte; | |
1240 | ||
1241 | for (msglen = 2; msglen < message[1] + 2; msglen++) { | |
1242 | msgbyte = fas216_get_msg_byte(info); | |
1243 | ||
1244 | if (msgbyte >= 0) | |
1245 | message[msglen] = msgbyte; | |
1246 | else | |
1247 | break; | |
1248 | } | |
1249 | } | |
1250 | } | |
1251 | ||
1252 | if (msgbyte == -3) | |
1253 | goto parity_error; | |
1254 | ||
1255 | #ifdef DEBUG_MESSAGES | |
1256 | { | |
1257 | int i; | |
1258 | ||
1259 | printk("scsi%d.%c: message in: ", | |
1260 | info->host->host_no, fas216_target(info)); | |
1261 | for (i = 0; i < msglen; i++) | |
1262 | printk("%02X ", message[i]); | |
1263 | printk("\n"); | |
1264 | } | |
1265 | #endif | |
1266 | ||
1267 | fas216_parse_message(info, message, msglen); | |
1268 | fas216_cmd(info, CMD_MSGACCEPTED); | |
1269 | return; | |
1270 | ||
1271 | parity_error: | |
1272 | fas216_cmd(info, CMD_SETATN); | |
1273 | msgqueue_flush(&info->scsi.msgs); | |
1274 | msgqueue_addmsg(&info->scsi.msgs, 1, MSG_PARITY_ERROR); | |
1275 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
1276 | fas216_cmd(info, CMD_MSGACCEPTED); | |
1277 | return; | |
1278 | } | |
1279 | ||
1280 | /** | |
1281 | * fas216_send_command - send command after all message bytes have been sent | |
1282 | * @info: interface which caused bus service | |
1283 | * | |
1284 | * Send a command to a target after all message bytes have been sent | |
1285 | */ | |
1286 | static void fas216_send_command(FAS216_Info *info) | |
1287 | { | |
1288 | int i; | |
1289 | ||
1290 | fas216_checkmagic(info); | |
1291 | ||
1292 | fas216_cmd(info, CMD_NOP|CMD_WITHDMA); | |
1293 | fas216_cmd(info, CMD_FLUSHFIFO); | |
1294 | ||
1295 | /* load command */ | |
1296 | for (i = info->scsi.SCp.sent_command; i < info->SCpnt->cmd_len; i++) | |
1297 | fas216_writeb(info, REG_FF, info->SCpnt->cmnd[i]); | |
1298 | ||
1299 | fas216_cmd(info, CMD_TRANSFERINFO); | |
1300 | ||
1301 | info->scsi.phase = PHASE_COMMAND; | |
1302 | } | |
1303 | ||
1304 | /** | |
1305 | * fas216_send_messageout - handle bus service to send a message | |
1306 | * @info: interface which caused bus service | |
1307 | * | |
1308 | * Handle bus service to send a message. | |
1309 | * Note: We do not allow the device to change the data direction! | |
1310 | */ | |
1311 | static void fas216_send_messageout(FAS216_Info *info, int start) | |
1312 | { | |
1313 | unsigned int tot_msglen = msgqueue_msglength(&info->scsi.msgs); | |
1314 | ||
1315 | fas216_checkmagic(info); | |
1316 | ||
1317 | fas216_cmd(info, CMD_FLUSHFIFO); | |
1318 | ||
1319 | if (tot_msglen) { | |
1320 | struct message *msg; | |
1321 | int msgnr = 0; | |
1322 | ||
1323 | while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) { | |
1324 | int i; | |
1325 | ||
1326 | for (i = start; i < msg->length; i++) | |
1327 | fas216_writeb(info, REG_FF, msg->msg[i]); | |
1328 | ||
1329 | msg->fifo = tot_msglen - (fas216_readb(info, REG_CFIS) & CFIS_CF); | |
1330 | start = 0; | |
1331 | } | |
1332 | } else | |
1333 | fas216_writeb(info, REG_FF, NOP); | |
1334 | ||
1335 | fas216_cmd(info, CMD_TRANSFERINFO); | |
1336 | ||
1337 | info->scsi.phase = PHASE_MSGOUT; | |
1338 | } | |
1339 | ||
1340 | /** | |
1341 | * fas216_busservice_intr - handle bus service interrupt from FAS216 chip | |
1342 | * @info: interface which caused bus service interrupt | |
1343 | * @stat: Status register contents | |
1344 | * @is: SCSI Status register contents | |
1345 | * | |
1346 | * Handle a bus service interrupt from FAS216 chip | |
1347 | */ | |
1348 | static void fas216_busservice_intr(FAS216_Info *info, unsigned int stat, unsigned int is) | |
1349 | { | |
1350 | fas216_checkmagic(info); | |
1351 | ||
1352 | fas216_log(info, LOG_BUSSERVICE, | |
1353 | "bus service: stat=%02x is=%02x phase=%02x", | |
1354 | stat, is, info->scsi.phase); | |
1355 | ||
1356 | switch (info->scsi.phase) { | |
1357 | case PHASE_SELECTION: | |
1358 | if ((is & IS_BITS) != IS_MSGBYTESENT) | |
1359 | goto bad_is; | |
1360 | break; | |
1361 | ||
1362 | case PHASE_SELSTEPS: | |
1363 | switch (is & IS_BITS) { | |
1364 | case IS_SELARB: | |
1365 | case IS_MSGBYTESENT: | |
1366 | goto bad_is; | |
1367 | ||
1368 | case IS_NOTCOMMAND: | |
1369 | case IS_EARLYPHASE: | |
1370 | if ((stat & STAT_BUSMASK) == STAT_MESGIN) | |
1371 | break; | |
1372 | goto bad_is; | |
1373 | ||
1374 | case IS_COMPLETE: | |
1375 | break; | |
1376 | } | |
1377 | ||
1378 | default: | |
1379 | break; | |
1380 | } | |
1381 | ||
1382 | fas216_cmd(info, CMD_NOP); | |
1383 | ||
1384 | #define STATE(st,ph) ((ph) << 3 | (st)) | |
1385 | /* This table describes the legal SCSI state transitions, | |
1386 | * as described by the SCSI II spec. | |
1387 | */ | |
1388 | switch (STATE(stat & STAT_BUSMASK, info->scsi.phase)) { | |
1389 | case STATE(STAT_DATAIN, PHASE_SELSTEPS):/* Sel w/ steps -> Data In */ | |
1390 | case STATE(STAT_DATAIN, PHASE_MSGOUT): /* Message Out -> Data In */ | |
1391 | case STATE(STAT_DATAIN, PHASE_COMMAND): /* Command -> Data In */ | |
1392 | case STATE(STAT_DATAIN, PHASE_MSGIN): /* Message In -> Data In */ | |
1393 | info->scsi.phase = PHASE_DATAIN; | |
1394 | fas216_transfer(info); | |
1395 | return; | |
1396 | ||
1397 | case STATE(STAT_DATAIN, PHASE_DATAIN): /* Data In -> Data In */ | |
1398 | case STATE(STAT_DATAOUT, PHASE_DATAOUT):/* Data Out -> Data Out */ | |
1399 | fas216_cleanuptransfer(info); | |
1400 | fas216_transfer(info); | |
1401 | return; | |
1402 | ||
1403 | case STATE(STAT_DATAOUT, PHASE_SELSTEPS):/* Sel w/ steps-> Data Out */ | |
1404 | case STATE(STAT_DATAOUT, PHASE_MSGOUT): /* Message Out -> Data Out */ | |
1405 | case STATE(STAT_DATAOUT, PHASE_COMMAND):/* Command -> Data Out */ | |
1406 | case STATE(STAT_DATAOUT, PHASE_MSGIN): /* Message In -> Data Out */ | |
1407 | fas216_cmd(info, CMD_FLUSHFIFO); | |
1408 | info->scsi.phase = PHASE_DATAOUT; | |
1409 | fas216_transfer(info); | |
1410 | return; | |
1411 | ||
1412 | case STATE(STAT_STATUS, PHASE_DATAOUT): /* Data Out -> Status */ | |
1413 | case STATE(STAT_STATUS, PHASE_DATAIN): /* Data In -> Status */ | |
1414 | fas216_stoptransfer(info); | |
1415 | case STATE(STAT_STATUS, PHASE_SELSTEPS):/* Sel w/ steps -> Status */ | |
1416 | case STATE(STAT_STATUS, PHASE_MSGOUT): /* Message Out -> Status */ | |
1417 | case STATE(STAT_STATUS, PHASE_COMMAND): /* Command -> Status */ | |
1418 | case STATE(STAT_STATUS, PHASE_MSGIN): /* Message In -> Status */ | |
1419 | fas216_cmd(info, CMD_INITCMDCOMPLETE); | |
1420 | info->scsi.phase = PHASE_STATUS; | |
1421 | return; | |
1422 | ||
1423 | case STATE(STAT_MESGIN, PHASE_DATAOUT): /* Data Out -> Message In */ | |
1424 | case STATE(STAT_MESGIN, PHASE_DATAIN): /* Data In -> Message In */ | |
1425 | fas216_stoptransfer(info); | |
1426 | case STATE(STAT_MESGIN, PHASE_COMMAND): /* Command -> Message In */ | |
1427 | case STATE(STAT_MESGIN, PHASE_SELSTEPS):/* Sel w/ steps -> Message In */ | |
1428 | case STATE(STAT_MESGIN, PHASE_MSGOUT): /* Message Out -> Message In */ | |
1429 | info->scsi.msgin_fifo = fas216_readb(info, REG_CFIS) & CFIS_CF; | |
1430 | fas216_cmd(info, CMD_FLUSHFIFO); | |
1431 | fas216_cmd(info, CMD_TRANSFERINFO); | |
1432 | info->scsi.phase = PHASE_MSGIN; | |
1433 | return; | |
1434 | ||
1435 | case STATE(STAT_MESGIN, PHASE_MSGIN): | |
1436 | info->scsi.msgin_fifo = fas216_readb(info, REG_CFIS) & CFIS_CF; | |
1437 | fas216_cmd(info, CMD_TRANSFERINFO); | |
1438 | return; | |
1439 | ||
1440 | case STATE(STAT_COMMAND, PHASE_MSGOUT): /* Message Out -> Command */ | |
1441 | case STATE(STAT_COMMAND, PHASE_MSGIN): /* Message In -> Command */ | |
1442 | fas216_send_command(info); | |
1443 | info->scsi.phase = PHASE_COMMAND; | |
1444 | return; | |
1445 | ||
1446 | ||
1447 | /* | |
1448 | * Selection -> Message Out | |
1449 | */ | |
1450 | case STATE(STAT_MESGOUT, PHASE_SELECTION): | |
1451 | fas216_send_messageout(info, 1); | |
1452 | return; | |
1453 | ||
1454 | /* | |
1455 | * Message Out -> Message Out | |
1456 | */ | |
1457 | case STATE(STAT_MESGOUT, PHASE_SELSTEPS): | |
1458 | case STATE(STAT_MESGOUT, PHASE_MSGOUT): | |
1459 | /* | |
1460 | * If we get another message out phase, this usually | |
1461 | * means some parity error occurred. Resend complete | |
1462 | * set of messages. If we have more than one byte to | |
1463 | * send, we need to assert ATN again. | |
1464 | */ | |
1465 | if (info->device[info->SCpnt->device->id].parity_check) { | |
1466 | /* | |
1467 | * We were testing... good, the device | |
1468 | * supports parity checking. | |
1469 | */ | |
1470 | info->device[info->SCpnt->device->id].parity_check = 0; | |
1471 | info->device[info->SCpnt->device->id].parity_enabled = 1; | |
1472 | fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]); | |
1473 | } | |
1474 | ||
1475 | if (msgqueue_msglength(&info->scsi.msgs) > 1) | |
1476 | fas216_cmd(info, CMD_SETATN); | |
1477 | /*FALLTHROUGH*/ | |
1478 | ||
1479 | /* | |
1480 | * Any -> Message Out | |
1481 | */ | |
1482 | case STATE(STAT_MESGOUT, PHASE_MSGOUT_EXPECT): | |
1483 | fas216_send_messageout(info, 0); | |
1484 | return; | |
1485 | ||
1486 | /* Error recovery rules. | |
1487 | * These either attempt to abort or retry the operation. | |
1488 | * TODO: we need more of these | |
1489 | */ | |
1490 | case STATE(STAT_COMMAND, PHASE_COMMAND):/* Command -> Command */ | |
1491 | /* error - we've sent out all the command bytes | |
1492 | * we have. | |
1493 | * NOTE: we need SAVE DATA POINTERS/RESTORE DATA POINTERS | |
1494 | * to include the command bytes sent for this to work | |
1495 | * correctly. | |
1496 | */ | |
1497 | printk(KERN_ERR "scsi%d.%c: " | |
1498 | "target trying to receive more command bytes\n", | |
1499 | info->host->host_no, fas216_target(info)); | |
1500 | fas216_cmd(info, CMD_SETATN); | |
1501 | fas216_set_stc(info, 15); | |
1502 | fas216_cmd(info, CMD_PADBYTES | CMD_WITHDMA); | |
1503 | msgqueue_flush(&info->scsi.msgs); | |
1504 | msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR); | |
1505 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
1506 | return; | |
1507 | } | |
1508 | ||
1509 | if (info->scsi.phase == PHASE_MSGIN_DISCONNECT) { | |
1510 | printk(KERN_ERR "scsi%d.%c: disconnect message received, but bus service %s?\n", | |
1511 | info->host->host_no, fas216_target(info), | |
1512 | fas216_bus_phase(stat)); | |
1513 | msgqueue_flush(&info->scsi.msgs); | |
1514 | fas216_cmd(info, CMD_SETATN); | |
1515 | msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR); | |
1516 | info->scsi.phase = PHASE_MSGOUT_EXPECT; | |
1517 | info->scsi.aborting = 1; | |
1518 | fas216_cmd(info, CMD_TRANSFERINFO); | |
1519 | return; | |
1520 | } | |
1521 | printk(KERN_ERR "scsi%d.%c: bus phase %s after %s?\n", | |
1522 | info->host->host_no, fas216_target(info), | |
1523 | fas216_bus_phase(stat), | |
1524 | fas216_drv_phase(info)); | |
1525 | print_debug_list(); | |
1526 | return; | |
1527 | ||
1528 | bad_is: | |
1529 | fas216_log(info, 0, "bus service at step %d?", is & IS_BITS); | |
1530 | fas216_dumpstate(info); | |
1531 | print_debug_list(); | |
1532 | ||
1533 | fas216_done(info, DID_ERROR); | |
1534 | } | |
1535 | ||
1536 | /** | |
1537 | * fas216_funcdone_intr - handle a function done interrupt from FAS216 chip | |
1538 | * @info: interface which caused function done interrupt | |
1539 | * @stat: Status register contents | |
1540 | * @is: SCSI Status register contents | |
1541 | * | |
1542 | * Handle a function done interrupt from FAS216 chip | |
1543 | */ | |
1544 | static void fas216_funcdone_intr(FAS216_Info *info, unsigned int stat, unsigned int is) | |
1545 | { | |
1546 | unsigned int fifo_len = fas216_readb(info, REG_CFIS) & CFIS_CF; | |
1547 | ||
1548 | fas216_checkmagic(info); | |
1549 | ||
1550 | fas216_log(info, LOG_FUNCTIONDONE, | |
1551 | "function done: stat=%02x is=%02x phase=%02x", | |
1552 | stat, is, info->scsi.phase); | |
1553 | ||
1554 | switch (info->scsi.phase) { | |
1555 | case PHASE_STATUS: /* status phase - read status and msg */ | |
1556 | if (fifo_len != 2) { | |
1557 | fas216_log(info, 0, "odd number of bytes in FIFO: %d", fifo_len); | |
1558 | } | |
1559 | /* | |
1560 | * Read status then message byte. | |
1561 | */ | |
1562 | info->scsi.SCp.Status = fas216_readb(info, REG_FF); | |
1563 | info->scsi.SCp.Message = fas216_readb(info, REG_FF); | |
1564 | info->scsi.phase = PHASE_DONE; | |
1565 | fas216_cmd(info, CMD_MSGACCEPTED); | |
1566 | break; | |
1567 | ||
1568 | case PHASE_IDLE: | |
1569 | case PHASE_SELECTION: | |
1570 | case PHASE_SELSTEPS: | |
1571 | break; | |
1572 | ||
1573 | case PHASE_MSGIN: /* message in phase */ | |
1574 | if ((stat & STAT_BUSMASK) == STAT_MESGIN) { | |
1575 | info->scsi.msgin_fifo = fifo_len; | |
1576 | fas216_message(info); | |
1577 | break; | |
1578 | } | |
1579 | ||
1580 | default: | |
1581 | fas216_log(info, 0, "internal phase %s for function done?" | |
1582 | " What do I do with this?", | |
1583 | fas216_target(info), fas216_drv_phase(info)); | |
1584 | } | |
1585 | } | |
1586 | ||
1587 | static void fas216_bus_reset(FAS216_Info *info) | |
1588 | { | |
1589 | neg_t sync_state; | |
1590 | int i; | |
1591 | ||
1592 | msgqueue_flush(&info->scsi.msgs); | |
1593 | ||
1594 | sync_state = neg_invalid; | |
1595 | ||
1596 | #ifdef SCSI2_SYNC | |
1597 | if (info->ifcfg.capabilities & (FASCAP_DMA|FASCAP_PSEUDODMA)) | |
1598 | sync_state = neg_wait; | |
1599 | #endif | |
1600 | ||
1601 | info->scsi.phase = PHASE_IDLE; | |
1602 | info->SCpnt = NULL; /* bug! */ | |
1603 | memset(&info->scsi.SCp, 0, sizeof(info->scsi.SCp)); | |
1604 | ||
1605 | for (i = 0; i < 8; i++) { | |
1606 | info->device[i].disconnect_ok = info->ifcfg.disconnect_ok; | |
1607 | info->device[i].sync_state = sync_state; | |
1608 | info->device[i].period = info->ifcfg.asyncperiod / 4; | |
1609 | info->device[i].stp = info->scsi.async_stp; | |
1610 | info->device[i].sof = 0; | |
1611 | info->device[i].wide_xfer = 0; | |
1612 | } | |
1613 | ||
1614 | info->rst_bus_status = 1; | |
1615 | wake_up(&info->eh_wait); | |
1616 | } | |
1617 | ||
1618 | /** | |
1619 | * fas216_intr - handle interrupts to progress a command | |
1620 | * @info: interface to service | |
1621 | * | |
1622 | * Handle interrupts from the interface to progress a command | |
1623 | */ | |
1624 | irqreturn_t fas216_intr(FAS216_Info *info) | |
1625 | { | |
1626 | unsigned char inst, is, stat; | |
1627 | int handled = IRQ_NONE; | |
1628 | ||
1629 | fas216_checkmagic(info); | |
1630 | ||
1631 | stat = fas216_readb(info, REG_STAT); | |
1632 | is = fas216_readb(info, REG_IS); | |
1633 | inst = fas216_readb(info, REG_INST); | |
1634 | ||
1635 | add_debug_list(stat, is, inst, info->scsi.phase); | |
1636 | ||
1637 | if (stat & STAT_INT) { | |
1638 | if (inst & INST_BUSRESET) { | |
1639 | fas216_log(info, 0, "bus reset detected"); | |
1640 | fas216_bus_reset(info); | |
1641 | scsi_report_bus_reset(info->host, 0); | |
1642 | } else if (inst & INST_ILLEGALCMD) { | |
1643 | fas216_log(info, LOG_ERROR, "illegal command given\n"); | |
1644 | fas216_dumpstate(info); | |
1645 | print_debug_list(); | |
1646 | } else if (inst & INST_DISCONNECT) | |
1647 | fas216_disconnect_intr(info); | |
1648 | else if (inst & INST_RESELECTED) /* reselected */ | |
1649 | fas216_reselected_intr(info); | |
1650 | else if (inst & INST_BUSSERVICE) /* bus service request */ | |
1651 | fas216_busservice_intr(info, stat, is); | |
1652 | else if (inst & INST_FUNCDONE) /* function done */ | |
1653 | fas216_funcdone_intr(info, stat, is); | |
1654 | else | |
1655 | fas216_log(info, 0, "unknown interrupt received:" | |
1656 | " phase %s inst %02X is %02X stat %02X", | |
1657 | fas216_drv_phase(info), inst, is, stat); | |
1658 | handled = IRQ_HANDLED; | |
1659 | } | |
1660 | return handled; | |
1661 | } | |
1662 | ||
ee0ca6ba | 1663 | static void __fas216_start_command(FAS216_Info *info, struct scsi_cmnd *SCpnt) |
1da177e4 LT |
1664 | { |
1665 | int tot_msglen; | |
1666 | ||
1667 | /* following what the ESP driver says */ | |
1668 | fas216_set_stc(info, 0); | |
1669 | fas216_cmd(info, CMD_NOP | CMD_WITHDMA); | |
1670 | ||
1671 | /* flush FIFO */ | |
1672 | fas216_cmd(info, CMD_FLUSHFIFO); | |
1673 | ||
1674 | /* load bus-id and timeout */ | |
1675 | fas216_writeb(info, REG_SDID, BUSID(SCpnt->device->id)); | |
1676 | fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout); | |
1677 | ||
1678 | /* synchronous transfers */ | |
1679 | fas216_set_sync(info, SCpnt->device->id); | |
1680 | ||
1681 | tot_msglen = msgqueue_msglength(&info->scsi.msgs); | |
1682 | ||
1683 | #ifdef DEBUG_MESSAGES | |
1684 | { | |
1685 | struct message *msg; | |
1686 | int msgnr = 0, i; | |
1687 | ||
1688 | printk("scsi%d.%c: message out: ", | |
1689 | info->host->host_no, '0' + SCpnt->device->id); | |
1690 | while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) { | |
1691 | printk("{ "); | |
1692 | for (i = 0; i < msg->length; i++) | |
1693 | printk("%02x ", msg->msg[i]); | |
1694 | printk("} "); | |
1695 | } | |
1696 | printk("\n"); | |
1697 | } | |
1698 | #endif | |
1699 | ||
1700 | if (tot_msglen == 1 || tot_msglen == 3) { | |
1701 | /* | |
1702 | * We have an easy message length to send... | |
1703 | */ | |
1704 | struct message *msg; | |
1705 | int msgnr = 0, i; | |
1706 | ||
1707 | info->scsi.phase = PHASE_SELSTEPS; | |
1708 | ||
1709 | /* load message bytes */ | |
1710 | while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) { | |
1711 | for (i = 0; i < msg->length; i++) | |
1712 | fas216_writeb(info, REG_FF, msg->msg[i]); | |
1713 | msg->fifo = tot_msglen - (fas216_readb(info, REG_CFIS) & CFIS_CF); | |
1714 | } | |
1715 | ||
1716 | /* load command */ | |
1717 | for (i = 0; i < SCpnt->cmd_len; i++) | |
1718 | fas216_writeb(info, REG_FF, SCpnt->cmnd[i]); | |
1719 | ||
1720 | if (tot_msglen == 1) | |
1721 | fas216_cmd(info, CMD_SELECTATN); | |
1722 | else | |
1723 | fas216_cmd(info, CMD_SELECTATN3); | |
1724 | } else { | |
1725 | /* | |
1726 | * We have an unusual number of message bytes to send. | |
1727 | * Load first byte into fifo, and issue SELECT with ATN and | |
1728 | * stop steps. | |
1729 | */ | |
1730 | struct message *msg = msgqueue_getmsg(&info->scsi.msgs, 0); | |
1731 | ||
1732 | fas216_writeb(info, REG_FF, msg->msg[0]); | |
1733 | msg->fifo = 1; | |
1734 | ||
1735 | fas216_cmd(info, CMD_SELECTATNSTOP); | |
1736 | } | |
1737 | } | |
1738 | ||
1739 | /* | |
1740 | * Decide whether we need to perform a parity test on this device. | |
1741 | * Can also be used to force parity error conditions during initial | |
1742 | * information transfer phase (message out) for test purposes. | |
1743 | */ | |
1744 | static int parity_test(FAS216_Info *info, int target) | |
1745 | { | |
1746 | #if 0 | |
1747 | if (target == 3) { | |
1748 | info->device[target].parity_check = 0; | |
1749 | return 1; | |
1750 | } | |
1751 | #endif | |
1752 | return info->device[target].parity_check; | |
1753 | } | |
1754 | ||
ee0ca6ba | 1755 | static void fas216_start_command(FAS216_Info *info, struct scsi_cmnd *SCpnt) |
1da177e4 LT |
1756 | { |
1757 | int disconnect_ok; | |
1758 | ||
1759 | /* | |
1760 | * claim host busy | |
1761 | */ | |
1762 | info->scsi.phase = PHASE_SELECTION; | |
1763 | info->scsi.SCp = SCpnt->SCp; | |
1764 | info->SCpnt = SCpnt; | |
1765 | info->dma.transfer_type = fasdma_none; | |
1766 | ||
1767 | if (parity_test(info, SCpnt->device->id)) | |
1768 | fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0] | CNTL1_PTE); | |
1769 | else | |
1770 | fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]); | |
1771 | ||
1772 | /* | |
1773 | * Don't allow request sense commands to disconnect. | |
1774 | */ | |
1775 | disconnect_ok = SCpnt->cmnd[0] != REQUEST_SENSE && | |
1776 | info->device[SCpnt->device->id].disconnect_ok; | |
1777 | ||
1778 | /* | |
1779 | * build outgoing message bytes | |
1780 | */ | |
1781 | msgqueue_flush(&info->scsi.msgs); | |
1782 | msgqueue_addmsg(&info->scsi.msgs, 1, IDENTIFY(disconnect_ok, SCpnt->device->lun)); | |
1783 | ||
1784 | /* | |
1785 | * add tag message if required | |
1786 | */ | |
1787 | if (SCpnt->tag) | |
1788 | msgqueue_addmsg(&info->scsi.msgs, 2, SIMPLE_QUEUE_TAG, SCpnt->tag); | |
1789 | ||
1790 | do { | |
1791 | #ifdef SCSI2_SYNC | |
1792 | if ((info->device[SCpnt->device->id].sync_state == neg_wait || | |
1793 | info->device[SCpnt->device->id].sync_state == neg_complete) && | |
1794 | (SCpnt->cmnd[0] == REQUEST_SENSE || | |
1795 | SCpnt->cmnd[0] == INQUIRY)) { | |
1796 | info->device[SCpnt->device->id].sync_state = neg_inprogress; | |
1797 | msgqueue_addmsg(&info->scsi.msgs, 5, | |
1798 | EXTENDED_MESSAGE, 3, EXTENDED_SDTR, | |
1799 | 1000 / info->ifcfg.clockrate, | |
1800 | info->ifcfg.sync_max_depth); | |
1801 | break; | |
1802 | } | |
1803 | #endif | |
1804 | } while (0); | |
1805 | ||
1806 | __fas216_start_command(info, SCpnt); | |
1807 | } | |
1808 | ||
ee0ca6ba | 1809 | static void fas216_allocate_tag(FAS216_Info *info, struct scsi_cmnd *SCpnt) |
1da177e4 LT |
1810 | { |
1811 | #ifdef SCSI2_TAG | |
1812 | /* | |
1813 | * tagged queuing - allocate a new tag to this command | |
1814 | */ | |
1815 | if (SCpnt->device->simple_tags && SCpnt->cmnd[0] != REQUEST_SENSE && | |
1816 | SCpnt->cmnd[0] != INQUIRY) { | |
1817 | SCpnt->device->current_tag += 1; | |
1818 | if (SCpnt->device->current_tag == 0) | |
1819 | SCpnt->device->current_tag = 1; | |
1820 | SCpnt->tag = SCpnt->device->current_tag; | |
1821 | } else | |
1822 | #endif | |
9cb78c16 HR |
1823 | set_bit(SCpnt->device->id * 8 + |
1824 | (u8)(SCpnt->device->lun & 0x7), info->busyluns); | |
1da177e4 LT |
1825 | |
1826 | info->stats.removes += 1; | |
1827 | switch (SCpnt->cmnd[0]) { | |
1828 | case WRITE_6: | |
1829 | case WRITE_10: | |
1830 | case WRITE_12: | |
1831 | info->stats.writes += 1; | |
1832 | break; | |
1833 | case READ_6: | |
1834 | case READ_10: | |
1835 | case READ_12: | |
1836 | info->stats.reads += 1; | |
1837 | break; | |
1838 | default: | |
1839 | info->stats.miscs += 1; | |
1840 | break; | |
1841 | } | |
1842 | } | |
1843 | ||
ee0ca6ba HK |
1844 | static void fas216_do_bus_device_reset(FAS216_Info *info, |
1845 | struct scsi_cmnd *SCpnt) | |
1da177e4 LT |
1846 | { |
1847 | struct message *msg; | |
1848 | ||
1849 | /* | |
1850 | * claim host busy | |
1851 | */ | |
1852 | info->scsi.phase = PHASE_SELECTION; | |
1853 | info->scsi.SCp = SCpnt->SCp; | |
1854 | info->SCpnt = SCpnt; | |
1855 | info->dma.transfer_type = fasdma_none; | |
1856 | ||
1857 | fas216_log(info, LOG_ERROR, "sending bus device reset"); | |
1858 | ||
1859 | msgqueue_flush(&info->scsi.msgs); | |
1860 | msgqueue_addmsg(&info->scsi.msgs, 1, BUS_DEVICE_RESET); | |
1861 | ||
1862 | /* following what the ESP driver says */ | |
1863 | fas216_set_stc(info, 0); | |
1864 | fas216_cmd(info, CMD_NOP | CMD_WITHDMA); | |
1865 | ||
1866 | /* flush FIFO */ | |
1867 | fas216_cmd(info, CMD_FLUSHFIFO); | |
1868 | ||
1869 | /* load bus-id and timeout */ | |
1870 | fas216_writeb(info, REG_SDID, BUSID(SCpnt->device->id)); | |
1871 | fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout); | |
1872 | ||
1873 | /* synchronous transfers */ | |
1874 | fas216_set_sync(info, SCpnt->device->id); | |
1875 | ||
1876 | msg = msgqueue_getmsg(&info->scsi.msgs, 0); | |
1877 | ||
1878 | fas216_writeb(info, REG_FF, BUS_DEVICE_RESET); | |
1879 | msg->fifo = 1; | |
1880 | ||
1881 | fas216_cmd(info, CMD_SELECTATNSTOP); | |
1882 | } | |
1883 | ||
1884 | /** | |
1885 | * fas216_kick - kick a command to the interface | |
1886 | * @info: our host interface to kick | |
1887 | * | |
1888 | * Kick a command to the interface, interface should be idle. | |
1889 | * Notes: Interrupts are always disabled! | |
1890 | */ | |
1891 | static void fas216_kick(FAS216_Info *info) | |
1892 | { | |
ee0ca6ba | 1893 | struct scsi_cmnd *SCpnt = NULL; |
1da177e4 LT |
1894 | #define TYPE_OTHER 0 |
1895 | #define TYPE_RESET 1 | |
1896 | #define TYPE_QUEUE 2 | |
1897 | int where_from = TYPE_OTHER; | |
1898 | ||
1899 | fas216_checkmagic(info); | |
1900 | ||
1901 | /* | |
1902 | * Obtain the next command to process. | |
1903 | */ | |
1904 | do { | |
1905 | if (info->rstSCpnt) { | |
1906 | SCpnt = info->rstSCpnt; | |
1907 | /* don't remove it */ | |
1908 | where_from = TYPE_RESET; | |
1909 | break; | |
1910 | } | |
1911 | ||
1912 | if (info->reqSCpnt) { | |
1913 | SCpnt = info->reqSCpnt; | |
1914 | info->reqSCpnt = NULL; | |
1915 | break; | |
1916 | } | |
1917 | ||
1918 | if (info->origSCpnt) { | |
1919 | SCpnt = info->origSCpnt; | |
1920 | info->origSCpnt = NULL; | |
1921 | break; | |
1922 | } | |
1923 | ||
1924 | /* retrieve next command */ | |
1925 | if (!SCpnt) { | |
1926 | SCpnt = queue_remove_exclude(&info->queues.issue, | |
1927 | info->busyluns); | |
1928 | where_from = TYPE_QUEUE; | |
1929 | break; | |
1930 | } | |
1931 | } while (0); | |
1932 | ||
1933 | if (!SCpnt) { | |
1934 | /* | |
1935 | * no command pending, so enable reselection. | |
1936 | */ | |
1937 | fas216_cmd(info, CMD_ENABLESEL); | |
1938 | return; | |
1939 | } | |
1940 | ||
1941 | /* | |
1942 | * We're going to start a command, so disable reselection | |
1943 | */ | |
1944 | fas216_cmd(info, CMD_DISABLESEL); | |
1945 | ||
1946 | if (info->scsi.disconnectable && info->SCpnt) { | |
1947 | fas216_log(info, LOG_CONNECT, | |
1948 | "moved command for %d to disconnected queue", | |
1949 | info->SCpnt->device->id); | |
1950 | queue_add_cmd_tail(&info->queues.disconnected, info->SCpnt); | |
1951 | info->scsi.disconnectable = 0; | |
1952 | info->SCpnt = NULL; | |
1953 | } | |
1954 | ||
1955 | fas216_log_command(info, LOG_CONNECT | LOG_MESSAGES, SCpnt, | |
1956 | "starting"); | |
1957 | ||
1958 | switch (where_from) { | |
1959 | case TYPE_QUEUE: | |
1960 | fas216_allocate_tag(info, SCpnt); | |
1961 | case TYPE_OTHER: | |
1962 | fas216_start_command(info, SCpnt); | |
1963 | break; | |
1964 | case TYPE_RESET: | |
1965 | fas216_do_bus_device_reset(info, SCpnt); | |
1966 | break; | |
1967 | } | |
1968 | ||
1969 | fas216_log(info, LOG_CONNECT, "select: data pointers [%p, %X]", | |
1970 | info->scsi.SCp.ptr, info->scsi.SCp.this_residual); | |
1971 | ||
1972 | /* | |
1973 | * should now get either DISCONNECT or | |
1974 | * (FUNCTION DONE with BUS SERVICE) interrupt | |
1975 | */ | |
1976 | } | |
1977 | ||
1978 | /* | |
1979 | * Clean up from issuing a BUS DEVICE RESET message to a device. | |
1980 | */ | |
ee0ca6ba HK |
1981 | static void fas216_devicereset_done(FAS216_Info *info, struct scsi_cmnd *SCpnt, |
1982 | unsigned int result) | |
1da177e4 LT |
1983 | { |
1984 | fas216_log(info, LOG_ERROR, "fas216 device reset complete"); | |
1985 | ||
1986 | info->rstSCpnt = NULL; | |
1987 | info->rst_dev_status = 1; | |
1988 | wake_up(&info->eh_wait); | |
1989 | } | |
1990 | ||
1991 | /** | |
1992 | * fas216_rq_sns_done - Finish processing automatic request sense command | |
1993 | * @info: interface that completed | |
1994 | * @SCpnt: command that completed | |
1995 | * @result: driver byte of result | |
1996 | * | |
1997 | * Finish processing automatic request sense command | |
1998 | */ | |
ee0ca6ba HK |
1999 | static void fas216_rq_sns_done(FAS216_Info *info, struct scsi_cmnd *SCpnt, |
2000 | unsigned int result) | |
1da177e4 LT |
2001 | { |
2002 | fas216_log_target(info, LOG_CONNECT, SCpnt->device->id, | |
2003 | "request sense complete, result=0x%04x%02x%02x", | |
2004 | result, SCpnt->SCp.Message, SCpnt->SCp.Status); | |
2005 | ||
2006 | if (result != DID_OK || SCpnt->SCp.Status != GOOD) | |
2007 | /* | |
2008 | * Something went wrong. Make sure that we don't | |
2009 | * have valid data in the sense buffer that could | |
2010 | * confuse the higher levels. | |
2011 | */ | |
2012 | memset(SCpnt->sense_buffer, 0, sizeof(SCpnt->sense_buffer)); | |
2013 | //printk("scsi%d.%c: sense buffer: ", info->host->host_no, '0' + SCpnt->device->id); | |
2014 | //{ int i; for (i = 0; i < 32; i++) printk("%02x ", SCpnt->sense_buffer[i]); printk("\n"); } | |
2015 | /* | |
2016 | * Note that we don't set SCpnt->result, since that should | |
2017 | * reflect the status of the command that we were asked by | |
2018 | * the upper layers to process. This would have been set | |
2019 | * correctly by fas216_std_done. | |
2020 | */ | |
ccf9ea91 | 2021 | scsi_eh_restore_cmnd(SCpnt, &info->ses); |
1da177e4 LT |
2022 | SCpnt->scsi_done(SCpnt); |
2023 | } | |
2024 | ||
2025 | /** | |
2026 | * fas216_std_done - finish processing of standard command | |
2027 | * @info: interface that completed | |
2028 | * @SCpnt: command that completed | |
2029 | * @result: driver byte of result | |
2030 | * | |
2031 | * Finish processing of standard command | |
2032 | */ | |
2033 | static void | |
ee0ca6ba | 2034 | fas216_std_done(FAS216_Info *info, struct scsi_cmnd *SCpnt, unsigned int result) |
1da177e4 LT |
2035 | { |
2036 | info->stats.fins += 1; | |
2037 | ||
2038 | SCpnt->result = result << 16 | info->scsi.SCp.Message << 8 | | |
2039 | info->scsi.SCp.Status; | |
2040 | ||
2041 | fas216_log_command(info, LOG_CONNECT, SCpnt, | |
2042 | "command complete, result=0x%08x", SCpnt->result); | |
2043 | ||
2044 | /* | |
2045 | * If the driver detected an error, we're all done. | |
2046 | */ | |
2047 | if (host_byte(SCpnt->result) != DID_OK || | |
2048 | msg_byte(SCpnt->result) != COMMAND_COMPLETE) | |
2049 | goto done; | |
2050 | ||
2051 | /* | |
2052 | * If the command returned CHECK_CONDITION or COMMAND_TERMINATED | |
2053 | * status, request the sense information. | |
2054 | */ | |
2055 | if (status_byte(SCpnt->result) == CHECK_CONDITION || | |
2056 | status_byte(SCpnt->result) == COMMAND_TERMINATED) | |
2057 | goto request_sense; | |
2058 | ||
2059 | /* | |
2060 | * If the command did not complete with GOOD status, | |
2061 | * we are all done here. | |
2062 | */ | |
2063 | if (status_byte(SCpnt->result) != GOOD) | |
2064 | goto done; | |
2065 | ||
2066 | /* | |
2067 | * We have successfully completed a command. Make sure that | |
2068 | * we do not have any buffers left to transfer. The world | |
2069 | * is not perfect, and we seem to occasionally hit this. | |
2070 | * It can be indicative of a buggy driver, target or the upper | |
2071 | * levels of the SCSI code. | |
2072 | */ | |
2073 | if (info->scsi.SCp.ptr) { | |
2074 | switch (SCpnt->cmnd[0]) { | |
2075 | case INQUIRY: | |
2076 | case START_STOP: | |
2077 | case MODE_SENSE: | |
2078 | break; | |
2079 | ||
2080 | default: | |
e04ca907 HR |
2081 | scmd_printk(KERN_ERR, SCpnt, |
2082 | "incomplete data transfer detected: res=%08X ptr=%p len=%X\n", | |
2083 | SCpnt->result, info->scsi.SCp.ptr, | |
2084 | info->scsi.SCp.this_residual); | |
2085 | scsi_print_command(SCpnt); | |
279c43b3 | 2086 | set_host_byte(SCpnt, DID_ERROR); |
1da177e4 LT |
2087 | goto request_sense; |
2088 | } | |
2089 | } | |
2090 | ||
2091 | done: | |
2092 | if (SCpnt->scsi_done) { | |
2093 | SCpnt->scsi_done(SCpnt); | |
2094 | return; | |
2095 | } | |
2096 | ||
2097 | panic("scsi%d.H: null scsi_done function in fas216_done", | |
2098 | info->host->host_no); | |
2099 | ||
2100 | ||
2101 | request_sense: | |
2102 | if (SCpnt->cmnd[0] == REQUEST_SENSE) | |
2103 | goto done; | |
2104 | ||
ccf9ea91 | 2105 | scsi_eh_prep_cmnd(SCpnt, &info->ses, NULL, 0, ~0); |
1da177e4 LT |
2106 | fas216_log_target(info, LOG_CONNECT, SCpnt->device->id, |
2107 | "requesting sense"); | |
ccf9ea91 | 2108 | init_SCp(SCpnt); |
1da177e4 LT |
2109 | SCpnt->SCp.Message = 0; |
2110 | SCpnt->SCp.Status = 0; | |
1da177e4 LT |
2111 | SCpnt->tag = 0; |
2112 | SCpnt->host_scribble = (void *)fas216_rq_sns_done; | |
2113 | ||
2114 | /* | |
2115 | * Place this command into the high priority "request | |
2116 | * sense" slot. This will be the very next command | |
2117 | * executed, unless a target connects to us. | |
2118 | */ | |
2119 | if (info->reqSCpnt) | |
25985edc | 2120 | printk(KERN_WARNING "scsi%d.%c: losing request command\n", |
1da177e4 LT |
2121 | info->host->host_no, '0' + SCpnt->device->id); |
2122 | info->reqSCpnt = SCpnt; | |
2123 | } | |
2124 | ||
2125 | /** | |
2126 | * fas216_done - complete processing for current command | |
2127 | * @info: interface that completed | |
2128 | * @result: driver byte of result | |
2129 | * | |
2130 | * Complete processing for current command | |
2131 | */ | |
2132 | static void fas216_done(FAS216_Info *info, unsigned int result) | |
2133 | { | |
ee0ca6ba HK |
2134 | void (*fn)(FAS216_Info *, struct scsi_cmnd *, unsigned int); |
2135 | struct scsi_cmnd *SCpnt; | |
1da177e4 LT |
2136 | unsigned long flags; |
2137 | ||
2138 | fas216_checkmagic(info); | |
2139 | ||
2140 | if (!info->SCpnt) | |
2141 | goto no_command; | |
2142 | ||
2143 | SCpnt = info->SCpnt; | |
2144 | info->SCpnt = NULL; | |
2145 | info->scsi.phase = PHASE_IDLE; | |
2146 | ||
2147 | if (info->scsi.aborting) { | |
2148 | fas216_log(info, 0, "uncaught abort - returning DID_ABORT"); | |
2149 | result = DID_ABORT; | |
2150 | info->scsi.aborting = 0; | |
2151 | } | |
2152 | ||
2153 | /* | |
2154 | * Sanity check the completion - if we have zero bytes left | |
2155 | * to transfer, we should not have a valid pointer. | |
2156 | */ | |
2157 | if (info->scsi.SCp.ptr && info->scsi.SCp.this_residual == 0) { | |
e04ca907 HR |
2158 | scmd_printk(KERN_INFO, SCpnt, |
2159 | "zero bytes left to transfer, but buffer pointer still valid: ptr=%p len=%08x\n", | |
2160 | info->scsi.SCp.ptr, info->scsi.SCp.this_residual); | |
1da177e4 | 2161 | info->scsi.SCp.ptr = NULL; |
e04ca907 | 2162 | scsi_print_command(SCpnt); |
1da177e4 LT |
2163 | } |
2164 | ||
2165 | /* | |
2166 | * Clear down this command as completed. If we need to request | |
2167 | * the sense information, fas216_kick will re-assert the busy | |
2168 | * status. | |
2169 | */ | |
2170 | info->device[SCpnt->device->id].parity_check = 0; | |
9cb78c16 HR |
2171 | clear_bit(SCpnt->device->id * 8 + |
2172 | (u8)(SCpnt->device->lun & 0x7), info->busyluns); | |
1da177e4 | 2173 | |
ee0ca6ba | 2174 | fn = (void (*)(FAS216_Info *, struct scsi_cmnd *, unsigned int))SCpnt->host_scribble; |
1da177e4 LT |
2175 | fn(info, SCpnt, result); |
2176 | ||
41569e37 | 2177 | if (info->scsi.irq) { |
1da177e4 LT |
2178 | spin_lock_irqsave(&info->host_lock, flags); |
2179 | if (info->scsi.phase == PHASE_IDLE) | |
2180 | fas216_kick(info); | |
2181 | spin_unlock_irqrestore(&info->host_lock, flags); | |
2182 | } | |
2183 | return; | |
2184 | ||
2185 | no_command: | |
2186 | panic("scsi%d.H: null command in fas216_done", | |
2187 | info->host->host_no); | |
2188 | } | |
2189 | ||
2190 | /** | |
2191 | * fas216_queue_command - queue a command for adapter to process. | |
2192 | * @SCpnt: Command to queue | |
2193 | * @done: done function to call once command is complete | |
2194 | * | |
2195 | * Queue a command for adapter to process. | |
2196 | * Returns: 0 on success, else error. | |
2197 | * Notes: io_request_lock is held, interrupts are disabled. | |
2198 | */ | |
f281233d | 2199 | static int fas216_queue_command_lck(struct scsi_cmnd *SCpnt, |
ee0ca6ba | 2200 | void (*done)(struct scsi_cmnd *)) |
1da177e4 LT |
2201 | { |
2202 | FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata; | |
2203 | int result; | |
2204 | ||
2205 | fas216_checkmagic(info); | |
2206 | ||
2207 | fas216_log_command(info, LOG_CONNECT, SCpnt, | |
2208 | "received command (%p)", SCpnt); | |
2209 | ||
2210 | SCpnt->scsi_done = done; | |
2211 | SCpnt->host_scribble = (void *)fas216_std_done; | |
2212 | SCpnt->result = 0; | |
2213 | ||
2214 | init_SCp(SCpnt); | |
2215 | ||
2216 | info->stats.queues += 1; | |
2217 | SCpnt->tag = 0; | |
2218 | ||
2219 | spin_lock(&info->host_lock); | |
2220 | ||
2221 | /* | |
2222 | * Add command into execute queue and let it complete under | |
2223 | * whatever scheme we're using. | |
2224 | */ | |
2225 | result = !queue_add_cmd_ordered(&info->queues.issue, SCpnt); | |
2226 | ||
2227 | /* | |
2228 | * If we successfully added the command, | |
2229 | * kick the interface to get it moving. | |
2230 | */ | |
2231 | if (result == 0 && info->scsi.phase == PHASE_IDLE) | |
2232 | fas216_kick(info); | |
2233 | spin_unlock(&info->host_lock); | |
2234 | ||
2235 | fas216_log_target(info, LOG_CONNECT, -1, "queue %s", | |
2236 | result ? "failure" : "success"); | |
2237 | ||
2238 | return result; | |
2239 | } | |
2240 | ||
f281233d JG |
2241 | DEF_SCSI_QCMD(fas216_queue_command) |
2242 | ||
1da177e4 LT |
2243 | /** |
2244 | * fas216_internal_done - trigger restart of a waiting thread in fas216_noqueue_command | |
2245 | * @SCpnt: Command to wake | |
2246 | * | |
2247 | * Trigger restart of a waiting thread in fas216_command | |
2248 | */ | |
ee0ca6ba | 2249 | static void fas216_internal_done(struct scsi_cmnd *SCpnt) |
1da177e4 LT |
2250 | { |
2251 | FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata; | |
2252 | ||
2253 | fas216_checkmagic(info); | |
2254 | ||
2255 | info->internal_done = 1; | |
2256 | } | |
2257 | ||
2258 | /** | |
2259 | * fas216_noqueue_command - process a command for the adapter. | |
2260 | * @SCpnt: Command to queue | |
2261 | * | |
2262 | * Queue a command for adapter to process. | |
2263 | * Returns: scsi result code. | |
2264 | * Notes: io_request_lock is held, interrupts are disabled. | |
2265 | */ | |
f281233d | 2266 | static int fas216_noqueue_command_lck(struct scsi_cmnd *SCpnt, |
ee0ca6ba | 2267 | void (*done)(struct scsi_cmnd *)) |
1da177e4 LT |
2268 | { |
2269 | FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata; | |
2270 | ||
2271 | fas216_checkmagic(info); | |
2272 | ||
2273 | /* | |
2274 | * We should only be using this if we don't have an interrupt. | |
2275 | * Provide some "incentive" to use the queueing code. | |
2276 | */ | |
41569e37 | 2277 | BUG_ON(info->scsi.irq); |
1da177e4 LT |
2278 | |
2279 | info->internal_done = 0; | |
f281233d | 2280 | fas216_queue_command_lck(SCpnt, fas216_internal_done); |
1da177e4 LT |
2281 | |
2282 | /* | |
2283 | * This wastes time, since we can't return until the command is | |
2284 | * complete. We can't sleep either since we may get re-entered! | |
2285 | * However, we must re-enable interrupts, or else we'll be | |
2286 | * waiting forever. | |
2287 | */ | |
2288 | spin_unlock_irq(info->host->host_lock); | |
2289 | ||
2290 | while (!info->internal_done) { | |
2291 | /* | |
2292 | * If we don't have an IRQ, then we must poll the card for | |
2293 | * it's interrupt, and use that to call this driver's | |
2294 | * interrupt routine. That way, we keep the command | |
25985edc | 2295 | * progressing. Maybe we can add some intelligence here |
1da177e4 LT |
2296 | * and go to sleep if we know that the device is going |
2297 | * to be some time (eg, disconnected). | |
2298 | */ | |
2299 | if (fas216_readb(info, REG_STAT) & STAT_INT) { | |
2300 | spin_lock_irq(info->host->host_lock); | |
2301 | fas216_intr(info); | |
2302 | spin_unlock_irq(info->host->host_lock); | |
2303 | } | |
2304 | } | |
2305 | ||
2306 | spin_lock_irq(info->host->host_lock); | |
2307 | ||
2308 | done(SCpnt); | |
2309 | ||
2310 | return 0; | |
2311 | } | |
2312 | ||
f281233d JG |
2313 | DEF_SCSI_QCMD(fas216_noqueue_command) |
2314 | ||
1da177e4 LT |
2315 | /* |
2316 | * Error handler timeout function. Indicate that we timed out, | |
2317 | * and wake up any error handler process so it can continue. | |
2318 | */ | |
2319 | static void fas216_eh_timer(unsigned long data) | |
2320 | { | |
2321 | FAS216_Info *info = (FAS216_Info *)data; | |
2322 | ||
2323 | fas216_log(info, LOG_ERROR, "error handling timed out\n"); | |
2324 | ||
2325 | del_timer(&info->eh_timer); | |
2326 | ||
2327 | if (info->rst_bus_status == 0) | |
2328 | info->rst_bus_status = -1; | |
2329 | if (info->rst_dev_status == 0) | |
2330 | info->rst_dev_status = -1; | |
2331 | ||
2332 | wake_up(&info->eh_wait); | |
2333 | } | |
2334 | ||
2335 | enum res_find { | |
2336 | res_failed, /* not found */ | |
2337 | res_success, /* command on issue queue */ | |
2338 | res_hw_abort /* command on disconnected dev */ | |
2339 | }; | |
2340 | ||
2341 | /** | |
2342 | * fas216_do_abort - decide how to abort a command | |
2343 | * @SCpnt: command to abort | |
2344 | * | |
2345 | * Decide how to abort a command. | |
2346 | * Returns: abort status | |
2347 | */ | |
ee0ca6ba HK |
2348 | static enum res_find fas216_find_command(FAS216_Info *info, |
2349 | struct scsi_cmnd *SCpnt) | |
1da177e4 LT |
2350 | { |
2351 | enum res_find res = res_failed; | |
2352 | ||
2353 | if (queue_remove_cmd(&info->queues.issue, SCpnt)) { | |
2354 | /* | |
2355 | * The command was on the issue queue, and has not been | |
2356 | * issued yet. We can remove the command from the queue, | |
2357 | * and acknowledge the abort. Neither the device nor the | |
2358 | * interface know about the command. | |
2359 | */ | |
2360 | printk("on issue queue "); | |
2361 | ||
2362 | res = res_success; | |
2363 | } else if (queue_remove_cmd(&info->queues.disconnected, SCpnt)) { | |
2364 | /* | |
2365 | * The command was on the disconnected queue. We must | |
2366 | * reconnect with the device if possible, and send it | |
2367 | * an abort message. | |
2368 | */ | |
2369 | printk("on disconnected queue "); | |
2370 | ||
2371 | res = res_hw_abort; | |
2372 | } else if (info->SCpnt == SCpnt) { | |
2373 | printk("executing "); | |
2374 | ||
2375 | switch (info->scsi.phase) { | |
2376 | /* | |
2377 | * If the interface is idle, and the command is 'disconnectable', | |
2378 | * then it is the same as on the disconnected queue. | |
2379 | */ | |
2380 | case PHASE_IDLE: | |
2381 | if (info->scsi.disconnectable) { | |
2382 | info->scsi.disconnectable = 0; | |
2383 | info->SCpnt = NULL; | |
2384 | res = res_hw_abort; | |
2385 | } | |
2386 | break; | |
2387 | ||
2388 | default: | |
2389 | break; | |
2390 | } | |
2391 | } else if (info->origSCpnt == SCpnt) { | |
2392 | /* | |
2393 | * The command will be executed next, but a command | |
2394 | * is currently using the interface. This is similar to | |
2395 | * being on the issue queue, except the busylun bit has | |
2396 | * been set. | |
2397 | */ | |
2398 | info->origSCpnt = NULL; | |
9cb78c16 HR |
2399 | clear_bit(SCpnt->device->id * 8 + |
2400 | (u8)(SCpnt->device->lun & 0x7), info->busyluns); | |
1da177e4 LT |
2401 | printk("waiting for execution "); |
2402 | res = res_success; | |
2403 | } else | |
2404 | printk("unknown "); | |
2405 | ||
2406 | return res; | |
2407 | } | |
2408 | ||
2409 | /** | |
2410 | * fas216_eh_abort - abort this command | |
2411 | * @SCpnt: command to abort | |
2412 | * | |
2413 | * Abort this command. | |
2414 | * Returns: FAILED if unable to abort | |
2415 | * Notes: io_request_lock is taken, and irqs are disabled | |
2416 | */ | |
ee0ca6ba | 2417 | int fas216_eh_abort(struct scsi_cmnd *SCpnt) |
1da177e4 LT |
2418 | { |
2419 | FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata; | |
2420 | int result = FAILED; | |
2421 | ||
2422 | fas216_checkmagic(info); | |
2423 | ||
2424 | info->stats.aborts += 1; | |
2425 | ||
1fa6b5fb | 2426 | scmd_printk(KERN_WARNING, SCpnt, "abort command\n"); |
1da177e4 LT |
2427 | |
2428 | print_debug_list(); | |
2429 | fas216_dumpstate(info); | |
2430 | ||
1da177e4 LT |
2431 | switch (fas216_find_command(info, SCpnt)) { |
2432 | /* | |
2433 | * We found the command, and cleared it out. Either | |
2434 | * the command is still known to be executing on the | |
2435 | * target, or the busylun bit is not set. | |
2436 | */ | |
2437 | case res_success: | |
1fa6b5fb | 2438 | scmd_printk(KERN_WARNING, SCpnt, "abort %p success\n", SCpnt); |
1da177e4 LT |
2439 | result = SUCCESS; |
2440 | break; | |
2441 | ||
2442 | /* | |
2443 | * We need to reconnect to the target and send it an | |
2444 | * ABORT or ABORT_TAG message. We can only do this | |
2445 | * if the bus is free. | |
2446 | */ | |
2447 | case res_hw_abort: | |
1da177e4 LT |
2448 | |
2449 | /* | |
2450 | * We are unable to abort the command for some reason. | |
2451 | */ | |
2452 | default: | |
2453 | case res_failed: | |
1fa6b5fb | 2454 | scmd_printk(KERN_WARNING, SCpnt, "abort %p failed\n", SCpnt); |
1da177e4 LT |
2455 | break; |
2456 | } | |
2457 | ||
2458 | return result; | |
2459 | } | |
2460 | ||
2461 | /** | |
2462 | * fas216_eh_device_reset - Reset the device associated with this command | |
2463 | * @SCpnt: command specifing device to reset | |
2464 | * | |
2465 | * Reset the device associated with this command. | |
2466 | * Returns: FAILED if unable to reset. | |
2467 | * Notes: We won't be re-entered, so we'll only have one device | |
2468 | * reset on the go at one time. | |
2469 | */ | |
ee0ca6ba | 2470 | int fas216_eh_device_reset(struct scsi_cmnd *SCpnt) |
1da177e4 LT |
2471 | { |
2472 | FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata; | |
2473 | unsigned long flags; | |
2474 | int i, res = FAILED, target = SCpnt->device->id; | |
2475 | ||
2476 | fas216_log(info, LOG_ERROR, "device reset for target %d", target); | |
2477 | ||
2478 | spin_lock_irqsave(&info->host_lock, flags); | |
2479 | ||
2480 | do { | |
2481 | /* | |
2482 | * If we are currently connected to a device, and | |
2483 | * it is the device we want to reset, there is | |
2484 | * nothing we can do here. Chances are it is stuck, | |
2485 | * and we need a bus reset. | |
2486 | */ | |
2487 | if (info->SCpnt && !info->scsi.disconnectable && | |
2488 | info->SCpnt->device->id == SCpnt->device->id) | |
2489 | break; | |
2490 | ||
2491 | /* | |
2492 | * We're going to be resetting this device. Remove | |
2493 | * all pending commands from the driver. By doing | |
2494 | * so, we guarantee that we won't touch the command | |
2495 | * structures except to process the reset request. | |
2496 | */ | |
2497 | queue_remove_all_target(&info->queues.issue, target); | |
2498 | queue_remove_all_target(&info->queues.disconnected, target); | |
2499 | if (info->origSCpnt && info->origSCpnt->device->id == target) | |
2500 | info->origSCpnt = NULL; | |
2501 | if (info->reqSCpnt && info->reqSCpnt->device->id == target) | |
2502 | info->reqSCpnt = NULL; | |
2503 | for (i = 0; i < 8; i++) | |
2504 | clear_bit(target * 8 + i, info->busyluns); | |
2505 | ||
2506 | /* | |
2507 | * Hijack this SCSI command structure to send | |
2508 | * a bus device reset message to this device. | |
2509 | */ | |
2510 | SCpnt->host_scribble = (void *)fas216_devicereset_done; | |
2511 | ||
2512 | info->rst_dev_status = 0; | |
2513 | info->rstSCpnt = SCpnt; | |
2514 | ||
2515 | if (info->scsi.phase == PHASE_IDLE) | |
2516 | fas216_kick(info); | |
2517 | ||
b857df1a | 2518 | mod_timer(&info->eh_timer, jiffies + 30 * HZ); |
1da177e4 LT |
2519 | spin_unlock_irqrestore(&info->host_lock, flags); |
2520 | ||
2521 | /* | |
2522 | * Wait up to 30 seconds for the reset to complete. | |
2523 | */ | |
2524 | wait_event(info->eh_wait, info->rst_dev_status); | |
2525 | ||
2526 | del_timer_sync(&info->eh_timer); | |
2527 | spin_lock_irqsave(&info->host_lock, flags); | |
2528 | info->rstSCpnt = NULL; | |
2529 | ||
2530 | if (info->rst_dev_status == 1) | |
2531 | res = SUCCESS; | |
2532 | } while (0); | |
2533 | ||
2534 | SCpnt->host_scribble = NULL; | |
2535 | spin_unlock_irqrestore(&info->host_lock, flags); | |
2536 | ||
2537 | fas216_log(info, LOG_ERROR, "device reset complete: %s\n", | |
2538 | res == SUCCESS ? "success" : "failed"); | |
2539 | ||
2540 | return res; | |
2541 | } | |
2542 | ||
2543 | /** | |
2544 | * fas216_eh_bus_reset - Reset the bus associated with the command | |
2545 | * @SCpnt: command specifing bus to reset | |
2546 | * | |
2547 | * Reset the bus associated with the command. | |
2548 | * Returns: FAILED if unable to reset. | |
2549 | * Notes: Further commands are blocked. | |
2550 | */ | |
ee0ca6ba | 2551 | int fas216_eh_bus_reset(struct scsi_cmnd *SCpnt) |
1da177e4 LT |
2552 | { |
2553 | FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata; | |
2554 | unsigned long flags; | |
f64a181d | 2555 | struct scsi_device *SDpnt; |
1da177e4 LT |
2556 | |
2557 | fas216_checkmagic(info); | |
2558 | fas216_log(info, LOG_ERROR, "resetting bus"); | |
2559 | ||
2560 | info->stats.bus_resets += 1; | |
2561 | ||
2562 | spin_lock_irqsave(&info->host_lock, flags); | |
2563 | ||
2564 | /* | |
2565 | * Stop all activity on this interface. | |
2566 | */ | |
2567 | fas216_aborttransfer(info); | |
2568 | fas216_writeb(info, REG_CNTL3, info->scsi.cfg[2]); | |
2569 | ||
2570 | /* | |
2571 | * Clear any pending interrupts. | |
2572 | */ | |
2573 | while (fas216_readb(info, REG_STAT) & STAT_INT) | |
2574 | fas216_readb(info, REG_INST); | |
2575 | ||
2576 | info->rst_bus_status = 0; | |
2577 | ||
2578 | /* | |
2579 | * For each attached hard-reset device, clear out | |
2580 | * all command structures. Leave the running | |
2581 | * command in place. | |
2582 | */ | |
2583 | shost_for_each_device(SDpnt, info->host) { | |
2584 | int i; | |
2585 | ||
2586 | if (SDpnt->soft_reset) | |
2587 | continue; | |
2588 | ||
2589 | queue_remove_all_target(&info->queues.issue, SDpnt->id); | |
2590 | queue_remove_all_target(&info->queues.disconnected, SDpnt->id); | |
2591 | if (info->origSCpnt && info->origSCpnt->device->id == SDpnt->id) | |
2592 | info->origSCpnt = NULL; | |
2593 | if (info->reqSCpnt && info->reqSCpnt->device->id == SDpnt->id) | |
2594 | info->reqSCpnt = NULL; | |
2595 | info->SCpnt = NULL; | |
2596 | ||
2597 | for (i = 0; i < 8; i++) | |
2598 | clear_bit(SDpnt->id * 8 + i, info->busyluns); | |
2599 | } | |
2600 | ||
2601 | info->scsi.phase = PHASE_IDLE; | |
2602 | ||
2603 | /* | |
2604 | * Reset the SCSI bus. Device cleanup happens in | |
2605 | * the interrupt handler. | |
2606 | */ | |
2607 | fas216_cmd(info, CMD_RESETSCSI); | |
2608 | ||
2609 | mod_timer(&info->eh_timer, jiffies + HZ); | |
2610 | spin_unlock_irqrestore(&info->host_lock, flags); | |
2611 | ||
2612 | /* | |
2613 | * Wait one second for the interrupt. | |
2614 | */ | |
2615 | wait_event(info->eh_wait, info->rst_bus_status); | |
2616 | del_timer_sync(&info->eh_timer); | |
2617 | ||
2618 | fas216_log(info, LOG_ERROR, "bus reset complete: %s\n", | |
2619 | info->rst_bus_status == 1 ? "success" : "failed"); | |
2620 | ||
2621 | return info->rst_bus_status == 1 ? SUCCESS : FAILED; | |
2622 | } | |
2623 | ||
2624 | /** | |
2625 | * fas216_init_chip - Initialise FAS216 state after reset | |
2626 | * @info: state structure for interface | |
2627 | * | |
2628 | * Initialise FAS216 state after reset | |
2629 | */ | |
2630 | static void fas216_init_chip(FAS216_Info *info) | |
2631 | { | |
2632 | unsigned int clock = ((info->ifcfg.clockrate - 1) / 5 + 1) & 7; | |
2633 | fas216_writeb(info, REG_CLKF, clock); | |
2634 | fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]); | |
2635 | fas216_writeb(info, REG_CNTL2, info->scsi.cfg[1]); | |
2636 | fas216_writeb(info, REG_CNTL3, info->scsi.cfg[2]); | |
2637 | fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout); | |
2638 | fas216_writeb(info, REG_SOF, 0); | |
2639 | fas216_writeb(info, REG_STP, info->scsi.async_stp); | |
2640 | fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]); | |
2641 | } | |
2642 | ||
2643 | /** | |
2644 | * fas216_eh_host_reset - Reset the host associated with this command | |
2645 | * @SCpnt: command specifing host to reset | |
2646 | * | |
2647 | * Reset the host associated with this command. | |
2648 | * Returns: FAILED if unable to reset. | |
2649 | * Notes: io_request_lock is taken, and irqs are disabled | |
2650 | */ | |
ee0ca6ba | 2651 | int fas216_eh_host_reset(struct scsi_cmnd *SCpnt) |
1da177e4 LT |
2652 | { |
2653 | FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata; | |
2654 | ||
df0ae249 JG |
2655 | spin_lock_irq(info->host->host_lock); |
2656 | ||
1da177e4 LT |
2657 | fas216_checkmagic(info); |
2658 | ||
e04ca907 | 2659 | fas216_log(info, LOG_ERROR, "resetting host"); |
1da177e4 LT |
2660 | |
2661 | /* | |
2662 | * Reset the SCSI chip. | |
2663 | */ | |
2664 | fas216_cmd(info, CMD_RESETCHIP); | |
2665 | ||
2666 | /* | |
2667 | * Ugly ugly ugly! | |
2668 | * We need to release the host_lock and enable | |
2669 | * IRQs if we sleep, but we must relock and disable | |
2670 | * IRQs after the sleep. | |
2671 | */ | |
2672 | spin_unlock_irq(info->host->host_lock); | |
2673 | msleep(50 * 1000/100); | |
2674 | spin_lock_irq(info->host->host_lock); | |
2675 | ||
2676 | /* | |
2677 | * Release the SCSI reset. | |
2678 | */ | |
2679 | fas216_cmd(info, CMD_NOP); | |
2680 | ||
2681 | fas216_init_chip(info); | |
2682 | ||
df0ae249 | 2683 | spin_unlock_irq(info->host->host_lock); |
1da177e4 LT |
2684 | return SUCCESS; |
2685 | } | |
2686 | ||
2687 | #define TYPE_UNKNOWN 0 | |
2688 | #define TYPE_NCR53C90 1 | |
2689 | #define TYPE_NCR53C90A 2 | |
2690 | #define TYPE_NCR53C9x 3 | |
2691 | #define TYPE_Am53CF94 4 | |
2692 | #define TYPE_EmFAS216 5 | |
2693 | #define TYPE_QLFAS216 6 | |
2694 | ||
2695 | static char *chip_types[] = { | |
2696 | "unknown", | |
2697 | "NS NCR53C90", | |
2698 | "NS NCR53C90A", | |
2699 | "NS NCR53C9x", | |
2700 | "AMD Am53CF94", | |
2701 | "Emulex FAS216", | |
2702 | "QLogic FAS216" | |
2703 | }; | |
2704 | ||
2705 | static int fas216_detect_type(FAS216_Info *info) | |
2706 | { | |
2707 | int family, rev; | |
2708 | ||
2709 | /* | |
2710 | * Reset the chip. | |
2711 | */ | |
2712 | fas216_writeb(info, REG_CMD, CMD_RESETCHIP); | |
2713 | udelay(50); | |
2714 | fas216_writeb(info, REG_CMD, CMD_NOP); | |
2715 | ||
2716 | /* | |
2717 | * Check to see if control reg 2 is present. | |
2718 | */ | |
2719 | fas216_writeb(info, REG_CNTL3, 0); | |
2720 | fas216_writeb(info, REG_CNTL2, CNTL2_S2FE); | |
2721 | ||
2722 | /* | |
2723 | * If we are unable to read back control reg 2 | |
2724 | * correctly, it is not present, and we have a | |
2725 | * NCR53C90. | |
2726 | */ | |
2727 | if ((fas216_readb(info, REG_CNTL2) & (~0xe0)) != CNTL2_S2FE) | |
2728 | return TYPE_NCR53C90; | |
2729 | ||
2730 | /* | |
2731 | * Now, check control register 3 | |
2732 | */ | |
2733 | fas216_writeb(info, REG_CNTL2, 0); | |
2734 | fas216_writeb(info, REG_CNTL3, 0); | |
2735 | fas216_writeb(info, REG_CNTL3, 5); | |
2736 | ||
2737 | /* | |
2738 | * If we are unable to read the register back | |
2739 | * correctly, we have a NCR53C90A | |
2740 | */ | |
2741 | if (fas216_readb(info, REG_CNTL3) != 5) | |
2742 | return TYPE_NCR53C90A; | |
2743 | ||
2744 | /* | |
2745 | * Now read the ID from the chip. | |
2746 | */ | |
2747 | fas216_writeb(info, REG_CNTL3, 0); | |
2748 | ||
2749 | fas216_writeb(info, REG_CNTL3, CNTL3_ADIDCHK); | |
2750 | fas216_writeb(info, REG_CNTL3, 0); | |
2751 | ||
2752 | fas216_writeb(info, REG_CMD, CMD_RESETCHIP); | |
2753 | udelay(50); | |
2754 | fas216_writeb(info, REG_CMD, CMD_WITHDMA | CMD_NOP); | |
2755 | ||
2756 | fas216_writeb(info, REG_CNTL2, CNTL2_ENF); | |
2757 | fas216_writeb(info, REG_CMD, CMD_RESETCHIP); | |
2758 | udelay(50); | |
2759 | fas216_writeb(info, REG_CMD, CMD_NOP); | |
2760 | ||
2761 | rev = fas216_readb(info, REG_ID); | |
2762 | family = rev >> 3; | |
2763 | rev &= 7; | |
2764 | ||
2765 | switch (family) { | |
2766 | case 0x01: | |
2767 | if (rev == 4) | |
2768 | return TYPE_Am53CF94; | |
2769 | break; | |
2770 | ||
2771 | case 0x02: | |
2772 | switch (rev) { | |
2773 | case 2: | |
2774 | return TYPE_EmFAS216; | |
2775 | case 3: | |
2776 | return TYPE_QLFAS216; | |
2777 | } | |
2778 | break; | |
2779 | ||
2780 | default: | |
2781 | break; | |
2782 | } | |
2783 | printk("family %x rev %x\n", family, rev); | |
2784 | return TYPE_NCR53C9x; | |
2785 | } | |
2786 | ||
2787 | /** | |
2788 | * fas216_reset_state - Initialise driver internal state | |
2789 | * @info: state to initialise | |
2790 | * | |
2791 | * Initialise driver internal state | |
2792 | */ | |
2793 | static void fas216_reset_state(FAS216_Info *info) | |
2794 | { | |
2795 | int i; | |
2796 | ||
2797 | fas216_checkmagic(info); | |
2798 | ||
2799 | fas216_bus_reset(info); | |
2800 | ||
2801 | /* | |
2802 | * Clear out all stale info in our state structure | |
2803 | */ | |
2804 | memset(info->busyluns, 0, sizeof(info->busyluns)); | |
2805 | info->scsi.disconnectable = 0; | |
2806 | info->scsi.aborting = 0; | |
2807 | ||
2808 | for (i = 0; i < 8; i++) { | |
2809 | info->device[i].parity_enabled = 0; | |
2810 | info->device[i].parity_check = 1; | |
2811 | } | |
2812 | ||
2813 | /* | |
2814 | * Drain all commands on disconnected queue | |
2815 | */ | |
2816 | while (queue_remove(&info->queues.disconnected) != NULL); | |
2817 | ||
2818 | /* | |
2819 | * Remove executing commands. | |
2820 | */ | |
2821 | info->SCpnt = NULL; | |
2822 | info->reqSCpnt = NULL; | |
2823 | info->rstSCpnt = NULL; | |
2824 | info->origSCpnt = NULL; | |
2825 | } | |
2826 | ||
2827 | /** | |
2828 | * fas216_init - initialise FAS/NCR/AMD SCSI structures. | |
2829 | * @host: a driver-specific filled-out structure | |
2830 | * | |
2831 | * Initialise FAS/NCR/AMD SCSI structures. | |
2832 | * Returns: 0 on success | |
2833 | */ | |
2834 | int fas216_init(struct Scsi_Host *host) | |
2835 | { | |
2836 | FAS216_Info *info = (FAS216_Info *)host->hostdata; | |
2837 | ||
2838 | info->magic_start = MAGIC; | |
2839 | info->magic_end = MAGIC; | |
2840 | info->host = host; | |
2841 | info->scsi.cfg[0] = host->this_id | CNTL1_PERE; | |
2842 | info->scsi.cfg[1] = CNTL2_ENF | CNTL2_S2FE; | |
2843 | info->scsi.cfg[2] = info->ifcfg.cntl3 | | |
2844 | CNTL3_ADIDCHK | CNTL3_QTAG | CNTL3_G2CB | CNTL3_LBTM; | |
2845 | info->scsi.async_stp = fas216_syncperiod(info, info->ifcfg.asyncperiod); | |
2846 | ||
2847 | info->rst_dev_status = -1; | |
2848 | info->rst_bus_status = -1; | |
2849 | init_waitqueue_head(&info->eh_wait); | |
2850 | init_timer(&info->eh_timer); | |
2851 | info->eh_timer.data = (unsigned long)info; | |
2852 | info->eh_timer.function = fas216_eh_timer; | |
2853 | ||
2854 | spin_lock_init(&info->host_lock); | |
2855 | ||
2856 | memset(&info->stats, 0, sizeof(info->stats)); | |
2857 | ||
2858 | msgqueue_initialise(&info->scsi.msgs); | |
2859 | ||
2860 | if (!queue_initialise(&info->queues.issue)) | |
2861 | return -ENOMEM; | |
2862 | ||
2863 | if (!queue_initialise(&info->queues.disconnected)) { | |
2864 | queue_free(&info->queues.issue); | |
2865 | return -ENOMEM; | |
2866 | } | |
2867 | ||
2868 | return 0; | |
2869 | } | |
2870 | ||
2871 | /** | |
2872 | * fas216_add - initialise FAS/NCR/AMD SCSI ic. | |
2873 | * @host: a driver-specific filled-out structure | |
2874 | * @dev: parent device | |
2875 | * | |
2876 | * Initialise FAS/NCR/AMD SCSI ic. | |
2877 | * Returns: 0 on success | |
2878 | */ | |
2879 | int fas216_add(struct Scsi_Host *host, struct device *dev) | |
2880 | { | |
2881 | FAS216_Info *info = (FAS216_Info *)host->hostdata; | |
2882 | int type, ret; | |
2883 | ||
2884 | if (info->ifcfg.clockrate <= 10 || info->ifcfg.clockrate > 40) { | |
2885 | printk(KERN_CRIT "fas216: invalid clock rate %u MHz\n", | |
2886 | info->ifcfg.clockrate); | |
2887 | return -EINVAL; | |
2888 | } | |
2889 | ||
2890 | fas216_reset_state(info); | |
2891 | type = fas216_detect_type(info); | |
2892 | info->scsi.type = chip_types[type]; | |
2893 | ||
2894 | udelay(300); | |
2895 | ||
2896 | /* | |
2897 | * Initialise the chip correctly. | |
2898 | */ | |
2899 | fas216_init_chip(info); | |
2900 | ||
2901 | /* | |
2902 | * Reset the SCSI bus. We don't want to see | |
2903 | * the resulting reset interrupt, so mask it | |
2904 | * out. | |
2905 | */ | |
2906 | fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0] | CNTL1_DISR); | |
2907 | fas216_writeb(info, REG_CMD, CMD_RESETSCSI); | |
2908 | ||
2909 | /* | |
2910 | * scsi standard says wait 250ms | |
2911 | */ | |
2912 | spin_unlock_irq(info->host->host_lock); | |
2913 | msleep(100*1000/100); | |
2914 | spin_lock_irq(info->host->host_lock); | |
2915 | ||
2916 | fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]); | |
2917 | fas216_readb(info, REG_INST); | |
2918 | ||
2919 | fas216_checkmagic(info); | |
2920 | ||
2921 | ret = scsi_add_host(host, dev); | |
2922 | if (ret) | |
2923 | fas216_writeb(info, REG_CMD, CMD_RESETCHIP); | |
2924 | else | |
2925 | scsi_scan_host(host); | |
2926 | ||
2927 | return ret; | |
2928 | } | |
2929 | ||
2930 | void fas216_remove(struct Scsi_Host *host) | |
2931 | { | |
2932 | FAS216_Info *info = (FAS216_Info *)host->hostdata; | |
2933 | ||
2934 | fas216_checkmagic(info); | |
2935 | scsi_remove_host(host); | |
2936 | ||
2937 | fas216_writeb(info, REG_CMD, CMD_RESETCHIP); | |
2938 | scsi_host_put(host); | |
2939 | } | |
2940 | ||
2941 | /** | |
2942 | * fas216_release - release all resources for FAS/NCR/AMD SCSI ic. | |
2943 | * @host: a driver-specific filled-out structure | |
2944 | * | |
2945 | * release all resources and put everything to bed for FAS/NCR/AMD SCSI ic. | |
2946 | */ | |
2947 | void fas216_release(struct Scsi_Host *host) | |
2948 | { | |
2949 | FAS216_Info *info = (FAS216_Info *)host->hostdata; | |
2950 | ||
2951 | queue_free(&info->queues.disconnected); | |
2952 | queue_free(&info->queues.issue); | |
2953 | } | |
2954 | ||
9d4e5c54 | 2955 | void fas216_print_host(FAS216_Info *info, struct seq_file *m) |
1da177e4 | 2956 | { |
9d4e5c54 | 2957 | seq_printf(m, |
1da177e4 LT |
2958 | "\n" |
2959 | "Chip : %s\n" | |
2960 | " Address: 0x%p\n" | |
2961 | " IRQ : %d\n" | |
2962 | " DMA : %d\n", | |
2963 | info->scsi.type, info->scsi.io_base, | |
2964 | info->scsi.irq, info->scsi.dma); | |
2965 | } | |
2966 | ||
9d4e5c54 | 2967 | void fas216_print_stats(FAS216_Info *info, struct seq_file *m) |
1da177e4 | 2968 | { |
9d4e5c54 | 2969 | seq_printf(m, "\n" |
1da177e4 LT |
2970 | "Command Statistics:\n" |
2971 | " Queued : %u\n" | |
2972 | " Issued : %u\n" | |
2973 | " Completed : %u\n" | |
2974 | " Reads : %u\n" | |
2975 | " Writes : %u\n" | |
2976 | " Others : %u\n" | |
2977 | " Disconnects: %u\n" | |
2978 | " Aborts : %u\n" | |
2979 | " Bus resets : %u\n" | |
2980 | " Host resets: %u\n", | |
2981 | info->stats.queues, info->stats.removes, | |
2982 | info->stats.fins, info->stats.reads, | |
2983 | info->stats.writes, info->stats.miscs, | |
2984 | info->stats.disconnects, info->stats.aborts, | |
2985 | info->stats.bus_resets, info->stats.host_resets); | |
1da177e4 LT |
2986 | } |
2987 | ||
9d4e5c54 | 2988 | void fas216_print_devices(FAS216_Info *info, struct seq_file *m) |
1da177e4 LT |
2989 | { |
2990 | struct fas216_device *dev; | |
f64a181d | 2991 | struct scsi_device *scd; |
1da177e4 | 2992 | |
9d4e5c54 | 2993 | seq_printf(m, "Device/Lun TaggedQ Parity Sync\n"); |
1da177e4 LT |
2994 | |
2995 | shost_for_each_device(scd, info->host) { | |
2996 | dev = &info->device[scd->id]; | |
9cb78c16 | 2997 | seq_printf(m, " %d/%llu ", scd->id, scd->lun); |
1da177e4 | 2998 | if (scd->tagged_supported) |
9d4e5c54 | 2999 | seq_printf(m, "%3sabled(%3d) ", |
1da177e4 LT |
3000 | scd->simple_tags ? "en" : "dis", |
3001 | scd->current_tag); | |
3002 | else | |
9d4e5c54 | 3003 | seq_printf(m, "unsupported "); |
1da177e4 | 3004 | |
9d4e5c54 | 3005 | seq_printf(m, "%3sabled ", dev->parity_enabled ? "en" : "dis"); |
1da177e4 LT |
3006 | |
3007 | if (dev->sof) | |
9d4e5c54 | 3008 | seq_printf(m, "offset %d, %d ns\n", |
1da177e4 LT |
3009 | dev->sof, dev->period * 4); |
3010 | else | |
9d4e5c54 | 3011 | seq_printf(m, "async\n"); |
1da177e4 | 3012 | } |
1da177e4 LT |
3013 | } |
3014 | ||
3015 | EXPORT_SYMBOL(fas216_init); | |
3016 | EXPORT_SYMBOL(fas216_add); | |
3017 | EXPORT_SYMBOL(fas216_queue_command); | |
3018 | EXPORT_SYMBOL(fas216_noqueue_command); | |
3019 | EXPORT_SYMBOL(fas216_intr); | |
3020 | EXPORT_SYMBOL(fas216_remove); | |
3021 | EXPORT_SYMBOL(fas216_release); | |
3022 | EXPORT_SYMBOL(fas216_eh_abort); | |
3023 | EXPORT_SYMBOL(fas216_eh_device_reset); | |
3024 | EXPORT_SYMBOL(fas216_eh_bus_reset); | |
3025 | EXPORT_SYMBOL(fas216_eh_host_reset); | |
3026 | EXPORT_SYMBOL(fas216_print_host); | |
3027 | EXPORT_SYMBOL(fas216_print_stats); | |
3028 | EXPORT_SYMBOL(fas216_print_devices); | |
3029 | ||
3030 | MODULE_AUTHOR("Russell King"); | |
3031 | MODULE_DESCRIPTION("Generic FAS216/NCR53C9x driver core"); | |
3032 | MODULE_LICENSE("GPL"); |