]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/scsi/aha1542.c
UBUNTU: Ubuntu-4.13.0-45.50
[mirror_ubuntu-artful-kernel.git] / drivers / scsi / aha1542.c
CommitLineData
1d084d20
OZ
1/*
2 * Driver for Adaptec AHA-1542 SCSI host adapters
1da177e4
LT
3 *
4 * Copyright (C) 1992 Tommy Thorn
5 * Copyright (C) 1993, 1994, 1995 Eric Youngdale
1d084d20 6 * Copyright (C) 2015 Ondrej Zary
1da177e4
LT
7 */
8
1da177e4
LT
9#include <linux/module.h>
10#include <linux/interrupt.h>
11#include <linux/kernel.h>
12#include <linux/types.h>
13#include <linux/string.h>
1da177e4 14#include <linux/delay.h>
1da177e4
LT
15#include <linux/init.h>
16#include <linux/spinlock.h>
643a7c43
OZ
17#include <linux/isa.h>
18#include <linux/pnp.h>
5a0e3ad6 19#include <linux/slab.h>
954a9fd7 20#include <linux/io.h>
1da177e4 21#include <asm/dma.h>
954a9fd7
OZ
22#include <scsi/scsi_cmnd.h>
23#include <scsi/scsi_device.h>
1da177e4
LT
24#include <scsi/scsi_host.h>
25#include "aha1542.h"
1da177e4 26
f71429ab 27#define MAXBOARDS 4
1da177e4 28
f71429ab
OZ
29static bool isapnp = 1;
30module_param(isapnp, bool, 0);
31MODULE_PARM_DESC(isapnp, "enable PnP support (default=1)");
1da177e4 32
f71429ab 33static int io[MAXBOARDS] = { 0x330, 0x334, 0, 0 };
88f06b76 34module_param_hw_array(io, int, ioport, NULL, 0);
f71429ab 35MODULE_PARM_DESC(io, "base IO address of controller (0x130,0x134,0x230,0x234,0x330,0x334, default=0x330,0x334)");
1da177e4 36
f71429ab
OZ
37/* time AHA spends on the AT-bus during data transfer */
38static int bus_on[MAXBOARDS] = { -1, -1, -1, -1 }; /* power-on default: 11us */
39module_param_array(bus_on, int, NULL, 0);
40MODULE_PARM_DESC(bus_on, "bus on time [us] (2-15, default=-1 [HW default: 11])");
1da177e4 41
f71429ab
OZ
42/* time AHA spends off the bus (not to monopolize it) during data transfer */
43static int bus_off[MAXBOARDS] = { -1, -1, -1, -1 }; /* power-on default: 4us */
44module_param_array(bus_off, int, NULL, 0);
45MODULE_PARM_DESC(bus_off, "bus off time [us] (1-64, default=-1 [HW default: 4])");
1da177e4 46
f71429ab
OZ
47/* default is jumper selected (J1 on 1542A), factory default = 5 MB/s */
48static int dma_speed[MAXBOARDS] = { -1, -1, -1, -1 };
49module_param_array(dma_speed, int, NULL, 0);
50MODULE_PARM_DESC(dma_speed, "DMA speed [MB/s] (5,6,7,8,10, default=-1 [by jumper])");
1da177e4 51
1da177e4
LT
52#define BIOS_TRANSLATION_6432 1 /* Default case these days */
53#define BIOS_TRANSLATION_25563 2 /* Big disk case */
54
55struct aha1542_hostdata {
56 /* This will effectively start both of them at the first mailbox */
57 int bios_translation; /* Mapping bios uses - for compatibility */
58 int aha1542_last_mbi_used;
59 int aha1542_last_mbo_used;
55b28f9f 60 struct scsi_cmnd *int_cmds[AHA1542_MAILBOXES];
1da177e4
LT
61 struct mailbox mb[2 * AHA1542_MAILBOXES];
62 struct ccb ccb[AHA1542_MAILBOXES];
63};
64
f1bbef63
OZ
65static inline void aha1542_intr_reset(u16 base)
66{
67 outb(IRST, CONTROL(base));
68}
1da177e4 69
2093bfa1
OZ
70static inline bool wait_mask(u16 port, u8 mask, u8 allof, u8 noneof, int timeout)
71{
72 bool delayed = true;
73
74 if (timeout == 0) {
75 timeout = 3000000;
76 delayed = false;
77 }
78
79 while (1) {
80 u8 bits = inb(port) & mask;
81 if ((bits & allof) == allof && ((bits & noneof) == 0))
82 break;
83 if (delayed)
84 mdelay(1);
85 if (--timeout == 0)
86 return false;
87 }
88
89 return true;
90}
1da177e4 91
cad2fc72 92static int aha1542_outb(unsigned int base, u8 val)
1da177e4 93{
eef77801
OZ
94 if (!wait_mask(STATUS(base), CDF, 0, CDF, 0))
95 return 1;
96 outb(val, DATA(base));
97
98 return 0;
0c2b6481
OZ
99}
100
cad2fc72 101static int aha1542_out(unsigned int base, u8 *buf, int len)
0c2b6481 102{
0c2b6481 103 while (len--) {
1b0224b0 104 if (!wait_mask(STATUS(base), CDF, 0, CDF, 0))
0c2b6481 105 return 1;
cad2fc72 106 outb(*buf++, DATA(base));
0c2b6481 107 }
23e6940a
OZ
108 if (!wait_mask(INTRFLAGS(base), INTRMASK, HACC, 0, 0))
109 return 1;
0c2b6481 110
1da177e4 111 return 0;
1da177e4
LT
112}
113
114/* Only used at boot time, so we do not need to worry about latency as much
115 here */
116
cad2fc72 117static int aha1542_in(unsigned int base, u8 *buf, int len, int timeout)
1da177e4 118{
1da177e4 119 while (len--) {
1b0224b0 120 if (!wait_mask(STATUS(base), DF, DF, 0, timeout))
a13b3722 121 return 1;
cad2fc72 122 *buf++ = inb(DATA(base));
1da177e4 123 }
1da177e4 124 return 0;
1da177e4
LT
125}
126
127static int makecode(unsigned hosterr, unsigned scsierr)
128{
129 switch (hosterr) {
130 case 0x0:
131 case 0xa: /* Linked command complete without error and linked normally */
132 case 0xb: /* Linked command complete without error, interrupt generated */
133 hosterr = 0;
134 break;
135
136 case 0x11: /* Selection time out-The initiator selection or target
137 reselection was not complete within the SCSI Time out period */
138 hosterr = DID_TIME_OUT;
139 break;
140
141 case 0x12: /* Data overrun/underrun-The target attempted to transfer more data
142 than was allocated by the Data Length field or the sum of the
143 Scatter / Gather Data Length fields. */
144
145 case 0x13: /* Unexpected bus free-The target dropped the SCSI BSY at an unexpected time. */
146
147 case 0x15: /* MBO command was not 00, 01 or 02-The first byte of the CB was
148 invalid. This usually indicates a software failure. */
149
150 case 0x16: /* Invalid CCB Operation Code-The first byte of the CCB was invalid.
151 This usually indicates a software failure. */
152
153 case 0x17: /* Linked CCB does not have the same LUN-A subsequent CCB of a set
154 of linked CCB's does not specify the same logical unit number as
155 the first. */
156 case 0x18: /* Invalid Target Direction received from Host-The direction of a
157 Target Mode CCB was invalid. */
158
159 case 0x19: /* Duplicate CCB Received in Target Mode-More than once CCB was
160 received to service data transfer between the same target LUN
161 and initiator SCSI ID in the same direction. */
162
163 case 0x1a: /* Invalid CCB or Segment List Parameter-A segment list with a zero
164 length segment or invalid segment list boundaries was received.
165 A CCB parameter was invalid. */
fde1fb8a
OZ
166#ifdef DEBUG
167 printk("Aha1542: %x %x\n", hosterr, scsierr);
168#endif
1da177e4
LT
169 hosterr = DID_ERROR; /* Couldn't find any better */
170 break;
171
172 case 0x14: /* Target bus phase sequence failure-An invalid bus phase or bus
173 phase sequence was requested by the target. The host adapter
174 will generate a SCSI Reset Condition, notifying the host with
175 a SCRD interrupt */
176 hosterr = DID_RESET;
177 break;
178 default:
179 printk(KERN_ERR "aha1542: makecode: unknown hoststatus %x\n", hosterr);
180 break;
181 }
182 return scsierr | (hosterr << 16);
183}
184
68ea9de3 185static int aha1542_test_port(struct Scsi_Host *sh)
1da177e4 186{
cb5b570c 187 u8 inquiry_result[4];
cad2fc72 188 int i;
1da177e4
LT
189
190 /* Quick and dirty test for presence of the card. */
68ea9de3 191 if (inb(STATUS(sh->io_port)) == 0xff)
1da177e4
LT
192 return 0;
193
194 /* Reset the adapter. I ought to make a hard reset, but it's not really necessary */
195
1da177e4 196 /* In case some other card was probing here, reset interrupts */
68ea9de3 197 aha1542_intr_reset(sh->io_port); /* reset interrupts, so they don't block */
1da177e4 198
68ea9de3 199 outb(SRST | IRST /*|SCRST */ , CONTROL(sh->io_port));
1da177e4
LT
200
201 mdelay(20); /* Wait a little bit for things to settle down. */
202
1da177e4 203 /* Expect INIT and IDLE, any of the others are bad */
68ea9de3 204 if (!wait_mask(STATUS(sh->io_port), STATMASK, INIT | IDLE, STST | DIAGF | INVDCMD | DF | CDF, 0))
a13b3722 205 return 0;
1da177e4 206
1da177e4 207 /* Shouldn't have generated any interrupts during reset */
68ea9de3 208 if (inb(INTRFLAGS(sh->io_port)) & INTRMASK)
a13b3722 209 return 0;
1da177e4 210
1da177e4
LT
211 /* Perform a host adapter inquiry instead so we do not need to set
212 up the mailboxes ahead of time */
213
68ea9de3 214 aha1542_outb(sh->io_port, CMD_INQUIRY);
1da177e4 215
cad2fc72 216 for (i = 0; i < 4; i++) {
68ea9de3 217 if (!wait_mask(STATUS(sh->io_port), DF, DF, 0, 0))
a13b3722 218 return 0;
68ea9de3 219 inquiry_result[i] = inb(DATA(sh->io_port));
1da177e4
LT
220 }
221
1da177e4 222 /* Reading port should reset DF */
68ea9de3 223 if (inb(STATUS(sh->io_port)) & DF)
a13b3722 224 return 0;
1da177e4 225
1da177e4 226 /* When HACC, command is completed, and we're though testing */
68ea9de3 227 if (!wait_mask(INTRFLAGS(sh->io_port), HACC, HACC, 0, 0))
a13b3722 228 return 0;
1da177e4 229
1da177e4 230 /* Clear interrupts */
68ea9de3 231 outb(IRST, CONTROL(sh->io_port));
1da177e4 232
bdebe224 233 return 1;
1da177e4
LT
234}
235
1b0224b0 236static irqreturn_t aha1542_interrupt(int irq, void *dev_id)
1da177e4 237{
1b0224b0 238 struct Scsi_Host *sh = dev_id;
c2532f68 239 struct aha1542_hostdata *aha1542 = shost_priv(sh);
55b28f9f 240 void (*my_done)(struct scsi_cmnd *) = NULL;
1da177e4
LT
241 int errstatus, mbi, mbo, mbistatus;
242 int number_serviced;
243 unsigned long flags;
55b28f9f 244 struct scsi_cmnd *tmp_cmd;
1da177e4 245 int flag;
e98878f7
OZ
246 struct mailbox *mb = aha1542->mb;
247 struct ccb *ccb = aha1542->ccb;
1da177e4
LT
248
249#ifdef DEBUG
250 {
c2532f68 251 flag = inb(INTRFLAGS(sh->io_port));
2906b3ce 252 shost_printk(KERN_DEBUG, sh, "aha1542_intr_handle: ");
1da177e4
LT
253 if (!(flag & ANYINTR))
254 printk("no interrupt?");
255 if (flag & MBIF)
256 printk("MBIF ");
257 if (flag & MBOA)
258 printk("MBOF ");
259 if (flag & HACC)
260 printk("HACC ");
261 if (flag & SCRD)
262 printk("SCRD ");
c2532f68 263 printk("status %02x\n", inb(STATUS(sh->io_port)));
1da177e4
LT
264 };
265#endif
266 number_serviced = 0;
1da177e4 267
1b0224b0
OZ
268 spin_lock_irqsave(sh->host_lock, flags);
269 while (1) {
c2532f68 270 flag = inb(INTRFLAGS(sh->io_port));
1da177e4
LT
271
272 /* Check for unusual interrupts. If any of these happen, we should
273 probably do something special, but for now just printing a message
274 is sufficient. A SCSI reset detected is something that we really
275 need to deal with in some way. */
276 if (flag & ~MBIF) {
277 if (flag & MBOA)
278 printk("MBOF ");
279 if (flag & HACC)
280 printk("HACC ");
dfd7c991 281 if (flag & SCRD)
1da177e4 282 printk("SCRD ");
1da177e4 283 }
c2532f68 284 aha1542_intr_reset(sh->io_port);
1da177e4 285
e98878f7 286 mbi = aha1542->aha1542_last_mbi_used + 1;
1da177e4
LT
287 if (mbi >= 2 * AHA1542_MAILBOXES)
288 mbi = AHA1542_MAILBOXES;
289
290 do {
291 if (mb[mbi].status != 0)
292 break;
293 mbi++;
294 if (mbi >= 2 * AHA1542_MAILBOXES)
295 mbi = AHA1542_MAILBOXES;
e98878f7 296 } while (mbi != aha1542->aha1542_last_mbi_used);
1da177e4
LT
297
298 if (mb[mbi].status == 0) {
1b0224b0 299 spin_unlock_irqrestore(sh->host_lock, flags);
1da177e4 300 /* Hmm, no mail. Must have read it the last time around */
dfd7c991 301 if (!number_serviced)
2906b3ce 302 shost_printk(KERN_WARNING, sh, "interrupt received, but no mail.\n");
1b0224b0 303 return IRQ_HANDLED;
1da177e4
LT
304 };
305
10be6250 306 mbo = (scsi2int(mb[mbi].ccbptr) - (isa_virt_to_bus(&ccb[0]))) / sizeof(struct ccb);
1da177e4
LT
307 mbistatus = mb[mbi].status;
308 mb[mbi].status = 0;
e98878f7 309 aha1542->aha1542_last_mbi_used = mbi;
1da177e4
LT
310
311#ifdef DEBUG
fde1fb8a
OZ
312 if (ccb[mbo].tarstat | ccb[mbo].hastat)
313 shost_printk(KERN_DEBUG, sh, "aha1542_command: returning %x (status %d)\n",
314 ccb[mbo].tarstat + ((int) ccb[mbo].hastat << 16), mb[mbi].status);
1da177e4
LT
315#endif
316
317 if (mbistatus == 3)
318 continue; /* Aborted command not found */
319
320#ifdef DEBUG
2906b3ce 321 shost_printk(KERN_DEBUG, sh, "...done %d %d\n", mbo, mbi);
1da177e4
LT
322#endif
323
55b28f9f 324 tmp_cmd = aha1542->int_cmds[mbo];
1da177e4 325
55b28f9f 326 if (!tmp_cmd || !tmp_cmd->scsi_done) {
1b0224b0 327 spin_unlock_irqrestore(sh->host_lock, flags);
2906b3ce
OZ
328 shost_printk(KERN_WARNING, sh, "Unexpected interrupt\n");
329 shost_printk(KERN_WARNING, sh, "tarstat=%x, hastat=%x idlun=%x ccb#=%d\n", ccb[mbo].tarstat,
1da177e4 330 ccb[mbo].hastat, ccb[mbo].idlun, mbo);
1b0224b0 331 return IRQ_HANDLED;
1da177e4 332 }
55b28f9f
OZ
333 my_done = tmp_cmd->scsi_done;
334 kfree(tmp_cmd->host_scribble);
335 tmp_cmd->host_scribble = NULL;
1da177e4
LT
336 /* Fetch the sense data, and tuck it away, in the required slot. The
337 Adaptec automatically fetches it, and there is no guarantee that
338 we will still have it in the cdb when we come back */
339 if (ccb[mbo].tarstat == 2)
55b28f9f 340 memcpy(tmp_cmd->sense_buffer, &ccb[mbo].cdb[ccb[mbo].cdblen],
b80ca4f7 341 SCSI_SENSE_BUFFERSIZE);
1da177e4
LT
342
343
344 /* is there mail :-) */
345
346 /* more error checking left out here */
347 if (mbistatus != 1)
348 /* This is surely wrong, but I don't know what's right */
349 errstatus = makecode(ccb[mbo].hastat, ccb[mbo].tarstat);
350 else
351 errstatus = 0;
352
353#ifdef DEBUG
354 if (errstatus)
2906b3ce 355 shost_printk(KERN_DEBUG, sh, "(aha1542 error:%x %x %x) ", errstatus,
1da177e4 356 ccb[mbo].hastat, ccb[mbo].tarstat);
6ddc8cf4
OZ
357 if (ccb[mbo].tarstat == 2)
358 print_hex_dump_bytes("sense: ", DUMP_PREFIX_NONE, &ccb[mbo].cdb[ccb[mbo].cdblen], 12);
fde1fb8a
OZ
359 if (errstatus)
360 printk("aha1542_intr_handle: returning %6x\n", errstatus);
361#endif
55b28f9f
OZ
362 tmp_cmd->result = errstatus;
363 aha1542->int_cmds[mbo] = NULL; /* This effectively frees up the mailbox slot, as
e98878f7 364 far as queuecommand is concerned */
55b28f9f 365 my_done(tmp_cmd);
1da177e4
LT
366 number_serviced++;
367 };
368}
369
1b0224b0 370static int aha1542_queuecommand(struct Scsi_Host *sh, struct scsi_cmnd *cmd)
09a44833 371{
2906b3ce 372 struct aha1542_hostdata *aha1542 = shost_priv(sh);
cb5b570c 373 u8 direction;
55b28f9f
OZ
374 u8 target = cmd->device->id;
375 u8 lun = cmd->device->lun;
1da177e4 376 unsigned long flags;
55b28f9f 377 int bufflen = scsi_bufflen(cmd);
8c08a621 378 int mbo, sg_count;
e98878f7
OZ
379 struct mailbox *mb = aha1542->mb;
380 struct ccb *ccb = aha1542->ccb;
8c08a621 381 struct chain *cptr;
1da177e4 382
55b28f9f 383 if (*cmd->cmnd == REQUEST_SENSE) {
1da177e4 384 /* Don't do the command - we have the sense data already */
55b28f9f 385 cmd->result = 0;
1b0224b0 386 cmd->scsi_done(cmd);
1da177e4
LT
387 return 0;
388 }
389#ifdef DEBUG
764a0c7e
OZ
390 {
391 int i = -1;
392 if (*cmd->cmnd == READ_10 || *cmd->cmnd == WRITE_10)
393 i = xscsi2int(cmd->cmnd + 2);
394 else if (*cmd->cmnd == READ_6 || *cmd->cmnd == WRITE_6)
395 i = scsi2int(cmd->cmnd + 2);
396 shost_printk(KERN_DEBUG, sh, "aha1542_queuecommand: dev %d cmd %02x pos %d len %d",
397 target, *cmd->cmnd, i, bufflen);
398 print_hex_dump_bytes("command: ", DUMP_PREFIX_NONE, cmd->cmnd, cmd->cmd_len);
399 }
1da177e4 400#endif
8c08a621
OZ
401 if (bufflen) { /* allocate memory before taking host_lock */
402 sg_count = scsi_sg_count(cmd);
403 cptr = kmalloc(sizeof(*cptr) * sg_count, GFP_KERNEL | GFP_DMA);
404 if (!cptr)
405 return SCSI_MLQUEUE_HOST_BUSY;
ec54adfb
AB
406 } else {
407 sg_count = 0;
408 cptr = NULL;
8c08a621
OZ
409 }
410
1da177e4
LT
411 /* Use the outgoing mailboxes in a round-robin fashion, because this
412 is how the host adapter will scan for them */
413
1b0224b0 414 spin_lock_irqsave(sh->host_lock, flags);
e98878f7 415 mbo = aha1542->aha1542_last_mbo_used + 1;
1da177e4
LT
416 if (mbo >= AHA1542_MAILBOXES)
417 mbo = 0;
418
419 do {
55b28f9f 420 if (mb[mbo].status == 0 && aha1542->int_cmds[mbo] == NULL)
1da177e4
LT
421 break;
422 mbo++;
423 if (mbo >= AHA1542_MAILBOXES)
424 mbo = 0;
e98878f7 425 } while (mbo != aha1542->aha1542_last_mbo_used);
1da177e4 426
55b28f9f 427 if (mb[mbo].status || aha1542->int_cmds[mbo])
1da177e4
LT
428 panic("Unable to find empty mailbox for aha1542.\n");
429
55b28f9f 430 aha1542->int_cmds[mbo] = cmd; /* This will effectively prevent someone else from
e98878f7 431 screwing with this cdb. */
1da177e4 432
e98878f7 433 aha1542->aha1542_last_mbo_used = mbo;
1da177e4
LT
434
435#ifdef DEBUG
1b0224b0 436 shost_printk(KERN_DEBUG, sh, "Sending command (%d %p)...", mbo, cmd->scsi_done);
1da177e4
LT
437#endif
438
10be6250 439 any2scsi(mb[mbo].ccbptr, isa_virt_to_bus(&ccb[mbo])); /* This gets trashed for some reason */
1da177e4
LT
440
441 memset(&ccb[mbo], 0, sizeof(struct ccb));
442
55b28f9f 443 ccb[mbo].cdblen = cmd->cmd_len;
1da177e4
LT
444
445 direction = 0;
55b28f9f 446 if (*cmd->cmnd == READ_10 || *cmd->cmnd == READ_6)
1da177e4 447 direction = 8;
55b28f9f 448 else if (*cmd->cmnd == WRITE_10 || *cmd->cmnd == WRITE_6)
1da177e4
LT
449 direction = 16;
450
55b28f9f 451 memcpy(ccb[mbo].cdb, cmd->cmnd, ccb[mbo].cdblen);
1da177e4 452
fc3fdfcc 453 if (bufflen) {
51cf2249 454 struct scatterlist *sg;
8c08a621 455 int i;
6ddc8cf4 456
1da177e4 457 ccb[mbo].op = 2; /* SCSI Initiator Command w/scatter-gather */
8c08a621 458 cmd->host_scribble = (void *)cptr;
55b28f9f 459 scsi_for_each_sg(cmd, sg, sg_count, i) {
10be6250
OZ
460 any2scsi(cptr[i].dataptr, isa_page_to_bus(sg_page(sg))
461 + sg->offset);
51cf2249 462 any2scsi(cptr[i].datalen, sg->length);
1da177e4 463 };
fc3fdfcc 464 any2scsi(ccb[mbo].datalen, sg_count * sizeof(struct chain));
10be6250 465 any2scsi(ccb[mbo].dataptr, isa_virt_to_bus(cptr));
1da177e4 466#ifdef DEBUG
6ddc8cf4
OZ
467 shost_printk(KERN_DEBUG, sh, "cptr %p: ", cptr);
468 print_hex_dump_bytes("cptr: ", DUMP_PREFIX_NONE, cptr, 18);
1da177e4
LT
469#endif
470 } else {
471 ccb[mbo].op = 0; /* SCSI Initiator Command */
55b28f9f 472 cmd->host_scribble = NULL;
fc3fdfcc
BH
473 any2scsi(ccb[mbo].datalen, 0);
474 any2scsi(ccb[mbo].dataptr, 0);
1da177e4
LT
475 };
476 ccb[mbo].idlun = (target & 7) << 5 | direction | (lun & 7); /*SCSI Target Id */
477 ccb[mbo].rsalen = 16;
478 ccb[mbo].linkptr[0] = ccb[mbo].linkptr[1] = ccb[mbo].linkptr[2] = 0;
479 ccb[mbo].commlinkid = 0;
480
481#ifdef DEBUG
6ddc8cf4 482 print_hex_dump_bytes("sending: ", DUMP_PREFIX_NONE, &ccb[mbo], sizeof(ccb[mbo]) - 10);
1b0224b0 483 printk("aha1542_queuecommand: now waiting for interrupt ");
1da177e4 484#endif
1b0224b0
OZ
485 mb[mbo].status = 1;
486 aha1542_outb(cmd->device->host->io_port, CMD_START_SCSI);
487 spin_unlock_irqrestore(sh->host_lock, flags);
1da177e4
LT
488
489 return 0;
490}
491
492/* Initialize mailboxes */
68ea9de3 493static void setup_mailboxes(struct Scsi_Host *sh)
1da177e4 494{
c2532f68 495 struct aha1542_hostdata *aha1542 = shost_priv(sh);
1da177e4 496 int i;
e98878f7
OZ
497 struct mailbox *mb = aha1542->mb;
498 struct ccb *ccb = aha1542->ccb;
1da177e4 499
cad2fc72 500 u8 mb_cmd[5] = { CMD_MBINIT, AHA1542_MAILBOXES, 0, 0, 0};
1da177e4 501
1da177e4
LT
502 for (i = 0; i < AHA1542_MAILBOXES; i++) {
503 mb[i].status = mb[AHA1542_MAILBOXES + i].status = 0;
10be6250 504 any2scsi(mb[i].ccbptr, isa_virt_to_bus(&ccb[i]));
1da177e4 505 };
68ea9de3 506 aha1542_intr_reset(sh->io_port); /* reset interrupts, so they don't block */
cad2fc72 507 any2scsi((mb_cmd + 2), isa_virt_to_bus(mb));
68ea9de3 508 if (aha1542_out(sh->io_port, mb_cmd, 5))
2906b3ce 509 shost_printk(KERN_ERR, sh, "failed setting up mailboxes\n");
68ea9de3 510 aha1542_intr_reset(sh->io_port);
1da177e4
LT
511}
512
68ea9de3 513static int aha1542_getconfig(struct Scsi_Host *sh)
1da177e4 514{
cb5b570c 515 u8 inquiry_result[3];
1da177e4 516 int i;
68ea9de3 517 i = inb(STATUS(sh->io_port));
1da177e4 518 if (i & DF) {
68ea9de3 519 i = inb(DATA(sh->io_port));
1da177e4 520 };
68ea9de3
OZ
521 aha1542_outb(sh->io_port, CMD_RETCONF);
522 aha1542_in(sh->io_port, inquiry_result, 3, 0);
523 if (!wait_mask(INTRFLAGS(sh->io_port), INTRMASK, HACC, 0, 0))
2906b3ce 524 shost_printk(KERN_ERR, sh, "error querying board settings\n");
68ea9de3 525 aha1542_intr_reset(sh->io_port);
1da177e4
LT
526 switch (inquiry_result[0]) {
527 case 0x80:
68ea9de3 528 sh->dma_channel = 7;
1da177e4
LT
529 break;
530 case 0x40:
68ea9de3 531 sh->dma_channel = 6;
1da177e4
LT
532 break;
533 case 0x20:
68ea9de3 534 sh->dma_channel = 5;
1da177e4
LT
535 break;
536 case 0x01:
68ea9de3 537 sh->dma_channel = 0;
1da177e4
LT
538 break;
539 case 0:
540 /* This means that the adapter, although Adaptec 1542 compatible, doesn't use a DMA channel.
541 Currently only aware of the BusLogic BT-445S VL-Bus adapter which needs this. */
68ea9de3 542 sh->dma_channel = 0xFF;
1da177e4
LT
543 break;
544 default:
2906b3ce 545 shost_printk(KERN_ERR, sh, "Unable to determine DMA channel.\n");
1da177e4
LT
546 return -1;
547 };
548 switch (inquiry_result[1]) {
549 case 0x40:
68ea9de3 550 sh->irq = 15;
1da177e4
LT
551 break;
552 case 0x20:
68ea9de3 553 sh->irq = 14;
1da177e4
LT
554 break;
555 case 0x8:
68ea9de3 556 sh->irq = 12;
1da177e4
LT
557 break;
558 case 0x4:
68ea9de3 559 sh->irq = 11;
1da177e4
LT
560 break;
561 case 0x2:
68ea9de3 562 sh->irq = 10;
1da177e4
LT
563 break;
564 case 0x1:
68ea9de3 565 sh->irq = 9;
1da177e4
LT
566 break;
567 default:
2906b3ce 568 shost_printk(KERN_ERR, sh, "Unable to determine IRQ level.\n");
1da177e4
LT
569 return -1;
570 };
68ea9de3 571 sh->this_id = inquiry_result[2] & 7;
1da177e4
LT
572 return 0;
573}
574
575/* This function should only be called for 1542C boards - we can detect
576 the special firmware settings and unlock the board */
577
68ea9de3 578static int aha1542_mbenable(struct Scsi_Host *sh)
1da177e4 579{
cb5b570c
OZ
580 static u8 mbenable_cmd[3];
581 static u8 mbenable_result[2];
1da177e4
LT
582 int retval;
583
584 retval = BIOS_TRANSLATION_6432;
585
68ea9de3
OZ
586 aha1542_outb(sh->io_port, CMD_EXTBIOS);
587 if (aha1542_in(sh->io_port, mbenable_result, 2, 100))
1da177e4 588 return retval;
68ea9de3 589 if (!wait_mask(INTRFLAGS(sh->io_port), INTRMASK, HACC, 0, 100))
2093bfa1 590 goto fail;
68ea9de3 591 aha1542_intr_reset(sh->io_port);
1da177e4
LT
592
593 if ((mbenable_result[0] & 0x08) || mbenable_result[1]) {
594 mbenable_cmd[0] = CMD_MBENABLE;
595 mbenable_cmd[1] = 0;
596 mbenable_cmd[2] = mbenable_result[1];
597
598 if ((mbenable_result[0] & 0x08) && (mbenable_result[1] & 0x03))
599 retval = BIOS_TRANSLATION_25563;
600
68ea9de3 601 if (aha1542_out(sh->io_port, mbenable_cmd, 3))
2093bfa1 602 goto fail;
1da177e4
LT
603 };
604 while (0) {
605fail:
2906b3ce 606 shost_printk(KERN_ERR, sh, "Mailbox init failed\n");
1da177e4 607 }
68ea9de3 608 aha1542_intr_reset(sh->io_port);
1da177e4
LT
609 return retval;
610}
611
612/* Query the board to find out if it is a 1542 or a 1740, or whatever. */
68ea9de3 613static int aha1542_query(struct Scsi_Host *sh)
1da177e4 614{
68ea9de3 615 struct aha1542_hostdata *aha1542 = shost_priv(sh);
cb5b570c 616 u8 inquiry_result[4];
1da177e4 617 int i;
68ea9de3 618 i = inb(STATUS(sh->io_port));
1da177e4 619 if (i & DF) {
68ea9de3 620 i = inb(DATA(sh->io_port));
1da177e4 621 };
68ea9de3
OZ
622 aha1542_outb(sh->io_port, CMD_INQUIRY);
623 aha1542_in(sh->io_port, inquiry_result, 4, 0);
624 if (!wait_mask(INTRFLAGS(sh->io_port), INTRMASK, HACC, 0, 0))
2906b3ce 625 shost_printk(KERN_ERR, sh, "error querying card type\n");
68ea9de3 626 aha1542_intr_reset(sh->io_port);
1da177e4 627
68ea9de3 628 aha1542->bios_translation = BIOS_TRANSLATION_6432; /* Default case */
1da177e4
LT
629
630 /* For an AHA1740 series board, we ignore the board since there is a
631 hardware bug which can lead to wrong blocks being returned if the board
632 is operating in the 1542 emulation mode. Since there is an extended mode
633 driver, we simply ignore the board and let the 1740 driver pick it up.
634 */
635
636 if (inquiry_result[0] == 0x43) {
2906b3ce 637 shost_printk(KERN_INFO, sh, "Emulation mode not supported for AHA-1740 hardware, use aha1740 driver instead.\n");
1da177e4
LT
638 return 1;
639 };
640
641 /* Always call this - boards that do not support extended bios translation
642 will ignore the command, and we will set the proper default */
643
68ea9de3 644 aha1542->bios_translation = aha1542_mbenable(sh);
1da177e4
LT
645
646 return 0;
647}
648
f71429ab 649static u8 dma_speed_hw(int dma_speed)
1da177e4 650{
f71429ab
OZ
651 switch (dma_speed) {
652 case 5:
653 return 0x00;
654 case 6:
655 return 0x04;
656 case 7:
657 return 0x01;
658 case 8:
659 return 0x02;
660 case 10:
661 return 0x03;
1da177e4 662 }
1da177e4 663
f71429ab 664 return 0xff; /* invalid */
1da177e4
LT
665}
666
f71429ab 667/* Set the Bus on/off-times as not to ruin floppy performance */
37d607bd 668static void aha1542_set_bus_times(struct Scsi_Host *sh, int bus_on, int bus_off, int dma_speed)
1da177e4 669{
37d607bd
OZ
670 if (bus_on > 0) {
671 u8 oncmd[] = { CMD_BUSON_TIME, clamp(bus_on, 2, 15) };
1da177e4 672
37d607bd
OZ
673 aha1542_intr_reset(sh->io_port);
674 if (aha1542_out(sh->io_port, oncmd, 2))
f71429ab
OZ
675 goto fail;
676 }
1da177e4 677
37d607bd
OZ
678 if (bus_off > 0) {
679 u8 offcmd[] = { CMD_BUSOFF_TIME, clamp(bus_off, 1, 64) };
1da177e4 680
37d607bd
OZ
681 aha1542_intr_reset(sh->io_port);
682 if (aha1542_out(sh->io_port, offcmd, 2))
f71429ab
OZ
683 goto fail;
684 }
1da177e4 685
37d607bd
OZ
686 if (dma_speed_hw(dma_speed) != 0xff) {
687 u8 dmacmd[] = { CMD_DMASPEED, dma_speed_hw(dma_speed) };
b847fd0d 688
37d607bd
OZ
689 aha1542_intr_reset(sh->io_port);
690 if (aha1542_out(sh->io_port, dmacmd, 2))
b847fd0d
OZ
691 goto fail;
692 }
37d607bd 693 aha1542_intr_reset(sh->io_port);
b847fd0d
OZ
694 return;
695fail:
2906b3ce 696 shost_printk(KERN_ERR, sh, "setting bus on/off-time failed\n");
37d607bd 697 aha1542_intr_reset(sh->io_port);
b847fd0d
OZ
698}
699
1da177e4 700/* return non-zero on detection */
643a7c43 701static struct Scsi_Host *aha1542_hw_init(struct scsi_host_template *tpnt, struct device *pdev, int indx)
1da177e4 702{
f71429ab 703 unsigned int base_io = io[indx];
c2532f68 704 struct Scsi_Host *sh;
e98878f7 705 struct aha1542_hostdata *aha1542;
2906b3ce 706 char dma_info[] = "no DMA";
1da177e4 707
3a70c006
OZ
708 if (base_io == 0)
709 return NULL;
1da177e4 710
3a70c006
OZ
711 if (!request_region(base_io, AHA1542_REGION_SIZE, "aha1542"))
712 return NULL;
1da177e4 713
c2532f68
OZ
714 sh = scsi_host_alloc(tpnt, sizeof(struct aha1542_hostdata));
715 if (!sh)
3a70c006 716 goto release;
c2532f68 717 aha1542 = shost_priv(sh);
b847fd0d 718
68ea9de3
OZ
719 sh->unique_id = base_io;
720 sh->io_port = base_io;
721 sh->n_io_port = AHA1542_REGION_SIZE;
722 aha1542->aha1542_last_mbi_used = 2 * AHA1542_MAILBOXES - 1;
723 aha1542->aha1542_last_mbo_used = AHA1542_MAILBOXES - 1;
724
725 if (!aha1542_test_port(sh))
3a70c006 726 goto unregister;
1da177e4 727
37d607bd 728 aha1542_set_bus_times(sh, bus_on[indx], bus_off[indx], dma_speed[indx]);
68ea9de3 729 if (aha1542_query(sh))
3a70c006 730 goto unregister;
68ea9de3 731 if (aha1542_getconfig(sh) == -1)
3a70c006 732 goto unregister;
1da177e4 733
c2532f68 734 if (sh->dma_channel != 0xFF)
2906b3ce
OZ
735 snprintf(dma_info, sizeof(dma_info), "DMA %d", sh->dma_channel);
736 shost_printk(KERN_INFO, sh, "Adaptec AHA-1542 (SCSI-ID %d) at IO 0x%x, IRQ %d, %s\n",
737 sh->this_id, base_io, sh->irq, dma_info);
3a70c006 738 if (aha1542->bios_translation == BIOS_TRANSLATION_25563)
2906b3ce 739 shost_printk(KERN_INFO, sh, "Using extended bios translation\n");
1da177e4 740
68ea9de3 741 setup_mailboxes(sh);
1da177e4 742
1b0224b0 743 if (request_irq(sh->irq, aha1542_interrupt, 0, "aha1542", sh)) {
2906b3ce 744 shost_printk(KERN_ERR, sh, "Unable to allocate IRQ.\n");
3a70c006
OZ
745 goto unregister;
746 }
c2532f68
OZ
747 if (sh->dma_channel != 0xFF) {
748 if (request_dma(sh->dma_channel, "aha1542")) {
2906b3ce 749 shost_printk(KERN_ERR, sh, "Unable to allocate DMA channel.\n");
3a70c006
OZ
750 goto free_irq;
751 }
c2532f68
OZ
752 if (sh->dma_channel == 0 || sh->dma_channel >= 5) {
753 set_dma_mode(sh->dma_channel, DMA_MODE_CASCADE);
754 enable_dma(sh->dma_channel);
3a70c006
OZ
755 }
756 }
1da177e4 757
c2532f68 758 if (scsi_add_host(sh, pdev))
3a70c006 759 goto free_dma;
1da177e4 760
c2532f68 761 scsi_scan_host(sh);
1da177e4 762
c2532f68 763 return sh;
3a70c006 764free_dma:
c2532f68
OZ
765 if (sh->dma_channel != 0xff)
766 free_dma(sh->dma_channel);
3a70c006 767free_irq:
c2532f68 768 free_irq(sh->irq, sh);
3a70c006 769unregister:
c2532f68 770 scsi_host_put(sh);
3a70c006
OZ
771release:
772 release_region(base_io, AHA1542_REGION_SIZE);
1da177e4 773
643a7c43 774 return NULL;
1da177e4
LT
775}
776
c2532f68 777static int aha1542_release(struct Scsi_Host *sh)
1da177e4 778{
c2532f68
OZ
779 scsi_remove_host(sh);
780 if (sh->dma_channel != 0xff)
781 free_dma(sh->dma_channel);
782 if (sh->irq)
783 free_irq(sh->irq, sh);
784 if (sh->io_port && sh->n_io_port)
785 release_region(sh->io_port, sh->n_io_port);
786 scsi_host_put(sh);
1da177e4
LT
787 return 0;
788}
789
1da177e4 790
1da177e4
LT
791/*
792 * This is a device reset. This is handled by sending a special command
793 * to the device.
794 */
55b28f9f 795static int aha1542_dev_reset(struct scsi_cmnd *cmd)
1da177e4 796{
1b0224b0
OZ
797 struct Scsi_Host *sh = cmd->device->host;
798 struct aha1542_hostdata *aha1542 = shost_priv(sh);
1da177e4 799 unsigned long flags;
e98878f7 800 struct mailbox *mb = aha1542->mb;
55b28f9f
OZ
801 u8 target = cmd->device->id;
802 u8 lun = cmd->device->lun;
1da177e4 803 int mbo;
e98878f7 804 struct ccb *ccb = aha1542->ccb;
1da177e4 805
1b0224b0 806 spin_lock_irqsave(sh->host_lock, flags);
e98878f7 807 mbo = aha1542->aha1542_last_mbo_used + 1;
1da177e4
LT
808 if (mbo >= AHA1542_MAILBOXES)
809 mbo = 0;
810
811 do {
55b28f9f 812 if (mb[mbo].status == 0 && aha1542->int_cmds[mbo] == NULL)
1da177e4
LT
813 break;
814 mbo++;
815 if (mbo >= AHA1542_MAILBOXES)
816 mbo = 0;
e98878f7 817 } while (mbo != aha1542->aha1542_last_mbo_used);
1da177e4 818
55b28f9f 819 if (mb[mbo].status || aha1542->int_cmds[mbo])
1da177e4
LT
820 panic("Unable to find empty mailbox for aha1542.\n");
821
55b28f9f 822 aha1542->int_cmds[mbo] = cmd; /* This will effectively
e98878f7
OZ
823 prevent someone else from
824 screwing with this cdb. */
1da177e4 825
e98878f7 826 aha1542->aha1542_last_mbo_used = mbo;
1da177e4 827
10be6250 828 any2scsi(mb[mbo].ccbptr, isa_virt_to_bus(&ccb[mbo])); /* This gets trashed for some reason */
1da177e4
LT
829
830 memset(&ccb[mbo], 0, sizeof(struct ccb));
831
832 ccb[mbo].op = 0x81; /* BUS DEVICE RESET */
833
834 ccb[mbo].idlun = (target & 7) << 5 | (lun & 7); /*SCSI Target Id */
835
836 ccb[mbo].linkptr[0] = ccb[mbo].linkptr[1] = ccb[mbo].linkptr[2] = 0;
837 ccb[mbo].commlinkid = 0;
838
839 /*
840 * Now tell the 1542 to flush all pending commands for this
841 * target
842 */
1b0224b0
OZ
843 aha1542_outb(sh->io_port, CMD_START_SCSI);
844 spin_unlock_irqrestore(sh->host_lock, flags);
1da177e4 845
55b28f9f 846 scmd_printk(KERN_WARNING, cmd,
017560fc 847 "Trying device reset for target\n");
1da177e4
LT
848
849 return SUCCESS;
1da177e4
LT
850}
851
55b28f9f 852static int aha1542_reset(struct scsi_cmnd *cmd, u8 reset_cmd)
1da177e4 853{
1b0224b0
OZ
854 struct Scsi_Host *sh = cmd->device->host;
855 struct aha1542_hostdata *aha1542 = shost_priv(sh);
856 unsigned long flags;
1da177e4
LT
857 int i;
858
1b0224b0 859 spin_lock_irqsave(sh->host_lock, flags);
1da177e4
LT
860 /*
861 * This does a scsi reset for all devices on the bus.
862 * In principle, we could also reset the 1542 - should
863 * we do this? Try this first, and we can add that later
864 * if it turns out to be useful.
865 */
55b28f9f 866 outb(reset_cmd, CONTROL(cmd->device->host->io_port));
1da177e4 867
55b28f9f 868 if (!wait_mask(STATUS(cmd->device->host->io_port),
7061dec4 869 STATMASK, IDLE, STST | DIAGF | INVDCMD | DF | CDF, 0)) {
1b0224b0 870 spin_unlock_irqrestore(sh->host_lock, flags);
a13b3722
OZ
871 return FAILED;
872 }
1b0224b0 873
8537cba8
OZ
874 /*
875 * We need to do this too before the 1542 can interact with
876 * us again after host reset.
877 */
878 if (reset_cmd & HRST)
68ea9de3 879 setup_mailboxes(cmd->device->host);
1b0224b0 880
1da177e4
LT
881 /*
882 * Now try to pick up the pieces. For all pending commands,
883 * free any internal data structures, and basically clear things
884 * out. We do not try and restart any commands or anything -
885 * the strategy handler takes care of that crap.
886 */
2906b3ce 887 shost_printk(KERN_WARNING, cmd->device->host, "Sent BUS RESET to scsi host %d\n", cmd->device->host->host_no);
1da177e4
LT
888
889 for (i = 0; i < AHA1542_MAILBOXES; i++) {
55b28f9f
OZ
890 if (aha1542->int_cmds[i] != NULL) {
891 struct scsi_cmnd *tmp_cmd;
892 tmp_cmd = aha1542->int_cmds[i];
1da177e4 893
55b28f9f 894 if (tmp_cmd->device->soft_reset) {
1da177e4
LT
895 /*
896 * If this device implements the soft reset option,
897 * then it is still holding onto the command, and
898 * may yet complete it. In this case, we don't
899 * flush the data.
900 */
901 continue;
902 }
55b28f9f
OZ
903 kfree(tmp_cmd->host_scribble);
904 tmp_cmd->host_scribble = NULL;
905 aha1542->int_cmds[i] = NULL;
e98878f7 906 aha1542->mb[i].status = 0;
1da177e4
LT
907 }
908 }
909
1b0224b0 910 spin_unlock_irqrestore(sh->host_lock, flags);
1da177e4 911 return SUCCESS;
1da177e4
LT
912}
913
55b28f9f 914static int aha1542_bus_reset(struct scsi_cmnd *cmd)
1da177e4 915{
55b28f9f 916 return aha1542_reset(cmd, SCRST);
8537cba8 917}
1da177e4 918
55b28f9f 919static int aha1542_host_reset(struct scsi_cmnd *cmd)
8537cba8 920{
55b28f9f 921 return aha1542_reset(cmd, HRST | SCRST);
1da177e4
LT
922}
923
1da177e4 924static int aha1542_biosparam(struct scsi_device *sdev,
17787a09 925 struct block_device *bdev, sector_t capacity, int geom[])
1da177e4 926{
e98878f7 927 struct aha1542_hostdata *aha1542 = shost_priv(sdev->host);
1da177e4 928
17787a09
OZ
929 if (capacity >= 0x200000 &&
930 aha1542->bios_translation == BIOS_TRANSLATION_25563) {
1da177e4 931 /* Please verify that this is the same as what DOS returns */
17787a09
OZ
932 geom[0] = 255; /* heads */
933 geom[1] = 63; /* sectors */
1da177e4 934 } else {
17787a09
OZ
935 geom[0] = 64; /* heads */
936 geom[1] = 32; /* sectors */
1da177e4 937 }
17787a09 938 geom[2] = sector_div(capacity, geom[0] * geom[1]); /* cylinders */
1da177e4
LT
939
940 return 0;
941}
942MODULE_LICENSE("GPL");
943
d0be4a7d 944static struct scsi_host_template driver_template = {
643a7c43 945 .module = THIS_MODULE,
1da177e4
LT
946 .proc_name = "aha1542",
947 .name = "Adaptec 1542",
1da177e4 948 .queuecommand = aha1542_queuecommand,
1da177e4
LT
949 .eh_device_reset_handler= aha1542_dev_reset,
950 .eh_bus_reset_handler = aha1542_bus_reset,
951 .eh_host_reset_handler = aha1542_host_reset,
952 .bios_param = aha1542_biosparam,
953 .can_queue = AHA1542_MAILBOXES,
954 .this_id = 7,
10be6250 955 .sg_tablesize = 16,
1da177e4
LT
956 .unchecked_isa_dma = 1,
957 .use_clustering = ENABLE_CLUSTERING,
958};
643a7c43
OZ
959
960static int aha1542_isa_match(struct device *pdev, unsigned int ndev)
961{
962 struct Scsi_Host *sh = aha1542_hw_init(&driver_template, pdev, ndev);
963
964 if (!sh)
965 return 0;
966
967 dev_set_drvdata(pdev, sh);
968 return 1;
969}
970
971static int aha1542_isa_remove(struct device *pdev,
972 unsigned int ndev)
973{
974 aha1542_release(dev_get_drvdata(pdev));
975 dev_set_drvdata(pdev, NULL);
976 return 0;
977}
978
979static struct isa_driver aha1542_isa_driver = {
980 .match = aha1542_isa_match,
981 .remove = aha1542_isa_remove,
982 .driver = {
983 .name = "aha1542"
984 },
985};
986static int isa_registered;
987
988#ifdef CONFIG_PNP
989static struct pnp_device_id aha1542_pnp_ids[] = {
990 { .id = "ADP1542" },
991 { .id = "" }
992};
993MODULE_DEVICE_TABLE(pnp, aha1542_pnp_ids);
994
995static int aha1542_pnp_probe(struct pnp_dev *pdev, const struct pnp_device_id *id)
996{
997 int indx;
998 struct Scsi_Host *sh;
999
f71429ab
OZ
1000 for (indx = 0; indx < ARRAY_SIZE(io); indx++) {
1001 if (io[indx])
643a7c43
OZ
1002 continue;
1003
1004 if (pnp_activate_dev(pdev) < 0)
1005 continue;
1006
f71429ab 1007 io[indx] = pnp_port_start(pdev, 0);
643a7c43
OZ
1008
1009 /* The card can be queried for its DMA, we have
1010 the DMA set up that is enough */
1011
2906b3ce 1012 dev_info(&pdev->dev, "ISAPnP found an AHA1535 at I/O 0x%03X", io[indx]);
643a7c43
OZ
1013 }
1014
1015 sh = aha1542_hw_init(&driver_template, &pdev->dev, indx);
1016 if (!sh)
1017 return -ENODEV;
1018
1019 pnp_set_drvdata(pdev, sh);
1020 return 0;
1021}
1022
1023static void aha1542_pnp_remove(struct pnp_dev *pdev)
1024{
1025 aha1542_release(pnp_get_drvdata(pdev));
1026 pnp_set_drvdata(pdev, NULL);
1027}
1028
1029static struct pnp_driver aha1542_pnp_driver = {
1030 .name = "aha1542",
1031 .id_table = aha1542_pnp_ids,
1032 .probe = aha1542_pnp_probe,
1033 .remove = aha1542_pnp_remove,
1034};
1035static int pnp_registered;
1036#endif /* CONFIG_PNP */
1037
1038static int __init aha1542_init(void)
1039{
1040 int ret = 0;
643a7c43
OZ
1041
1042#ifdef CONFIG_PNP
1043 if (isapnp) {
1044 ret = pnp_register_driver(&aha1542_pnp_driver);
1045 if (!ret)
1046 pnp_registered = 1;
1047 }
1048#endif
1049 ret = isa_register_driver(&aha1542_isa_driver, MAXBOARDS);
1050 if (!ret)
1051 isa_registered = 1;
1052
1053#ifdef CONFIG_PNP
1054 if (pnp_registered)
1055 ret = 0;
1056#endif
1057 if (isa_registered)
1058 ret = 0;
1059
1060 return ret;
1061}
1062
1063static void __exit aha1542_exit(void)
1064{
1065#ifdef CONFIG_PNP
1066 if (pnp_registered)
1067 pnp_unregister_driver(&aha1542_pnp_driver);
1068#endif
1069 if (isa_registered)
1070 isa_unregister_driver(&aha1542_isa_driver);
1071}
1072
1073module_init(aha1542_init);
1074module_exit(aha1542_exit);