File: | obj-scan-build/../linux/src/drivers/scsi/aha1542.c |
Location: | line 828, column 5 |
Description: | Value stored to 'i' is never read |
1 | /* $Id: aha1542.c,v 1.1 1999/04/26 05:54:11 tb Exp $ |
2 | * linux/kernel/aha1542.c |
3 | * |
4 | * Copyright (C) 1992 Tommy Thorn |
5 | * Copyright (C) 1993, 1994, 1995 Eric Youngdale |
6 | * |
7 | * Modified by Eric Youngdale |
8 | * Use request_irq and request_dma to help prevent unexpected conflicts |
9 | * Set up on-board DMA controller, such that we do not have to |
10 | * have the bios enabled to use the aha1542. |
11 | * Modified by David Gentzel |
12 | * Don't call request_dma if dma mask is 0 (for BusLogic BT-445S VL-Bus |
13 | * controller). |
14 | * Modified by Matti Aarnio |
15 | * Accept parameters from LILO cmd-line. -- 1-Oct-94 |
16 | * Modified by Mike McLagan <mike.mclagan@linux.org> |
17 | * Recognise extended mode on AHA1542CP, different bit than 1542CF |
18 | * 1-Jan-97 |
19 | * Modified by Bjorn L. Thordarson and Einar Thor Einarsson |
20 | * Recognize that DMA0 is valid DMA channel -- 13-Jul-98 |
21 | */ |
22 | |
23 | #include <linux/module.h> |
24 | |
25 | #include <linux/kernel.h> |
26 | #include <linux/head.h> |
27 | #include <linux/types.h> |
28 | #include <linux/string.h> |
29 | #include <linux/ioport.h> |
30 | #include <linux/delay.h> |
31 | #include <linux/sched.h> |
32 | #include <linux/proc_fs.h> |
33 | #include <asm/dma.h> |
34 | #include <asm/system.h> |
35 | #include <asm/io.h> |
36 | #include <linux/blk.h> |
37 | #include "scsi.h" |
38 | #include "hosts.h" |
39 | |
40 | |
41 | #include "aha1542.h" |
42 | |
43 | #include<linux/stat.h> |
44 | |
45 | struct proc_dir_entry proc_scsi_aha1542 = { |
46 | PROC_SCSI_AHA1542, 7, "aha1542", |
47 | S_IFDIR0040000 | S_IRUGO(00400|00040|00004) | S_IXUGO(00100|00010|00001), 2 |
48 | }; |
49 | |
50 | #ifdef DEBUG |
51 | #define DEB(x) x |
52 | #else |
53 | #define DEB(x) |
54 | #endif |
55 | /* |
56 | static const char RCSid[] = "$Header: cvs/gnumach/linux/src/drivers/scsi/Attic/aha1542.c,v 1.1 1999/04/26 05:54:11 tb Exp $"; |
57 | */ |
58 | |
59 | /* The adaptec can be configured for quite a number of addresses, but |
60 | I generally do not want the card poking around at random. We allow |
61 | two addresses - this allows people to use the Adaptec with a Midi |
62 | card, which also used 0x330 -- can be overridden with LILO! */ |
63 | |
64 | #define MAXBOARDS2 2 /* Increase this and the sizes of the |
65 | arrays below, if you need more.. */ |
66 | |
67 | static unsigned int bases[MAXBOARDS2]={0x330, 0x334}; |
68 | |
69 | /* set by aha1542_setup according to the command line */ |
70 | static int setup_called[MAXBOARDS2] = {0,0}; |
71 | static int setup_buson[MAXBOARDS2] = {0,0}; |
72 | static int setup_busoff[MAXBOARDS2] = {0,0}; |
73 | static int setup_dmaspeed[MAXBOARDS2] = {-1,-1}; |
74 | |
75 | static char *setup_str[MAXBOARDS2] = {(char *)NULL((void *) 0),(char *)NULL((void *) 0)}; |
76 | |
77 | /* |
78 | * LILO params: aha1542=<PORTBASE>[,<BUSON>,<BUSOFF>[,<DMASPEED>]] |
79 | * |
80 | * Where: <PORTBASE> is any of the valid AHA addresses: |
81 | * 0x130, 0x134, 0x230, 0x234, 0x330, 0x334 |
82 | * <BUSON> is the time (in microsecs) that AHA spends on the AT-bus |
83 | * when transferring data. 1542A power-on default is 11us, |
84 | * valid values are in range: 2..15 (decimal) |
85 | * <BUSOFF> is the time that AHA spends OFF THE BUS after while |
86 | * it is transferring data (not to monopolize the bus). |
87 | * Power-on default is 4us, valid range: 1..64 microseconds. |
88 | * <DMASPEED> Default is jumper selected (1542A: on the J1), |
89 | * but experimenter can alter it with this. |
90 | * Valid values: 5, 6, 7, 8, 10 (MB/s) |
91 | * Factory default is 5 MB/s. |
92 | */ |
93 | |
94 | #define BIOS_TRANSLATION_16320 0 /* Used by some old 1542A boards */ |
95 | #define BIOS_TRANSLATION_64321 1 /* Default case these days */ |
96 | #define BIOS_TRANSLATION_255632 2 /* Big disk case */ |
97 | |
98 | struct aha1542_hostdata{ |
99 | /* This will effectively start both of them at the first mailbox */ |
100 | int bios_translation; /* Mapping bios uses - for compatibility */ |
101 | int aha1542_last_mbi_used; |
102 | int aha1542_last_mbo_used; |
103 | Scsi_Cmnd * SCint[AHA1542_MAILBOXES8]; |
104 | struct mailbox mb[2*AHA1542_MAILBOXES8]; |
105 | struct ccb ccb[AHA1542_MAILBOXES8]; |
106 | }; |
107 | |
108 | #define HOSTDATA(host)((struct aha1542_hostdata *) &host->hostdata) ((struct aha1542_hostdata *) &host->hostdata) |
109 | |
110 | static struct Scsi_Host * aha_host[7] = {NULL((void *) 0),}; /* One for each IRQ level (9-15) */ |
111 | |
112 | |
113 | |
114 | |
115 | #define WAITnexttimeout3000000 3000000 |
116 | |
117 | static void setup_mailboxes(int base_io, struct Scsi_Host * shpnt); |
118 | static int aha1542_restart(struct Scsi_Host * shost); |
119 | |
120 | #define aha1542_intr_reset(base)((__builtin_constant_p((base)) && (base) < 256) ? __outbc ((0x20),(base)) : __outb((0x20),(base))) outb(IRST, CONTROL(base))((__builtin_constant_p((base)) && (base) < 256) ? __outbc ((0x20),(base)) : __outb((0x20),(base))) |
121 | |
122 | #define WAIT(port, mask, allof, noneof){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((port)) && ( port) < 256) ? __inbc(port) : __inb(port)) & (mask); if ((WAITbits & (allof)) == (allof) && ((WAITbits & (noneof)) == 0)) break; if (--WAITtimeout == 0) goto fail; } } \ |
123 | { register int WAITbits; \ |
124 | register int WAITtimeout = WAITnexttimeout3000000; \ |
125 | while (1) { \ |
126 | WAITbits = inb(port)((__builtin_constant_p((port)) && (port) < 256) ? __inbc (port) : __inb(port)) & (mask); \ |
127 | if ((WAITbits & (allof)) == (allof) && ((WAITbits & (noneof)) == 0)) \ |
128 | break; \ |
129 | if (--WAITtimeout == 0) goto fail; \ |
130 | } \ |
131 | } |
132 | |
133 | /* Similar to WAIT, except we use the udelay call to regulate the |
134 | amount of time we wait. */ |
135 | #define WAITd(port, mask, allof, noneof, timeout){ register int WAITbits; register int WAITtimeout = timeout; while (1) { WAITbits = ((__builtin_constant_p((port)) && ( port) < 256) ? __inbc(port) : __inb(port)) & (mask); if ((WAITbits & (allof)) == (allof) && ((WAITbits & (noneof)) == 0)) break; (__builtin_constant_p(1000) ? __const_udelay ((1000) * 0x10c6ul) : __udelay(1000)); if (--WAITtimeout == 0 ) goto fail; } } \ |
136 | { register int WAITbits; \ |
137 | register int WAITtimeout = timeout; \ |
138 | while (1) { \ |
139 | WAITbits = inb(port)((__builtin_constant_p((port)) && (port) < 256) ? __inbc (port) : __inb(port)) & (mask); \ |
140 | if ((WAITbits & (allof)) == (allof) && ((WAITbits & (noneof)) == 0)) \ |
141 | break; \ |
142 | udelay(1000)(__builtin_constant_p(1000) ? __const_udelay((1000) * 0x10c6ul ) : __udelay(1000)); \ |
143 | if (--WAITtimeout == 0) goto fail; \ |
144 | } \ |
145 | } |
146 | |
147 | static void aha1542_stat(void) |
148 | { |
149 | /* int s = inb(STATUS), i = inb(INTRFLAGS); |
150 | printk("status=%x intrflags=%x\n", s, i, WAITnexttimeout-WAITtimeout); */ |
151 | } |
152 | |
153 | /* This is a bit complicated, but we need to make sure that an interrupt |
154 | routine does not send something out while we are in the middle of this. |
155 | Fortunately, it is only at boot time that multi-byte messages |
156 | are ever sent. */ |
157 | static int aha1542_out(unsigned int base, unchar *cmdp, int len) |
158 | { |
159 | unsigned long flags = 0; |
160 | |
161 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
162 | if(len == 1) { |
163 | while(1==1){ |
164 | WAIT(STATUS(base), CDF, 0, CDF){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((base)) && ( base) < 256) ? __inbc(base) : __inb(base)) & (0x08); if ((WAITbits & (0)) == (0) && ((WAITbits & (0x08 )) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
165 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
166 | if(inb(STATUS(base))((__builtin_constant_p((base)) && (base) < 256) ? __inbc (base) : __inb(base)) & CDF0x08) {restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); continue;} |
167 | outb(*cmdp, DATA(base))((__builtin_constant_p(((base+1))) && ((base+1)) < 256) ? __outbc((*cmdp),((base+1))) : __outb((*cmdp),((base+1 )))); |
168 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
169 | return 0; |
170 | } |
171 | } else { |
172 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
173 | while (len--) |
174 | { |
175 | WAIT(STATUS(base), CDF, 0, CDF){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((base)) && ( base) < 256) ? __inbc(base) : __inb(base)) & (0x08); if ((WAITbits & (0)) == (0) && ((WAITbits & (0x08 )) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
176 | outb(*cmdp++, DATA(base))((__builtin_constant_p(((base+1))) && ((base+1)) < 256) ? __outbc((*cmdp++),((base+1))) : __outb((*cmdp++),((base +1)))); |
177 | } |
178 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
179 | } |
180 | return 0; |
181 | fail: |
182 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
183 | printk("aha1542_out failed(%d): ", len+1); aha1542_stat(); |
184 | return 1; |
185 | } |
186 | |
187 | /* Only used at boot time, so we do not need to worry about latency as much |
188 | here */ |
189 | static int aha1542_in(unsigned int base, unchar *cmdp, int len) |
190 | { |
191 | unsigned long flags; |
192 | |
193 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
194 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
195 | while (len--) |
196 | { |
197 | WAIT(STATUS(base), DF, DF, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((base)) && ( base) < 256) ? __inbc(base) : __inb(base)) & (0x04); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
198 | *cmdp++ = inb(DATA(base))((__builtin_constant_p(((base+1))) && ((base+1)) < 256) ? __inbc((base+1)) : __inb((base+1))); |
199 | } |
200 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
201 | return 0; |
202 | fail: |
203 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
204 | printk("aha1542_in failed(%d): ", len+1); aha1542_stat(); |
205 | return 1; |
206 | } |
207 | |
208 | /* Similar to aha1542_in, except that we wait a very short period of time. |
209 | We use this if we know the board is alive and awake, but we are not sure |
210 | if the board will respond to the command we are about to send or not */ |
211 | static int aha1542_in1(unsigned int base, unchar *cmdp, int len) |
212 | { |
213 | unsigned long flags; |
214 | |
215 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
216 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
217 | while (len--) |
218 | { |
219 | WAITd(STATUS(base), DF, DF, 0, 100){ register int WAITbits; register int WAITtimeout = 100; while (1) { WAITbits = ((__builtin_constant_p((base)) && ( base) < 256) ? __inbc(base) : __inb(base)) & (0x04); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; (__builtin_constant_p(1000) ? __const_udelay ((1000) * 0x10c6ul) : __udelay(1000)); if (--WAITtimeout == 0 ) goto fail; } }; |
220 | *cmdp++ = inb(DATA(base))((__builtin_constant_p(((base+1))) && ((base+1)) < 256) ? __inbc((base+1)) : __inb((base+1))); |
221 | } |
222 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
223 | return 0; |
224 | fail: |
225 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
226 | return 1; |
227 | } |
228 | |
229 | static int makecode(unsigned hosterr, unsigned scsierr) |
230 | { |
231 | switch (hosterr) { |
232 | case 0x0: |
233 | case 0xa: /* Linked command complete without error and linked normally */ |
234 | case 0xb: /* Linked command complete without error, interrupt generated */ |
235 | hosterr = 0; |
236 | break; |
237 | |
238 | case 0x11: /* Selection time out-The initiator selection or target |
239 | reselection was not complete within the SCSI Time out period */ |
240 | hosterr = DID_TIME_OUT0x03; |
241 | break; |
242 | |
243 | case 0x12: /* Data overrun/underrun-The target attempted to transfer more data |
244 | than was allocated by the Data Length field or the sum of the |
245 | Scatter / Gather Data Length fields. */ |
246 | |
247 | case 0x13: /* Unexpected bus free-The target dropped the SCSI BSY at an unexpected time. */ |
248 | |
249 | case 0x15: /* MBO command was not 00, 01 or 02-The first byte of the CB was |
250 | invalid. This usually indicates a software failure. */ |
251 | |
252 | case 0x16: /* Invalid CCB Operation Code-The first byte of the CCB was invalid. |
253 | This usually indicates a software failure. */ |
254 | |
255 | case 0x17: /* Linked CCB does not have the same LUN-A subsequent CCB of a set |
256 | of linked CCB's does not specify the same logical unit number as |
257 | the first. */ |
258 | case 0x18: /* Invalid Target Direction received from Host-The direction of a |
259 | Target Mode CCB was invalid. */ |
260 | |
261 | case 0x19: /* Duplicate CCB Received in Target Mode-More than once CCB was |
262 | received to service data transfer between the same target LUN |
263 | and initiator SCSI ID in the same direction. */ |
264 | |
265 | case 0x1a: /* Invalid CCB or Segment List Parameter-A segment list with a zero |
266 | length segment or invalid segment list boundaries was received. |
267 | A CCB parameter was invalid. */ |
268 | DEB(printk("Aha1542: %x %x\n", hosterr, scsierr)); |
269 | hosterr = DID_ERROR0x07; /* Couldn't find any better */ |
270 | break; |
271 | |
272 | case 0x14: /* Target bus phase sequence failure-An invalid bus phase or bus |
273 | phase sequence was requested by the target. The host adapter |
274 | will generate a SCSI Reset Condition, notifying the host with |
275 | a SCRD interrupt */ |
276 | hosterr = DID_RESET0x08; |
277 | break; |
278 | default: |
279 | printk("makecode: unknown hoststatus %x\n", hosterr); |
280 | break; |
281 | } |
282 | return scsierr|(hosterr << 16); |
283 | } |
284 | |
285 | static int aha1542_test_port(int bse, struct Scsi_Host * shpnt) |
286 | { |
287 | int i; |
288 | unchar inquiry_cmd[] = {CMD_INQUIRY0x04 }; |
289 | unchar inquiry_result[4]; |
290 | unchar *cmdp; |
291 | int len; |
292 | volatile int debug = 0; |
293 | |
294 | /* Quick and dirty test for presence of the card. */ |
295 | if(inb(STATUS(bse))((__builtin_constant_p((bse)) && (bse) < 256) ? __inbc (bse) : __inb(bse)) == 0xff) return 0; |
296 | |
297 | /* Reset the adapter. I ought to make a hard reset, but it's not really necessary */ |
298 | |
299 | /* DEB(printk("aha1542_test_port called \n")); */ |
300 | |
301 | /* In case some other card was probing here, reset interrupts */ |
302 | aha1542_intr_reset(bse)((__builtin_constant_p((bse)) && (bse) < 256) ? __outbc ((0x20),(bse)) : __outb((0x20),(bse))); /* reset interrupts, so they don't block */ |
303 | |
304 | outb(SRST|IRST/*|SCRST*/, CONTROL(bse))((__builtin_constant_p((bse)) && (bse) < 256) ? __outbc ((0x40|0x20),(bse)) : __outb((0x40|0x20),(bse))); |
305 | |
306 | i = jiffies + 2; |
307 | while (i>jiffies); /* Wait a little bit for things to settle down. */ |
308 | |
309 | debug = 1; |
310 | /* Expect INIT and IDLE, any of the others are bad */ |
311 | WAIT(STATUS(bse), STATMASK, INIT|IDLE, STST|DIAGF|INVDCMD|DF|CDF){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((bse)) && (bse ) < 256) ? __inbc(bse) : __inb(bse)) & (0xfd); if ((WAITbits & (0x20|0x10)) == (0x20|0x10) && ((WAITbits & (0x80|0x40|0x01|0x04|0x08)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
312 | |
313 | debug = 2; |
314 | /* Shouldn't have generated any interrupts during reset */ |
315 | if (inb(INTRFLAGS(bse))((__builtin_constant_p(((bse+2))) && ((bse+2)) < 256 ) ? __inbc((bse+2)) : __inb((bse+2)))&INTRMASK0x8f) goto fail; |
316 | |
317 | |
318 | /* Perform a host adapter inquiry instead so we do not need to set |
319 | up the mailboxes ahead of time */ |
320 | |
321 | aha1542_out(bse, inquiry_cmd, 1); |
322 | |
323 | debug = 3; |
324 | len = 4; |
325 | cmdp = &inquiry_result[0]; |
326 | |
327 | while (len--) |
328 | { |
329 | WAIT(STATUS(bse), DF, DF, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((bse)) && (bse ) < 256) ? __inbc(bse) : __inb(bse)) & (0x04); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0 )) break; if (--WAITtimeout == 0) goto fail; } }; |
330 | *cmdp++ = inb(DATA(bse))((__builtin_constant_p(((bse+1))) && ((bse+1)) < 256 ) ? __inbc((bse+1)) : __inb((bse+1))); |
331 | } |
332 | |
333 | debug = 8; |
334 | /* Reading port should reset DF */ |
335 | if (inb(STATUS(bse))((__builtin_constant_p((bse)) && (bse) < 256) ? __inbc (bse) : __inb(bse)) & DF0x04) goto fail; |
336 | |
337 | debug = 9; |
338 | /* When HACC, command is completed, and we're though testing */ |
339 | WAIT(INTRFLAGS(bse), HACC, HACC, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((bse+2))) && ((bse+2)) < 256) ? __inbc((bse+2)) : __inb((bse+2))) & (0x04); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
340 | /* now initialize adapter */ |
341 | |
342 | debug = 10; |
343 | /* Clear interrupts */ |
344 | outb(IRST, CONTROL(bse))((__builtin_constant_p((bse)) && (bse) < 256) ? __outbc ((0x20),(bse)) : __outb((0x20),(bse))); |
345 | |
346 | debug = 11; |
347 | |
348 | return debug; /* 1 = ok */ |
349 | fail: |
350 | return 0; /* 0 = not ok */ |
351 | } |
352 | |
353 | /* A "high" level interrupt handler */ |
354 | static void aha1542_intr_handle(int irq, void *dev_id, struct pt_regs *regs) |
355 | { |
356 | void (*my_done)(Scsi_Cmnd *) = NULL((void *) 0); |
357 | int errstatus, mbi, mbo, mbistatus; |
358 | int number_serviced; |
359 | unsigned long flags; |
360 | struct Scsi_Host * shost; |
361 | Scsi_Cmnd * SCtmp; |
362 | int flag; |
363 | int needs_restart; |
364 | struct mailbox * mb; |
365 | struct ccb *ccb; |
366 | |
367 | shost = aha_host[irq - 9]; |
368 | if(!shost) panic("Splunge!"); |
369 | |
370 | mb = HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->mb; |
371 | ccb = HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->ccb; |
372 | |
373 | #ifdef DEBUG |
374 | { |
375 | flag = inb(INTRFLAGS(shost->io_port))((__builtin_constant_p(((shost->io_port+2))) && (( shost->io_port+2)) < 256) ? __inbc((shost->io_port+2 )) : __inb((shost->io_port+2))); |
376 | printk("aha1542_intr_handle: "); |
377 | if (!(flag&ANYINTR0x80)) printk("no interrupt?"); |
378 | if (flag&MBIF0x01) printk("MBIF "); |
379 | if (flag&MBOA0x02) printk("MBOF "); |
380 | if (flag&HACC0x04) printk("HACC "); |
381 | if (flag&SCRD0x08) printk("SCRD "); |
382 | printk("status %02x\n", inb(STATUS(shost->io_port))((__builtin_constant_p((shost->io_port)) && (shost ->io_port) < 256) ? __inbc(shost->io_port) : __inb(shost ->io_port))); |
383 | }; |
384 | #endif |
385 | number_serviced = 0; |
386 | needs_restart = 0; |
387 | |
388 | while(1==1){ |
389 | flag = inb(INTRFLAGS(shost->io_port))((__builtin_constant_p(((shost->io_port+2))) && (( shost->io_port+2)) < 256) ? __inbc((shost->io_port+2 )) : __inb((shost->io_port+2))); |
390 | |
391 | /* Check for unusual interrupts. If any of these happen, we should |
392 | probably do something special, but for now just printing a message |
393 | is sufficient. A SCSI reset detected is something that we really |
394 | need to deal with in some way. */ |
395 | if (flag & ~MBIF0x01) { |
396 | if (flag&MBOA0x02) printk("MBOF "); |
397 | if (flag&HACC0x04) printk("HACC "); |
398 | if (flag&SCRD0x08) { |
399 | needs_restart = 1; |
400 | printk("SCRD "); |
401 | } |
402 | } |
403 | |
404 | aha1542_intr_reset(shost->io_port)((__builtin_constant_p((shost->io_port)) && (shost ->io_port) < 256) ? __outbc((0x20),(shost->io_port)) : __outb((0x20),(shost->io_port))); |
405 | |
406 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
407 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
408 | mbi = HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->aha1542_last_mbi_used + 1; |
409 | if (mbi >= 2*AHA1542_MAILBOXES8) mbi = AHA1542_MAILBOXES8; |
410 | |
411 | do{ |
412 | if(mb[mbi].status != 0) break; |
413 | mbi++; |
414 | if (mbi >= 2*AHA1542_MAILBOXES8) mbi = AHA1542_MAILBOXES8; |
415 | } while (mbi != HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->aha1542_last_mbi_used); |
416 | |
417 | if(mb[mbi].status == 0){ |
418 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
419 | /* Hmm, no mail. Must have read it the last time around */ |
420 | if (!number_serviced && !needs_restart) |
421 | printk("aha1542.c: interrupt received, but no mail.\n"); |
422 | /* We detected a reset. Restart all pending commands for |
423 | devices that use the hard reset option */ |
424 | if(needs_restart) aha1542_restart(shost); |
425 | return; |
426 | }; |
427 | |
428 | mbo = (scsi2int(mb[mbi].ccbptr)( (((long)*(mb[mbi].ccbptr)) << 16) + (((long)(mb[mbi]. ccbptr)[1]) << 8) + ((long)(mb[mbi].ccbptr)[2]) ) - ((unsigned int) &ccb[0])) / sizeof(struct ccb); |
429 | mbistatus = mb[mbi].status; |
430 | mb[mbi].status = 0; |
431 | HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->aha1542_last_mbi_used = mbi; |
432 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
433 | |
434 | #ifdef DEBUG |
435 | { |
436 | if (ccb[mbo].tarstat|ccb[mbo].hastat) |
437 | printk("aha1542_command: returning %x (status %d)\n", |
438 | ccb[mbo].tarstat + ((int) ccb[mbo].hastat << 16), mb[mbi].status); |
439 | }; |
440 | #endif |
441 | |
442 | if(mbistatus == 3) continue; /* Aborted command not found */ |
443 | |
444 | #ifdef DEBUG |
445 | printk("...done %d %d\n",mbo, mbi); |
446 | #endif |
447 | |
448 | SCtmp = HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->SCint[mbo]; |
449 | |
450 | if (!SCtmp || !SCtmp->scsi_done) { |
451 | printk("aha1542_intr_handle: Unexpected interrupt\n"); |
452 | printk("tarstat=%x, hastat=%x idlun=%x ccb#=%d \n", ccb[mbo].tarstat, |
453 | ccb[mbo].hastat, ccb[mbo].idlun, mbo); |
454 | return; |
455 | } |
456 | |
457 | my_done = SCtmp->scsi_done; |
458 | if (SCtmp->host_scribble) scsi_free(SCtmp->host_scribble, 512); |
459 | |
460 | /* Fetch the sense data, and tuck it away, in the required slot. The |
461 | Adaptec automatically fetches it, and there is no guarantee that |
462 | we will still have it in the cdb when we come back */ |
463 | if (ccb[mbo].tarstat == 2) |
464 | memcpy(SCtmp->sense_buffer, &ccb[mbo].cdb[ccb[mbo].cdblen],(__builtin_constant_p(sizeof(SCtmp->sense_buffer)) ? __constant_memcpy ((SCtmp->sense_buffer),(&ccb[mbo].cdb[ccb[mbo].cdblen] ),(sizeof(SCtmp->sense_buffer))) : __memcpy((SCtmp->sense_buffer ),(&ccb[mbo].cdb[ccb[mbo].cdblen]),(sizeof(SCtmp->sense_buffer )))) |
465 | sizeof(SCtmp->sense_buffer))(__builtin_constant_p(sizeof(SCtmp->sense_buffer)) ? __constant_memcpy ((SCtmp->sense_buffer),(&ccb[mbo].cdb[ccb[mbo].cdblen] ),(sizeof(SCtmp->sense_buffer))) : __memcpy((SCtmp->sense_buffer ),(&ccb[mbo].cdb[ccb[mbo].cdblen]),(sizeof(SCtmp->sense_buffer )))); |
466 | |
467 | |
468 | /* is there mail :-) */ |
469 | |
470 | /* more error checking left out here */ |
471 | if (mbistatus != 1) |
472 | /* This is surely wrong, but I don't know what's right */ |
473 | errstatus = makecode(ccb[mbo].hastat, ccb[mbo].tarstat); |
474 | else |
475 | errstatus = 0; |
476 | |
477 | #ifdef DEBUG |
478 | if(errstatus) printk("(aha1542 error:%x %x %x) ",errstatus, |
479 | ccb[mbo].hastat, ccb[mbo].tarstat); |
480 | #endif |
481 | |
482 | if (ccb[mbo].tarstat == 2) { |
483 | #ifdef DEBUG |
484 | int i; |
485 | #endif |
486 | DEB(printk("aha1542_intr_handle: sense:")); |
487 | #ifdef DEBUG |
488 | for (i = 0; i < 12; i++) |
489 | printk("%02x ", ccb[mbo].cdb[ccb[mbo].cdblen+i]); |
490 | printk("\n"); |
491 | #endif |
492 | /* |
493 | DEB(printk("aha1542_intr_handle: buf:")); |
494 | for (i = 0; i < bufflen; i++) |
495 | printk("%02x ", ((unchar *)buff)[i]); |
496 | printk("\n"); |
497 | */ |
498 | } |
499 | DEB(if (errstatus) printk("aha1542_intr_handle: returning %6x\n", errstatus)); |
500 | SCtmp->result = errstatus; |
501 | HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->SCint[mbo] = NULL((void *) 0); /* This effectively frees up the mailbox slot, as |
502 | far as queuecommand is concerned */ |
503 | my_done(SCtmp); |
504 | number_serviced++; |
505 | }; |
506 | } |
507 | |
508 | int aha1542_queuecommand(Scsi_Cmnd * SCpnt, void (*done)(Scsi_Cmnd *)) |
509 | { |
510 | unchar ahacmd = CMD_START_SCSI0x02; |
511 | unchar direction; |
512 | unchar *cmd = (unchar *) SCpnt->cmnd; |
513 | unchar target = SCpnt->target; |
514 | unchar lun = SCpnt->lun; |
515 | unsigned long flags; |
516 | void *buff = SCpnt->request_buffer; |
517 | int bufflen = SCpnt->request_bufflen; |
518 | int mbo; |
519 | struct mailbox * mb; |
520 | struct ccb *ccb; |
521 | |
522 | DEB(int i); |
523 | |
524 | mb = HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->mb; |
525 | ccb = HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->ccb; |
526 | |
527 | DEB(if (target > 1) { |
528 | SCpnt->result = DID_TIME_OUT << 16; |
529 | done(SCpnt); return 0;}); |
530 | |
531 | if(*cmd == REQUEST_SENSE0x03){ |
532 | #ifndef DEBUG |
533 | if (bufflen != sizeof(SCpnt->sense_buffer)) { |
534 | printk("Wrong buffer length supplied for request sense (%d)\n",bufflen); |
535 | }; |
536 | #endif |
537 | SCpnt->result = 0; |
538 | done(SCpnt); |
539 | return 0; |
540 | }; |
541 | |
542 | #ifdef DEBUG |
543 | if (*cmd == READ_100x28 || *cmd == WRITE_100x2a) |
544 | i = xscsi2int(cmd+2)( (((long)(cmd+2)[0]) << 24) + (((long)(cmd+2)[1]) << 16) + (((long)(cmd+2)[2]) << 8) + ((long)(cmd+2)[3]) ); |
545 | else if (*cmd == READ_60x08 || *cmd == WRITE_60x0a) |
546 | i = scsi2int(cmd+2)( (((long)*(cmd+2)) << 16) + (((long)(cmd+2)[1]) << 8) + ((long)(cmd+2)[2]) ); |
547 | else |
548 | i = -1; |
549 | if (done) |
550 | printk("aha1542_queuecommand: dev %d cmd %02x pos %d len %d ", target, *cmd, i, bufflen); |
551 | else |
552 | printk("aha1542_command: dev %d cmd %02x pos %d len %d ", target, *cmd, i, bufflen); |
553 | aha1542_stat(); |
554 | printk("aha1542_queuecommand: dumping scsi cmd:"); |
555 | for (i = 0; i < SCpnt->cmd_len; i++) printk("%02x ", cmd[i]); |
556 | printk("\n"); |
557 | if (*cmd == WRITE_100x2a || *cmd == WRITE_60x0a) |
558 | return 0; /* we are still testing, so *don't* write */ |
559 | #endif |
560 | /* Use the outgoing mailboxes in a round-robin fashion, because this |
561 | is how the host adapter will scan for them */ |
562 | |
563 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
564 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
565 | mbo = HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->aha1542_last_mbo_used + 1; |
566 | if (mbo >= AHA1542_MAILBOXES8) mbo = 0; |
567 | |
568 | do{ |
569 | if(mb[mbo].status == 0 && HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[mbo] == NULL((void *) 0)) |
570 | break; |
571 | mbo++; |
572 | if (mbo >= AHA1542_MAILBOXES8) mbo = 0; |
573 | } while (mbo != HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->aha1542_last_mbo_used); |
574 | |
575 | if(mb[mbo].status || HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[mbo]) |
576 | panic("Unable to find empty mailbox for aha1542.\n"); |
577 | |
578 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[mbo] = SCpnt; /* This will effectively prevent someone else from |
579 | screwing with this cdb. */ |
580 | |
581 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->aha1542_last_mbo_used = mbo; |
582 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
583 | |
584 | #ifdef DEBUG |
585 | printk("Sending command (%d %x)...",mbo, done); |
586 | #endif |
587 | |
588 | any2scsi(mb[mbo].ccbptr, &ccb[mbo])(mb[mbo].ccbptr)[0] = (((unsigned long)(&ccb[mbo])) >> 16) ; (mb[mbo].ccbptr)[1] = (((unsigned long)(&ccb[mbo]) ) >> 8); (mb[mbo].ccbptr)[2] = ((unsigned long)(&ccb [mbo]));; /* This gets trashed for some reason*/ |
589 | |
590 | memset(&ccb[mbo], 0, sizeof(struct ccb))(__builtin_constant_p(0) ? (__builtin_constant_p((sizeof(struct ccb))) ? __constant_c_and_count_memset(((&ccb[mbo])),((0x01010101UL *(unsigned char)(0))),((sizeof(struct ccb)))) : __constant_c_memset (((&ccb[mbo])),((0x01010101UL*(unsigned char)(0))),((sizeof (struct ccb))))) : (__builtin_constant_p((sizeof(struct ccb)) ) ? __memset_generic((((&ccb[mbo]))),(((0))),(((sizeof(struct ccb))))) : __memset_generic(((&ccb[mbo])),((0)),((sizeof (struct ccb)))))); |
591 | |
592 | ccb[mbo].cdblen = SCpnt->cmd_len; |
593 | |
594 | direction = 0; |
595 | if (*cmd == READ_100x28 || *cmd == READ_60x08) |
596 | direction = 8; |
597 | else if (*cmd == WRITE_100x2a || *cmd == WRITE_60x0a) |
598 | direction = 16; |
599 | |
600 | memcpy(ccb[mbo].cdb, cmd, ccb[mbo].cdblen)(__builtin_constant_p(ccb[mbo].cdblen) ? __constant_memcpy((ccb [mbo].cdb),(cmd),(ccb[mbo].cdblen)) : __memcpy((ccb[mbo].cdb) ,(cmd),(ccb[mbo].cdblen))); |
601 | |
602 | if (SCpnt->use_sg) { |
603 | struct scatterlist * sgpnt; |
604 | struct chain * cptr; |
605 | #ifdef DEBUG |
606 | unsigned char * ptr; |
607 | #endif |
608 | int i; |
609 | ccb[mbo].op = 2; /* SCSI Initiator Command w/scatter-gather*/ |
610 | SCpnt->host_scribble = (unsigned char *) scsi_malloc(512); |
611 | sgpnt = (struct scatterlist *) SCpnt->request_buffer; |
612 | cptr = (struct chain *) SCpnt->host_scribble; |
613 | if (cptr == NULL((void *) 0)) panic("aha1542.c: unable to allocate DMA memory\n"); |
614 | for(i=0; i<SCpnt->use_sg; i++) { |
615 | if(sgpnt[i].length == 0 || SCpnt->use_sg > 16 || |
616 | (((int)sgpnt[i].address) & 1) || (sgpnt[i].length & 1)){ |
617 | unsigned char * ptr; |
618 | printk("Bad segment list supplied to aha1542.c (%d, %d)\n",SCpnt->use_sg,i); |
619 | for(i=0;i<SCpnt->use_sg;i++){ |
620 | printk("%d: %x %x %d\n",i,(unsigned int) sgpnt[i].address, (unsigned int) sgpnt[i].alt_address, |
621 | sgpnt[i].length); |
622 | }; |
623 | printk("cptr %x: ",(unsigned int) cptr); |
624 | ptr = (unsigned char *) &cptr[i]; |
625 | for(i=0;i<18;i++) printk("%02x ", ptr[i]); |
626 | panic("Foooooooood fight!"); |
627 | }; |
628 | any2scsi(cptr[i].dataptr, sgpnt[i].address)(cptr[i].dataptr)[0] = (((unsigned long)(sgpnt[i].address)) >> 16) ; (cptr[i].dataptr)[1] = (((unsigned long)(sgpnt[i].address )) >> 8); (cptr[i].dataptr)[2] = ((unsigned long)(sgpnt [i].address));; |
629 | if(((unsigned int) sgpnt[i].address) & 0xff000000) goto baddma; |
630 | any2scsi(cptr[i].datalen, sgpnt[i].length)(cptr[i].datalen)[0] = (((unsigned long)(sgpnt[i].length)) >> 16) ; (cptr[i].datalen)[1] = (((unsigned long)(sgpnt[i].length )) >> 8); (cptr[i].datalen)[2] = ((unsigned long)(sgpnt [i].length));; |
631 | }; |
632 | any2scsi(ccb[mbo].datalen, SCpnt->use_sg * sizeof(struct chain))(ccb[mbo].datalen)[0] = (((unsigned long)(SCpnt->use_sg * sizeof (struct chain))) >> 16) ; (ccb[mbo].datalen)[1] = (((unsigned long)(SCpnt->use_sg * sizeof(struct chain))) >> 8); (ccb[mbo].datalen)[2] = ((unsigned long)(SCpnt->use_sg * sizeof (struct chain)));; |
633 | any2scsi(ccb[mbo].dataptr, cptr)(ccb[mbo].dataptr)[0] = (((unsigned long)(cptr)) >> 16) ; (ccb[mbo].dataptr)[1] = (((unsigned long)(cptr)) >> 8 ); (ccb[mbo].dataptr)[2] = ((unsigned long)(cptr));; |
634 | #ifdef DEBUG |
635 | printk("cptr %x: ",cptr); |
636 | ptr = (unsigned char *) cptr; |
637 | for(i=0;i<18;i++) printk("%02x ", ptr[i]); |
638 | #endif |
639 | } else { |
640 | ccb[mbo].op = 0; /* SCSI Initiator Command */ |
641 | SCpnt->host_scribble = NULL((void *) 0); |
642 | any2scsi(ccb[mbo].datalen, bufflen)(ccb[mbo].datalen)[0] = (((unsigned long)(bufflen)) >> 16 ) ; (ccb[mbo].datalen)[1] = (((unsigned long)(bufflen)) >> 8); (ccb[mbo].datalen)[2] = ((unsigned long)(bufflen));; |
643 | if(((unsigned int) buff & 0xff000000)) goto baddma; |
644 | any2scsi(ccb[mbo].dataptr, buff)(ccb[mbo].dataptr)[0] = (((unsigned long)(buff)) >> 16) ; (ccb[mbo].dataptr)[1] = (((unsigned long)(buff)) >> 8 ); (ccb[mbo].dataptr)[2] = ((unsigned long)(buff));; |
645 | }; |
646 | ccb[mbo].idlun = (target&7)<<5 | direction | (lun & 7); /*SCSI Target Id*/ |
647 | ccb[mbo].rsalen = 16; |
648 | ccb[mbo].linkptr[0] = ccb[mbo].linkptr[1] = ccb[mbo].linkptr[2] = 0; |
649 | ccb[mbo].commlinkid = 0; |
650 | |
651 | #ifdef DEBUG |
652 | { int i; |
653 | printk("aha1542_command: sending.. "); |
654 | for (i = 0; i < sizeof(ccb[mbo])-10; i++) |
655 | printk("%02x ", ((unchar *)&ccb[mbo])[i]); |
656 | }; |
657 | #endif |
658 | |
659 | if (done) { |
660 | DEB(printk("aha1542_queuecommand: now waiting for interrupt "); aha1542_stat()); |
661 | SCpnt->scsi_done = done; |
662 | mb[mbo].status = 1; |
663 | aha1542_out(SCpnt->host->io_port, &ahacmd, 1); /* start scsi command */ |
664 | DEB(aha1542_stat()); |
665 | } |
666 | else |
667 | printk("aha1542_queuecommand: done can't be NULL\n"); |
668 | |
669 | return 0; |
670 | baddma: |
671 | panic("Buffer at address > 16Mb used for 1542B"); |
672 | } |
673 | |
674 | static void internal_done(Scsi_Cmnd * SCpnt) |
675 | { |
676 | SCpnt->SCp.Status++; |
677 | } |
678 | |
679 | int aha1542_command(Scsi_Cmnd * SCpnt) |
680 | { |
681 | DEB(printk("aha1542_command: ..calling aha1542_queuecommand\n")); |
682 | |
683 | aha1542_queuecommand(SCpnt, internal_done); |
684 | |
685 | SCpnt->SCp.Status = 0; |
686 | while (!SCpnt->SCp.Status) |
687 | barrier()__asm__ __volatile__("": : :"memory"); |
688 | return SCpnt->result; |
689 | } |
690 | |
691 | /* Initialize mailboxes */ |
692 | static void setup_mailboxes(int bse, struct Scsi_Host * shpnt) |
693 | { |
694 | int i; |
695 | struct mailbox * mb; |
696 | struct ccb *ccb; |
697 | |
698 | unchar cmd[5] = {CMD_MBINIT0x01, AHA1542_MAILBOXES8, 0, 0, 0}; |
699 | |
700 | mb = HOSTDATA(shpnt)((struct aha1542_hostdata *) &shpnt->hostdata)->mb; |
701 | ccb = HOSTDATA(shpnt)((struct aha1542_hostdata *) &shpnt->hostdata)->ccb; |
702 | |
703 | for(i=0; i<AHA1542_MAILBOXES8; i++){ |
704 | mb[i].status = mb[AHA1542_MAILBOXES8+i].status = 0; |
705 | any2scsi(mb[i].ccbptr, &ccb[i])(mb[i].ccbptr)[0] = (((unsigned long)(&ccb[i])) >> 16 ) ; (mb[i].ccbptr)[1] = (((unsigned long)(&ccb[i])) >> 8); (mb[i].ccbptr)[2] = ((unsigned long)(&ccb[i]));; |
706 | }; |
707 | aha1542_intr_reset(bse)((__builtin_constant_p((bse)) && (bse) < 256) ? __outbc ((0x20),(bse)) : __outb((0x20),(bse))); /* reset interrupts, so they don't block */ |
708 | any2scsi((cmd+2), mb)((cmd+2))[0] = (((unsigned long)(mb)) >> 16) ; ((cmd+2) )[1] = (((unsigned long)(mb)) >> 8); ((cmd+2))[2] = ((unsigned long)(mb));; |
709 | aha1542_out(bse, cmd, 5); |
710 | WAIT(INTRFLAGS(bse), INTRMASK, HACC, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((bse+2))) && ((bse+2)) < 256) ? __inbc((bse+2)) : __inb((bse+2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
711 | while (0) { |
712 | fail: |
713 | printk("aha1542_detect: failed setting up mailboxes\n"); |
714 | } |
715 | aha1542_intr_reset(bse)((__builtin_constant_p((bse)) && (bse) < 256) ? __outbc ((0x20),(bse)) : __outb((0x20),(bse))); |
716 | } |
717 | |
718 | static int aha1542_getconfig(int base_io, unsigned char * irq_level, unsigned char * dma_chan, unsigned char * scsi_id) |
719 | { |
720 | unchar inquiry_cmd[] = {CMD_RETCONF0x0b }; |
721 | unchar inquiry_result[3]; |
722 | int i; |
723 | i = inb(STATUS(base_io))((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __inbc(base_io) : __inb(base_io)); |
724 | if (i & DF0x04) { |
725 | i = inb(DATA(base_io))((__builtin_constant_p(((base_io+1))) && ((base_io+1) ) < 256) ? __inbc((base_io+1)) : __inb((base_io+1))); |
726 | }; |
727 | aha1542_out(base_io, inquiry_cmd, 1); |
728 | aha1542_in(base_io, inquiry_result, 3); |
729 | WAIT(INTRFLAGS(base_io), INTRMASK, HACC, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((base_io+2))) && ((base_io+2)) < 256) ? __inbc((base_io+2)) : __inb((base_io +2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
730 | while (0) { |
731 | fail: |
732 | printk("aha1542_detect: query board settings\n"); |
733 | } |
734 | aha1542_intr_reset(base_io)((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __outbc((0x20),(base_io)) : __outb((0x20),(base_io))); |
735 | switch(inquiry_result[0]){ |
736 | case 0x80: |
737 | *dma_chan = 7; |
738 | break; |
739 | case 0x40: |
740 | *dma_chan = 6; |
741 | break; |
742 | case 0x20: |
743 | *dma_chan = 5; |
744 | break; |
745 | case 0x01: |
746 | *dma_chan = 0; |
747 | break; |
748 | case 0: |
749 | /* This means that the adapter, although Adaptec 1542 compatible, doesn't use a DMA channel. |
750 | Currently only aware of the BusLogic BT-445S VL-Bus adapter which needs this. */ |
751 | *dma_chan = 0xFF; |
752 | break; |
753 | default: |
754 | printk("Unable to determine Adaptec DMA priority. Disabling board\n"); |
755 | return -1; |
756 | }; |
757 | switch(inquiry_result[1]){ |
758 | case 0x40: |
759 | *irq_level = 15; |
760 | break; |
761 | case 0x20: |
762 | *irq_level = 14; |
763 | break; |
764 | case 0x8: |
765 | *irq_level = 12; |
766 | break; |
767 | case 0x4: |
768 | *irq_level = 11; |
769 | break; |
770 | case 0x2: |
771 | *irq_level = 10; |
772 | break; |
773 | case 0x1: |
774 | *irq_level = 9; |
775 | break; |
776 | default: |
777 | printk("Unable to determine Adaptec IRQ level. Disabling board\n"); |
778 | return -1; |
779 | }; |
780 | *scsi_id=inquiry_result[2] & 7; |
781 | return 0; |
782 | } |
783 | |
784 | /* This function should only be called for 1542C boards - we can detect |
785 | the special firmware settings and unlock the board */ |
786 | |
787 | static int aha1542_mbenable(int base) |
788 | { |
789 | static unchar mbenable_cmd[3]; |
790 | static unchar mbenable_result[2]; |
791 | int retval; |
792 | |
793 | retval = BIOS_TRANSLATION_64321; |
794 | |
795 | mbenable_cmd[0]=CMD_EXTBIOS0x28; |
796 | aha1542_out(base,mbenable_cmd,1); |
797 | if(aha1542_in1(base,mbenable_result,2)) |
798 | return retval; |
799 | WAITd(INTRFLAGS(base),INTRMASK,HACC,0,100){ register int WAITbits; register int WAITtimeout = 100; while (1) { WAITbits = ((__builtin_constant_p(((base+2))) && ((base+2)) < 256) ? __inbc((base+2)) : __inb((base+2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; (__builtin_constant_p(1000) ? __const_udelay ((1000) * 0x10c6ul) : __udelay(1000)); if (--WAITtimeout == 0 ) goto fail; } }; |
800 | aha1542_intr_reset(base)((__builtin_constant_p((base)) && (base) < 256) ? __outbc ((0x20),(base)) : __outb((0x20),(base))); |
801 | |
802 | if ((mbenable_result[0] & 0x08) || mbenable_result[1]) { |
803 | mbenable_cmd[0]=CMD_MBENABLE0x29; |
804 | mbenable_cmd[1]=0; |
805 | mbenable_cmd[2]=mbenable_result[1]; |
806 | |
807 | if((mbenable_result[0] & 0x08) && (mbenable_result[1] & 0x03)) retval = BIOS_TRANSLATION_255632; |
808 | |
809 | aha1542_out(base,mbenable_cmd,3); |
810 | WAIT(INTRFLAGS(base),INTRMASK,HACC,0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((base+2))) && ((base+2)) < 256) ? __inbc((base+2)) : __inb((base+2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
811 | }; |
812 | while(0) { |
813 | fail: |
814 | printk("aha1542_mbenable: Mailbox init failed\n"); |
815 | } |
816 | aha1542_intr_reset(base)((__builtin_constant_p((base)) && (base) < 256) ? __outbc ((0x20),(base)) : __outb((0x20),(base))); |
817 | return retval; |
818 | } |
819 | |
820 | /* Query the board to find out if it is a 1542 or a 1740, or whatever. */ |
821 | static int aha1542_query(int base_io, int * transl) |
822 | { |
823 | unchar inquiry_cmd[] = {CMD_INQUIRY0x04 }; |
824 | unchar inquiry_result[4]; |
825 | int i; |
826 | i = inb(STATUS(base_io))((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __inbc(base_io) : __inb(base_io)); |
827 | if (i & DF0x04) { |
828 | i = inb(DATA(base_io))((__builtin_constant_p(((base_io+1))) && ((base_io+1) ) < 256) ? __inbc((base_io+1)) : __inb((base_io+1))); |
Value stored to 'i' is never read | |
829 | }; |
830 | aha1542_out(base_io, inquiry_cmd, 1); |
831 | aha1542_in(base_io, inquiry_result, 4); |
832 | WAIT(INTRFLAGS(base_io), INTRMASK, HACC, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((base_io+2))) && ((base_io+2)) < 256) ? __inbc((base_io+2)) : __inb((base_io +2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
833 | while (0) { |
834 | fail: |
835 | printk("aha1542_detect: query card type\n"); |
836 | } |
837 | aha1542_intr_reset(base_io)((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __outbc((0x20),(base_io)) : __outb((0x20),(base_io))); |
838 | |
839 | *transl = BIOS_TRANSLATION_64321; /* Default case */ |
840 | |
841 | /* For an AHA1740 series board, we ignore the board since there is a |
842 | hardware bug which can lead to wrong blocks being returned if the board |
843 | is operating in the 1542 emulation mode. Since there is an extended mode |
844 | driver, we simply ignore the board and let the 1740 driver pick it up. |
845 | */ |
846 | |
847 | if (inquiry_result[0] == 0x43) { |
848 | printk("aha1542.c: Emulation mode not supported for AHA 174N hardware.\n"); |
849 | return 1; |
850 | }; |
851 | |
852 | /* Always call this - boards that do not support extended bios translation |
853 | will ignore the command, and we will set the proper default */ |
854 | |
855 | *transl = aha1542_mbenable(base_io); |
856 | |
857 | return 0; |
858 | } |
859 | |
860 | /* called from init/main.c */ |
861 | void aha1542_setup( char *str, int *ints) |
862 | { |
863 | const char *ahausage = "aha1542: usage: aha1542=<PORTBASE>[,<BUSON>,<BUSOFF>[,<DMASPEED>]]\n"; |
864 | static int setup_idx = 0; |
865 | int setup_portbase; |
866 | |
867 | if(setup_idx >= MAXBOARDS2) |
868 | { |
869 | printk("aha1542: aha1542_setup called too many times! Bad LILO params ?\n"); |
870 | printk(" Entryline 1: %s\n",setup_str[0]); |
871 | printk(" Entryline 2: %s\n",setup_str[1]); |
872 | printk(" This line: %s\n",str); |
873 | return; |
874 | } |
875 | if (ints[0] < 1 || ints[0] > 4) |
876 | { |
877 | printk("aha1542: %s\n", str ); |
878 | printk("%s", ahausage); |
879 | printk("aha1542: Wrong parameters may cause system malfunction.. We try anyway..\n"); |
880 | } |
881 | |
882 | setup_called[setup_idx]=ints[0]; |
883 | setup_str[setup_idx]=str; |
884 | |
885 | setup_portbase = ints[0] >= 1 ? ints[1] : 0; /* Preserve the default value.. */ |
886 | setup_buson [setup_idx] = ints[0] >= 2 ? ints[2] : 7; |
887 | setup_busoff [setup_idx] = ints[0] >= 3 ? ints[3] : 5; |
888 | if (ints[0] >= 4) { |
889 | int atbt = -1; |
890 | switch (ints[4]) { |
891 | case 5: |
892 | atbt = 0x00; |
893 | break; |
894 | case 6: |
895 | atbt = 0x04; |
896 | break; |
897 | case 7: |
898 | atbt = 0x01; |
899 | break; |
900 | case 8: |
901 | atbt = 0x02; |
902 | break; |
903 | case 10: |
904 | atbt = 0x03; |
905 | break; |
906 | default: |
907 | printk("aha1542: %s\n", str ); |
908 | printk("%s", ahausage); |
909 | printk("aha1542: Valid values for DMASPEED are 5-8, 10 MB/s. Using jumper defaults.\n"); |
910 | break; |
911 | } |
912 | setup_dmaspeed[setup_idx] = atbt; |
913 | } |
914 | |
915 | if (setup_portbase != 0) |
916 | bases[setup_idx] = setup_portbase; |
917 | |
918 | ++setup_idx; |
919 | } |
920 | |
921 | /* return non-zero on detection */ |
922 | int aha1542_detect(Scsi_Host_Template * tpnt) |
923 | { |
924 | unsigned char dma_chan; |
925 | unsigned char irq_level; |
926 | unsigned char scsi_id; |
927 | unsigned long flags; |
928 | unsigned int base_io; |
929 | int trans; |
930 | struct Scsi_Host * shpnt = NULL((void *) 0); |
931 | int count = 0; |
932 | int indx; |
933 | |
934 | DEB(printk("aha1542_detect: \n")); |
935 | |
936 | tpnt->proc_dir = &proc_scsi_aha1542; |
937 | |
938 | for(indx = 0; indx < sizeof(bases)/sizeof(bases[0]); indx++) |
939 | if(bases[indx] != 0 && !check_region(bases[indx], 4)) { |
940 | shpnt = scsi_register(tpnt, |
941 | sizeof(struct aha1542_hostdata)); |
942 | |
943 | /* For now we do this - until kmalloc is more intelligent |
944 | we are resigned to stupid hacks like this */ |
945 | if ((unsigned int) shpnt > 0xffffff) { |
946 | printk("Invalid address for shpnt with 1542.\n"); |
947 | goto unregister; |
948 | } |
949 | |
950 | if(!aha1542_test_port(bases[indx], shpnt)) goto unregister; |
951 | |
952 | |
953 | base_io = bases[indx]; |
954 | |
955 | /* Set the Bus on/off-times as not to ruin floppy performance */ |
956 | { |
957 | unchar oncmd[] = {CMD_BUSON_TIME0x07, 7}; |
958 | unchar offcmd[] = {CMD_BUSOFF_TIME0x08, 5}; |
959 | |
960 | if(setup_called[indx]) |
961 | { |
962 | oncmd[1] = setup_buson[indx]; |
963 | offcmd[1] = setup_busoff[indx]; |
964 | } |
965 | |
966 | aha1542_intr_reset(base_io)((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __outbc((0x20),(base_io)) : __outb((0x20),(base_io))); |
967 | aha1542_out(base_io, oncmd, 2); |
968 | WAIT(INTRFLAGS(base_io), INTRMASK, HACC, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((base_io+2))) && ((base_io+2)) < 256) ? __inbc((base_io+2)) : __inb((base_io +2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
969 | aha1542_intr_reset(base_io)((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __outbc((0x20),(base_io)) : __outb((0x20),(base_io))); |
970 | aha1542_out(base_io, offcmd, 2); |
971 | WAIT(INTRFLAGS(base_io), INTRMASK, HACC, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((base_io+2))) && ((base_io+2)) < 256) ? __inbc((base_io+2)) : __inb((base_io +2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
972 | if (setup_dmaspeed[indx] >= 0) |
973 | { |
974 | unchar dmacmd[] = {CMD_DMASPEED0x09, 0}; |
975 | dmacmd[1] = setup_dmaspeed[indx]; |
976 | aha1542_intr_reset(base_io)((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __outbc((0x20),(base_io)) : __outb((0x20),(base_io))); |
977 | aha1542_out(base_io, dmacmd, 2); |
978 | WAIT(INTRFLAGS(base_io), INTRMASK, HACC, 0){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p(((base_io+2))) && ((base_io+2)) < 256) ? __inbc((base_io+2)) : __inb((base_io +2))) & (0x8f); if ((WAITbits & (0x04)) == (0x04) && ((WAITbits & (0)) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
979 | } |
980 | while (0) { |
981 | fail: |
982 | printk("aha1542_detect: setting bus on/off-time failed\n"); |
983 | } |
984 | aha1542_intr_reset(base_io)((__builtin_constant_p((base_io)) && (base_io) < 256 ) ? __outbc((0x20),(base_io)) : __outb((0x20),(base_io))); |
985 | } |
986 | if(aha1542_query(base_io, &trans)) goto unregister; |
987 | |
988 | if (aha1542_getconfig(base_io, &irq_level, &dma_chan, &scsi_id) == -1) goto unregister; |
989 | |
990 | printk("Configuring Adaptec (SCSI-ID %d) at IO:%x, IRQ %d", scsi_id, base_io, irq_level); |
991 | if (dma_chan != 0xFF) |
992 | printk(", DMA priority %d", dma_chan); |
993 | printk("\n"); |
994 | |
995 | DEB(aha1542_stat()); |
996 | setup_mailboxes(base_io, shpnt); |
997 | |
998 | DEB(aha1542_stat()); |
999 | |
1000 | DEB(printk("aha1542_detect: enable interrupt channel %d\n", irq_level)); |
1001 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
1002 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
1003 | if (request_irq(irq_level,aha1542_intr_handle, 0, "aha1542", NULL((void *) 0))) { |
1004 | printk("Unable to allocate IRQ for adaptec controller.\n"); |
1005 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
1006 | goto unregister; |
1007 | } |
1008 | |
1009 | if (dma_chan != 0xFF) { |
1010 | if (request_dma(dma_chan,"aha1542")) { |
1011 | printk("Unable to allocate DMA channel for Adaptec.\n"); |
1012 | free_irq(irq_level, NULL((void *) 0)); |
1013 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
1014 | goto unregister; |
1015 | } |
1016 | |
1017 | if (dma_chan == 0 || dma_chan >= 5) { |
1018 | set_dma_mode(dma_chan, DMA_MODE_CASCADE0xC0); |
1019 | enable_dma(dma_chan); |
1020 | } |
1021 | } |
1022 | aha_host[irq_level - 9] = shpnt; |
1023 | shpnt->this_id = scsi_id; |
1024 | shpnt->unique_id = base_io; |
1025 | shpnt->io_port = base_io; |
1026 | shpnt->n_io_port = 4; /* Number of bytes of I/O space used */ |
1027 | shpnt->dma_channel = dma_chan; |
1028 | shpnt->irq = irq_level; |
1029 | HOSTDATA(shpnt)((struct aha1542_hostdata *) &shpnt->hostdata)->bios_translation = trans; |
1030 | if(trans == BIOS_TRANSLATION_255632) |
1031 | printk("aha1542.c: Using extended bios translation\n"); |
1032 | HOSTDATA(shpnt)((struct aha1542_hostdata *) &shpnt->hostdata)->aha1542_last_mbi_used = (2*AHA1542_MAILBOXES8 - 1); |
1033 | HOSTDATA(shpnt)((struct aha1542_hostdata *) &shpnt->hostdata)->aha1542_last_mbo_used = (AHA1542_MAILBOXES8 - 1); |
1034 | memset(HOSTDATA(shpnt)->SCint, 0, sizeof(HOSTDATA(shpnt)->SCint))(__builtin_constant_p(0) ? (__builtin_constant_p((sizeof(((struct aha1542_hostdata *) &shpnt->hostdata)->SCint))) ? __constant_c_and_count_memset (((((struct aha1542_hostdata *) &shpnt->hostdata)-> SCint)),((0x01010101UL*(unsigned char)(0))),((sizeof(((struct aha1542_hostdata *) &shpnt->hostdata)->SCint)))) : __constant_c_memset(((((struct aha1542_hostdata *) &shpnt ->hostdata)->SCint)),((0x01010101UL*(unsigned char)(0)) ),((sizeof(((struct aha1542_hostdata *) &shpnt->hostdata )->SCint))))) : (__builtin_constant_p((sizeof(((struct aha1542_hostdata *) &shpnt->hostdata)->SCint))) ? __memset_generic( (((((struct aha1542_hostdata *) &shpnt->hostdata)-> SCint))),(((0))),(((sizeof(((struct aha1542_hostdata *) & shpnt->hostdata)->SCint))))) : __memset_generic(((((struct aha1542_hostdata *) &shpnt->hostdata)->SCint)),((0 )),((sizeof(((struct aha1542_hostdata *) &shpnt->hostdata )->SCint)))))); |
1035 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
1036 | #if 0 |
1037 | DEB(printk(" *** READ CAPACITY ***\n")); |
1038 | |
1039 | { |
1040 | unchar buf[8]; |
1041 | static unchar cmd[] = { READ_CAPACITY0x25, 0, 0, 0, 0, 0, 0, 0, 0, 0}; |
1042 | int i; |
1043 | |
1044 | for (i = 0; i < sizeof(buf); ++i) buf[i] = 0x87; |
1045 | for (i = 0; i < 2; ++i) |
1046 | if (!aha1542_command(i, cmd, buf, sizeof(buf))) { |
1047 | printk("aha_detect: LU %d sector_size %d device_size %d\n", |
1048 | i, xscsi2int(buf+4)( (((long)(buf+4)[0]) << 24) + (((long)(buf+4)[1]) << 16) + (((long)(buf+4)[2]) << 8) + ((long)(buf+4)[3]) ), xscsi2int(buf)( (((long)(buf)[0]) << 24) + (((long)(buf)[1]) << 16) + (((long)(buf)[2]) << 8) + ((long)(buf)[3]) )); |
1049 | } |
1050 | } |
1051 | |
1052 | DEB(printk(" *** NOW RUNNING MY OWN TEST *** \n")); |
1053 | |
1054 | for (i = 0; i < 4; ++i) |
1055 | { |
1056 | unsigned char cmd[10]; |
1057 | static buffer[512]; |
1058 | |
1059 | cmd[0] = READ_100x28; |
1060 | cmd[1] = 0; |
1061 | xany2scsi(cmd+2, i)(cmd+2)[0] = ((long)(i)) >> 24; (cmd+2)[1] = ((long)(i) ) >> 16; (cmd+2)[2] = ((long)(i)) >> 8; (cmd+2)[3 ] = ((long)(i));; |
1062 | cmd[6] = 0; |
1063 | cmd[7] = 0; |
1064 | cmd[8] = 1; |
1065 | cmd[9] = 0; |
1066 | aha1542_command(0, cmd, buffer, 512); |
1067 | } |
1068 | #endif |
1069 | request_region(bases[indx], 4,"aha1542"); /* Register the IO ports that we use */ |
1070 | count++; |
1071 | continue; |
1072 | unregister: |
1073 | scsi_unregister(shpnt); |
1074 | continue; |
1075 | |
1076 | }; |
1077 | |
1078 | return count; |
1079 | } |
1080 | |
1081 | static int aha1542_restart(struct Scsi_Host * shost) |
1082 | { |
1083 | int i; |
1084 | int count = 0; |
1085 | #if 0 |
1086 | unchar ahacmd = CMD_START_SCSI0x02; |
1087 | #endif |
1088 | |
1089 | for(i=0; i< AHA1542_MAILBOXES8; i++) |
1090 | if(HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->SCint[i] && |
1091 | !(HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->SCint[i]->device->soft_reset)) |
1092 | { |
1093 | #if 0 |
1094 | HOSTDATA(shost)((struct aha1542_hostdata *) &shost->hostdata)->mb[i].status = 1; /* Indicate ready to restart... */ |
1095 | #endif |
1096 | count++; |
1097 | } |
1098 | |
1099 | printk("Potential to restart %d stalled commands...\n", count); |
1100 | #if 0 |
1101 | /* start scsi command */ |
1102 | if (count) aha1542_out(shost->io_port, &ahacmd, 1); |
1103 | #endif |
1104 | return 0; |
1105 | } |
1106 | |
1107 | /* The abort command does not leave the device in a clean state where |
1108 | it is available to be used again. Until this gets worked out, we will |
1109 | leave it commented out. */ |
1110 | |
1111 | int aha1542_abort(Scsi_Cmnd * SCpnt) |
1112 | { |
1113 | #if 0 |
1114 | unchar ahacmd = CMD_START_SCSI0x02; |
1115 | unsigned long flags; |
1116 | struct mailbox * mb; |
1117 | int mbi, mbo, i; |
1118 | |
1119 | printk("In aha1542_abort: %x %x\n", |
1120 | inb(STATUS(SCpnt->host->io_port))((__builtin_constant_p((SCpnt->host->io_port)) && (SCpnt->host->io_port) < 256) ? __inbc(SCpnt->host ->io_port) : __inb(SCpnt->host->io_port)), |
1121 | inb(INTRFLAGS(SCpnt->host->io_port))((__builtin_constant_p(((SCpnt->host->io_port+2))) && ((SCpnt->host->io_port+2)) < 256) ? __inbc((SCpnt-> host->io_port+2)) : __inb((SCpnt->host->io_port+2)))); |
1122 | |
1123 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
1124 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
1125 | mb = HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->mb; |
1126 | mbi = HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->aha1542_last_mbi_used + 1; |
1127 | if (mbi >= 2*AHA1542_MAILBOXES8) mbi = AHA1542_MAILBOXES8; |
1128 | |
1129 | do{ |
1130 | if(mb[mbi].status != 0) break; |
1131 | mbi++; |
1132 | if (mbi >= 2*AHA1542_MAILBOXES8) mbi = AHA1542_MAILBOXES8; |
1133 | } while (mbi != HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->aha1542_last_mbi_used); |
1134 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
1135 | |
1136 | if(mb[mbi].status) { |
1137 | printk("Lost interrupt discovered on irq %d - attempting to recover\n", |
1138 | SCpnt->host->irq); |
1139 | aha1542_intr_handle(SCpnt->host->irq, NULL((void *) 0)); |
1140 | return 0; |
1141 | } |
1142 | |
1143 | /* OK, no lost interrupt. Try looking to see how many pending commands |
1144 | we think we have. */ |
1145 | |
1146 | for(i=0; i< AHA1542_MAILBOXES8; i++) |
1147 | if(HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i]) |
1148 | { |
1149 | if(HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i] == SCpnt) { |
1150 | printk("Timed out command pending for %s\n", |
1151 | kdevname(SCpnt->request.rq_dev)); |
1152 | if (HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->mb[i].status) { |
1153 | printk("OGMB still full - restarting\n"); |
1154 | aha1542_out(SCpnt->host->io_port, &ahacmd, 1); |
1155 | }; |
1156 | } else |
1157 | printk("Other pending command %s\n", |
1158 | kdevname(SCpnt->request.rq_dev)); |
1159 | } |
1160 | |
1161 | #endif |
1162 | |
1163 | DEB(printk("aha1542_abort\n")); |
1164 | #if 0 |
1165 | save_flags(flags)__asm__ __volatile__("pushf ; pop %0" : "=r" (flags): :"memory" ); |
1166 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
1167 | for(mbo = 0; mbo < AHA1542_MAILBOXES8; mbo++) |
1168 | if (SCpnt == HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[mbo]){ |
1169 | mb[mbo].status = 2; /* Abort command */ |
1170 | aha1542_out(SCpnt->host->io_port, &ahacmd, 1); /* start scsi command */ |
1171 | restore_flags(flags)__asm__ __volatile__("push %0 ; popf": :"g" (flags):"memory"); |
1172 | break; |
1173 | }; |
1174 | #endif |
1175 | return SCSI_ABORT_SNOOZE0; |
1176 | } |
1177 | |
1178 | /* We do not implement a reset function here, but the upper level code |
1179 | assumes that it will get some kind of response for the command in |
1180 | SCpnt. We must oblige, or the command will hang the scsi system. |
1181 | For a first go, we assume that the 1542 notifies us with all of the |
1182 | pending commands (it does implement soft reset, after all). */ |
1183 | |
1184 | int aha1542_reset(Scsi_Cmnd * SCpnt, unsigned int reset_flags) |
1185 | { |
1186 | unchar ahacmd = CMD_START_SCSI0x02; |
1187 | int i; |
1188 | |
1189 | /* |
1190 | * See if a bus reset was suggested. |
1191 | */ |
1192 | if( reset_flags & SCSI_RESET_SUGGEST_BUS_RESET0x04 ) |
1193 | { |
1194 | /* |
1195 | * This does a scsi reset for all devices on the bus. |
1196 | * In principle, we could also reset the 1542 - should |
1197 | * we do this? Try this first, and we can add that later |
1198 | * if it turns out to be useful. |
1199 | */ |
1200 | outb(HRST | SCRST, CONTROL(SCpnt->host->io_port))((__builtin_constant_p((SCpnt->host->io_port)) && (SCpnt->host->io_port) < 256) ? __outbc((0x80 | 0x10 ),(SCpnt->host->io_port)) : __outb((0x80 | 0x10),(SCpnt ->host->io_port))); |
1201 | |
1202 | /* |
1203 | * Wait for the thing to settle down a bit. Unfortunately |
1204 | * this is going to basically lock up the machine while we |
1205 | * wait for this to complete. To be 100% correct, we need to |
1206 | * check for timeout, and if we are doing something like this |
1207 | * we are pretty desperate anyways. |
1208 | */ |
1209 | WAIT(STATUS(SCpnt->host->io_port),{ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((SCpnt->host-> io_port)) && (SCpnt->host->io_port) < 256) ? __inbc(SCpnt->host->io_port) : __inb(SCpnt->host-> io_port)) & (0xfd); if ((WAITbits & (0x20|0x10)) == ( 0x20|0x10) && ((WAITbits & (0x80|0x40|0x01|0x04|0x08 )) == 0)) break; if (--WAITtimeout == 0) goto fail; } } |
1210 | STATMASK, INIT|IDLE, STST|DIAGF|INVDCMD|DF|CDF){ register int WAITbits; register int WAITtimeout = 3000000; while (1) { WAITbits = ((__builtin_constant_p((SCpnt->host-> io_port)) && (SCpnt->host->io_port) < 256) ? __inbc(SCpnt->host->io_port) : __inb(SCpnt->host-> io_port)) & (0xfd); if ((WAITbits & (0x20|0x10)) == ( 0x20|0x10) && ((WAITbits & (0x80|0x40|0x01|0x04|0x08 )) == 0)) break; if (--WAITtimeout == 0) goto fail; } }; |
1211 | |
1212 | /* |
1213 | * We need to do this too before the 1542 can interact with |
1214 | * us again. |
1215 | */ |
1216 | setup_mailboxes(SCpnt->host->io_port, SCpnt->host); |
1217 | |
1218 | /* |
1219 | * Now try to pick up the pieces. Restart all commands |
1220 | * that are currently active on the bus, and reset all of |
1221 | * the datastructures. We have some time to kill while |
1222 | * things settle down, so print a nice message. |
1223 | */ |
1224 | printk("Sent BUS RESET to scsi host %d\n", SCpnt->host->host_no); |
1225 | |
1226 | for(i=0; i< AHA1542_MAILBOXES8; i++) |
1227 | if(HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i] != NULL((void *) 0)) |
1228 | { |
1229 | Scsi_Cmnd * SCtmp; |
1230 | SCtmp = HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i]; |
1231 | SCtmp->result = DID_RESET0x08 << 16; |
1232 | if (SCtmp->host_scribble) scsi_free(SCtmp->host_scribble, 512); |
1233 | printk("Sending DID_RESET for target %d\n", SCpnt->target); |
1234 | SCtmp->scsi_done(SCpnt); |
1235 | |
1236 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i] = NULL((void *) 0); |
1237 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->mb[i].status = 0; |
1238 | } |
1239 | /* |
1240 | * Now tell the mid-level code what we did here. Since |
1241 | * we have restarted all of the outstanding commands, |
1242 | * then report SUCCESS. |
1243 | */ |
1244 | return (SCSI_RESET_SUCCESS2 | SCSI_RESET_BUS_RESET0x100); |
1245 | fail: |
1246 | printk("aha1542.c: Unable to perform hard reset.\n"); |
1247 | printk("Power cycle machine to reset\n"); |
1248 | return (SCSI_RESET_ERROR6 | SCSI_RESET_BUS_RESET0x100); |
1249 | |
1250 | |
1251 | } |
1252 | else |
1253 | { |
1254 | /* This does a selective reset of just the one device */ |
1255 | /* First locate the ccb for this command */ |
1256 | for(i=0; i< AHA1542_MAILBOXES8; i++) |
1257 | if(HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i] == SCpnt) |
1258 | { |
1259 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->ccb[i].op = 0x81; /* BUS DEVICE RESET */ |
1260 | /* Now tell the 1542 to flush all pending commands for this target */ |
1261 | aha1542_out(SCpnt->host->io_port, &ahacmd, 1); |
1262 | |
1263 | /* Here is the tricky part. What to do next. Do we get an interrupt |
1264 | for the commands that we aborted with the specified target, or |
1265 | do we generate this on our own? Try it without first and see |
1266 | what happens */ |
1267 | printk("Sent BUS DEVICE RESET to target %d\n", SCpnt->target); |
1268 | |
1269 | /* If the first does not work, then try the second. I think the |
1270 | first option is more likely to be correct. Free the command |
1271 | block for all commands running on this target... */ |
1272 | for(i=0; i< AHA1542_MAILBOXES8; i++) |
1273 | if(HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i] && |
1274 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i]->target == SCpnt->target) |
1275 | { |
1276 | Scsi_Cmnd * SCtmp; |
1277 | SCtmp = HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i]; |
1278 | SCtmp->result = DID_RESET0x08 << 16; |
1279 | if (SCtmp->host_scribble) scsi_free(SCtmp->host_scribble, 512); |
1280 | printk("Sending DID_RESET for target %d\n", SCpnt->target); |
1281 | SCtmp->scsi_done(SCpnt); |
1282 | |
1283 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->SCint[i] = NULL((void *) 0); |
1284 | HOSTDATA(SCpnt->host)((struct aha1542_hostdata *) &SCpnt->host->hostdata )->mb[i].status = 0; |
1285 | } |
1286 | return SCSI_RESET_SUCCESS2; |
1287 | } |
1288 | } |
1289 | /* No active command at this time, so this means that each time we got |
1290 | some kind of response the last time through. Tell the mid-level code |
1291 | to request sense information in order to decide what to do next. */ |
1292 | return SCSI_RESET_PUNT1; |
1293 | } |
1294 | |
1295 | #include "sd.h" |
1296 | |
1297 | int aha1542_biosparam(Scsi_Disk * disk, kdev_t dev, int * ip) |
1298 | { |
1299 | int translation_algorithm; |
1300 | int size = disk->capacity; |
1301 | |
1302 | translation_algorithm = HOSTDATA(disk->device->host)((struct aha1542_hostdata *) &disk->device->host-> hostdata)->bios_translation; |
1303 | |
1304 | if((size>>11) > 1024 && translation_algorithm == BIOS_TRANSLATION_255632) { |
1305 | /* Please verify that this is the same as what DOS returns */ |
1306 | ip[0] = 255; |
1307 | ip[1] = 63; |
1308 | ip[2] = size /255/63; |
1309 | } else { |
1310 | ip[0] = 64; |
1311 | ip[1] = 32; |
1312 | ip[2] = size >> 11; |
1313 | } |
1314 | |
1315 | return 0; |
1316 | } |
1317 | |
1318 | |
1319 | #ifdef MODULE |
1320 | /* Eventually this will go into an include file, but this will be later */ |
1321 | Scsi_Host_Template driver_template = AHA1542{ ((void *) 0), ((void *) 0), &proc_scsi_aha1542, ((void * ) 0), "Adaptec 1542", aha1542_detect, ((void *) 0), ((void *) 0), aha1542_command, aha1542_queuecommand, aha1542_abort, aha1542_reset , ((void *) 0), aha1542_biosparam, 8, 7, 16, 1, 0, 1, 1}; |
1322 | |
1323 | #include "scsi_module.c" |
1324 | #endif |
1325 |