blob: 5b8b2937a3fea85e6d69f02526158c659a182584 [file] [log] [blame]
Ondrej Zary1d084d22015-02-06 23:11:47 +01001/*
2 * Driver for Adaptec AHA-1542 SCSI host adapters
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 *
4 * Copyright (C) 1992 Tommy Thorn
5 * Copyright (C) 1993, 1994, 1995 Eric Youngdale
Ondrej Zary1d084d22015-02-06 23:11:47 +01006 * Copyright (C) 2015 Ondrej Zary
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 */
8
Linus Torvalds1da177e2005-04-16 15:20:36 -07009#include <linux/module.h>
10#include <linux/interrupt.h>
11#include <linux/kernel.h>
12#include <linux/types.h>
13#include <linux/string.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <linux/delay.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/init.h>
16#include <linux/spinlock.h>
Ondrej Zary643a7c42015-02-06 23:11:22 +010017#include <linux/isa.h>
18#include <linux/pnp.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090019#include <linux/slab.h>
Ondrej Zary954a9fd2015-02-06 23:11:48 +010020#include <linux/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021#include <asm/dma.h>
Ondrej Zary954a9fd2015-02-06 23:11:48 +010022#include <scsi/scsi_cmnd.h>
23#include <scsi/scsi_device.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <scsi/scsi_host.h>
25#include "aha1542.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070026
Ondrej Zaryf71429a2015-02-06 23:11:41 +010027#define MAXBOARDS 4
Linus Torvalds1da177e2005-04-16 15:20:36 -070028
Ondrej Zaryf71429a2015-02-06 23:11:41 +010029static bool isapnp = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -070030module_param(isapnp, bool, 0);
Ondrej Zaryf71429a2015-02-06 23:11:41 +010031MODULE_PARM_DESC(isapnp, "enable PnP support (default=1)");
32
33static int io[MAXBOARDS] = { 0x330, 0x334, 0, 0 };
34module_param_array(io, int, NULL, 0);
35MODULE_PARM_DESC(io, "base IO address of controller (0x130,0x134,0x230,0x234,0x330,0x334, default=0x330,0x334)");
36
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])");
41
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])");
46
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])");
Linus Torvalds1da177e2005-04-16 15:20:36 -070051
Linus Torvalds1da177e2005-04-16 15:20:36 -070052#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;
Ondrej Zary55b28f92015-02-06 23:11:44 +010060 struct scsi_cmnd *int_cmds[AHA1542_MAILBOXES];
Linus Torvalds1da177e2005-04-16 15:20:36 -070061 struct mailbox mb[2 * AHA1542_MAILBOXES];
62 struct ccb ccb[AHA1542_MAILBOXES];
63};
64
Ondrej Zaryf1bbef62015-02-06 23:11:26 +010065static inline void aha1542_intr_reset(u16 base)
66{
67 outb(IRST, CONTROL(base));
68}
Linus Torvalds1da177e2005-04-16 15:20:36 -070069
Ondrej Zary2093bfa2015-02-06 23:11:31 +010070static inline bool wait_mask(u16 port, u8 mask, u8 allof, u8 noneof, int timeout)
71{
72 bool delayed = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -070073
Ondrej Zary2093bfa2015-02-06 23:11:31 +010074 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}
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
Ondrej Zarycad2fc72015-02-06 23:11:43 +010092static int aha1542_outb(unsigned int base, u8 val)
Ondrej Zary0c2b6482015-02-06 23:11:33 +010093{
Ondrej Zaryeef77802015-02-06 23:11:57 +010094 if (!wait_mask(STATUS(base), CDF, 0, CDF, 0))
95 return 1;
96 outb(val, DATA(base));
97
98 return 0;
Ondrej Zary0c2b6482015-02-06 23:11:33 +010099}
100
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100101static int aha1542_out(unsigned int base, u8 *buf, int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102{
Ondrej Zary0c2b6482015-02-06 23:11:33 +0100103 while (len--) {
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100104 if (!wait_mask(STATUS(base), CDF, 0, CDF, 0))
Ondrej Zary0c2b6482015-02-06 23:11:33 +0100105 return 1;
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100106 outb(*buf++, DATA(base));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 }
Ondrej Zary23e69402015-02-06 23:11:39 +0100108 if (!wait_mask(INTRFLAGS(base), INTRMASK, HACC, 0, 0))
109 return 1;
Ondrej Zary0c2b6482015-02-06 23:11:33 +0100110
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112}
113
114/* Only used at boot time, so we do not need to worry about latency as much
115 here */
116
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100117static int aha1542_in(unsigned int base, u8 *buf, int len, int timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119 while (len--) {
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100120 if (!wait_mask(STATUS(base), DF, DF, 0, timeout))
Ondrej Zarya13b3722015-02-06 23:11:34 +0100121 return 1;
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100122 *buf++ = inb(DATA(base));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700123 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125}
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. */
Ondrej Zaryfde1fb82015-02-06 23:11:52 +0100166#ifdef DEBUG
167 printk("Aha1542: %x %x\n", hosterr, scsierr);
168#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169 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
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100185static int aha1542_test_port(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186{
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100187 u8 inquiry_result[4];
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100188 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189
190 /* Quick and dirty test for presence of the card. */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100191 if (inb(STATUS(sh->io_port)) == 0xff)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192 return 0;
193
194 /* Reset the adapter. I ought to make a hard reset, but it's not really necessary */
195
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 /* In case some other card was probing here, reset interrupts */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100197 aha1542_intr_reset(sh->io_port); /* reset interrupts, so they don't block */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100199 outb(SRST | IRST /*|SCRST */ , CONTROL(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200
201 mdelay(20); /* Wait a little bit for things to settle down. */
202
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 /* Expect INIT and IDLE, any of the others are bad */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100204 if (!wait_mask(STATUS(sh->io_port), STATMASK, INIT | IDLE, STST | DIAGF | INVDCMD | DF | CDF, 0))
Ondrej Zarya13b3722015-02-06 23:11:34 +0100205 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206
Linus Torvalds1da177e2005-04-16 15:20:36 -0700207 /* Shouldn't have generated any interrupts during reset */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100208 if (inb(INTRFLAGS(sh->io_port)) & INTRMASK)
Ondrej Zarya13b3722015-02-06 23:11:34 +0100209 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 /* Perform a host adapter inquiry instead so we do not need to set
212 up the mailboxes ahead of time */
213
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100214 aha1542_outb(sh->io_port, CMD_INQUIRY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100216 for (i = 0; i < 4; i++) {
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100217 if (!wait_mask(STATUS(sh->io_port), DF, DF, 0, 0))
Ondrej Zarya13b3722015-02-06 23:11:34 +0100218 return 0;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100219 inquiry_result[i] = inb(DATA(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220 }
221
Linus Torvalds1da177e2005-04-16 15:20:36 -0700222 /* Reading port should reset DF */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100223 if (inb(STATUS(sh->io_port)) & DF)
Ondrej Zarya13b3722015-02-06 23:11:34 +0100224 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226 /* When HACC, command is completed, and we're though testing */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100227 if (!wait_mask(INTRFLAGS(sh->io_port), HACC, HACC, 0, 0))
Ondrej Zarya13b3722015-02-06 23:11:34 +0100228 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230 /* Clear interrupts */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100231 outb(IRST, CONTROL(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232
Ondrej Zarybdebe222015-02-06 23:11:35 +0100233 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234}
235
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100236static irqreturn_t aha1542_interrupt(int irq, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237{
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100238 struct Scsi_Host *sh = dev_id;
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100239 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Ondrej Zary55b28f92015-02-06 23:11:44 +0100240 void (*my_done)(struct scsi_cmnd *) = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 int errstatus, mbi, mbo, mbistatus;
242 int number_serviced;
243 unsigned long flags;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100244 struct scsi_cmnd *tmp_cmd;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 int flag;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100246 struct mailbox *mb = aha1542->mb;
247 struct ccb *ccb = aha1542->ccb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248
249#ifdef DEBUG
250 {
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100251 flag = inb(INTRFLAGS(sh->io_port));
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100252 shost_printk(KERN_DEBUG, sh, "aha1542_intr_handle: ");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253 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 ");
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100263 printk("status %02x\n", inb(STATUS(sh->io_port)));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264 };
265#endif
266 number_serviced = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100268 spin_lock_irqsave(sh->host_lock, flags);
269 while (1) {
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100270 flag = inb(INTRFLAGS(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271
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 ");
Ondrej Zarydfd7c992015-02-06 23:11:36 +0100281 if (flag & SCRD)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 printk("SCRD ");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283 }
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100284 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285
Ondrej Zarye98878f2015-02-06 23:11:25 +0100286 mbi = aha1542->aha1542_last_mbi_used + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 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;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100296 } while (mbi != aha1542->aha1542_last_mbi_used);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297
298 if (mb[mbi].status == 0) {
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100299 spin_unlock_irqrestore(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 /* Hmm, no mail. Must have read it the last time around */
Ondrej Zarydfd7c992015-02-06 23:11:36 +0100301 if (!number_serviced)
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100302 shost_printk(KERN_WARNING, sh, "interrupt received, but no mail.\n");
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100303 return IRQ_HANDLED;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304 };
305
Ondrej Zary10be6252015-02-06 23:11:24 +0100306 mbo = (scsi2int(mb[mbi].ccbptr) - (isa_virt_to_bus(&ccb[0]))) / sizeof(struct ccb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307 mbistatus = mb[mbi].status;
308 mb[mbi].status = 0;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100309 aha1542->aha1542_last_mbi_used = mbi;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310
311#ifdef DEBUG
Ondrej Zaryfde1fb82015-02-06 23:11:52 +0100312 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315#endif
316
317 if (mbistatus == 3)
318 continue; /* Aborted command not found */
319
320#ifdef DEBUG
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100321 shost_printk(KERN_DEBUG, sh, "...done %d %d\n", mbo, mbi);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322#endif
323
Ondrej Zary55b28f92015-02-06 23:11:44 +0100324 tmp_cmd = aha1542->int_cmds[mbo];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325
Ondrej Zary55b28f92015-02-06 23:11:44 +0100326 if (!tmp_cmd || !tmp_cmd->scsi_done) {
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100327 spin_unlock_irqrestore(sh->host_lock, flags);
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100328 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,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330 ccb[mbo].hastat, ccb[mbo].idlun, mbo);
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100331 return IRQ_HANDLED;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700332 }
Ondrej Zary55b28f92015-02-06 23:11:44 +0100333 my_done = tmp_cmd->scsi_done;
334 kfree(tmp_cmd->host_scribble);
335 tmp_cmd->host_scribble = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336 /* 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)
Ondrej Zary55b28f92015-02-06 23:11:44 +0100340 memcpy(tmp_cmd->sense_buffer, &ccb[mbo].cdb[ccb[mbo].cdblen],
FUJITA Tomonorib80ca4f2008-01-13 15:46:13 +0900341 SCSI_SENSE_BUFFERSIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342
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)
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100355 shost_printk(KERN_DEBUG, sh, "(aha1542 error:%x %x %x) ", errstatus,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356 ccb[mbo].hastat, ccb[mbo].tarstat);
Ondrej Zary6ddc8cf2015-02-06 23:11:53 +0100357 if (ccb[mbo].tarstat == 2)
358 print_hex_dump_bytes("sense: ", DUMP_PREFIX_NONE, &ccb[mbo].cdb[ccb[mbo].cdblen], 12);
Ondrej Zaryfde1fb82015-02-06 23:11:52 +0100359 if (errstatus)
360 printk("aha1542_intr_handle: returning %6x\n", errstatus);
361#endif
Ondrej Zary55b28f92015-02-06 23:11:44 +0100362 tmp_cmd->result = errstatus;
363 aha1542->int_cmds[mbo] = NULL; /* This effectively frees up the mailbox slot, as
Ondrej Zarye98878f2015-02-06 23:11:25 +0100364 far as queuecommand is concerned */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100365 my_done(tmp_cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366 number_serviced++;
367 };
368}
369
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100370static int aha1542_queuecommand(struct Scsi_Host *sh, struct scsi_cmnd *cmd)
Ondrej Zary09a44832015-02-06 23:11:28 +0100371{
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100372 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100373 u8 direction;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100374 u8 target = cmd->device->id;
375 u8 lun = cmd->device->lun;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 unsigned long flags;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100377 int bufflen = scsi_bufflen(cmd);
Ondrej Zary8c08a622015-04-21 23:27:50 +0200378 int mbo, sg_count;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100379 struct mailbox *mb = aha1542->mb;
380 struct ccb *ccb = aha1542->ccb;
Ondrej Zary8c08a622015-04-21 23:27:50 +0200381 struct chain *cptr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382
Ondrej Zary55b28f92015-02-06 23:11:44 +0100383 if (*cmd->cmnd == REQUEST_SENSE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384 /* Don't do the command - we have the sense data already */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100385 cmd->result = 0;
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100386 cmd->scsi_done(cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 return 0;
388 }
389#ifdef DEBUG
Ondrej Zary764a0c72015-02-06 23:11:54 +0100390 {
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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700400#endif
Ondrej Zary8c08a622015-04-21 23:27:50 +0200401 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;
406 }
407
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 /* Use the outgoing mailboxes in a round-robin fashion, because this
409 is how the host adapter will scan for them */
410
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100411 spin_lock_irqsave(sh->host_lock, flags);
Ondrej Zarye98878f2015-02-06 23:11:25 +0100412 mbo = aha1542->aha1542_last_mbo_used + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 if (mbo >= AHA1542_MAILBOXES)
414 mbo = 0;
415
416 do {
Ondrej Zary55b28f92015-02-06 23:11:44 +0100417 if (mb[mbo].status == 0 && aha1542->int_cmds[mbo] == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418 break;
419 mbo++;
420 if (mbo >= AHA1542_MAILBOXES)
421 mbo = 0;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100422 } while (mbo != aha1542->aha1542_last_mbo_used);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423
Ondrej Zary55b28f92015-02-06 23:11:44 +0100424 if (mb[mbo].status || aha1542->int_cmds[mbo])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425 panic("Unable to find empty mailbox for aha1542.\n");
426
Ondrej Zary55b28f92015-02-06 23:11:44 +0100427 aha1542->int_cmds[mbo] = cmd; /* This will effectively prevent someone else from
Ondrej Zarye98878f2015-02-06 23:11:25 +0100428 screwing with this cdb. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429
Ondrej Zarye98878f2015-02-06 23:11:25 +0100430 aha1542->aha1542_last_mbo_used = mbo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700431
432#ifdef DEBUG
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100433 shost_printk(KERN_DEBUG, sh, "Sending command (%d %p)...", mbo, cmd->scsi_done);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700434#endif
435
Ondrej Zary10be6252015-02-06 23:11:24 +0100436 any2scsi(mb[mbo].ccbptr, isa_virt_to_bus(&ccb[mbo])); /* This gets trashed for some reason */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437
438 memset(&ccb[mbo], 0, sizeof(struct ccb));
439
Ondrej Zary55b28f92015-02-06 23:11:44 +0100440 ccb[mbo].cdblen = cmd->cmd_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441
442 direction = 0;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100443 if (*cmd->cmnd == READ_10 || *cmd->cmnd == READ_6)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444 direction = 8;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100445 else if (*cmd->cmnd == WRITE_10 || *cmd->cmnd == WRITE_6)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446 direction = 16;
447
Ondrej Zary55b28f92015-02-06 23:11:44 +0100448 memcpy(ccb[mbo].cdb, cmd->cmnd, ccb[mbo].cdblen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449
Boaz Harroshfc3fdfc2007-09-09 21:02:45 +0300450 if (bufflen) {
Jens Axboe51cf2242007-07-16 10:00:31 +0200451 struct scatterlist *sg;
Ondrej Zary8c08a622015-04-21 23:27:50 +0200452 int i;
Ondrej Zary6ddc8cf2015-02-06 23:11:53 +0100453
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454 ccb[mbo].op = 2; /* SCSI Initiator Command w/scatter-gather */
Ondrej Zary8c08a622015-04-21 23:27:50 +0200455 cmd->host_scribble = (void *)cptr;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100456 scsi_for_each_sg(cmd, sg, sg_count, i) {
Ondrej Zary10be6252015-02-06 23:11:24 +0100457 any2scsi(cptr[i].dataptr, isa_page_to_bus(sg_page(sg))
458 + sg->offset);
Jens Axboe51cf2242007-07-16 10:00:31 +0200459 any2scsi(cptr[i].datalen, sg->length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460 };
Boaz Harroshfc3fdfc2007-09-09 21:02:45 +0300461 any2scsi(ccb[mbo].datalen, sg_count * sizeof(struct chain));
Ondrej Zary10be6252015-02-06 23:11:24 +0100462 any2scsi(ccb[mbo].dataptr, isa_virt_to_bus(cptr));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463#ifdef DEBUG
Ondrej Zary6ddc8cf2015-02-06 23:11:53 +0100464 shost_printk(KERN_DEBUG, sh, "cptr %p: ", cptr);
465 print_hex_dump_bytes("cptr: ", DUMP_PREFIX_NONE, cptr, 18);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466#endif
467 } else {
468 ccb[mbo].op = 0; /* SCSI Initiator Command */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100469 cmd->host_scribble = NULL;
Boaz Harroshfc3fdfc2007-09-09 21:02:45 +0300470 any2scsi(ccb[mbo].datalen, 0);
471 any2scsi(ccb[mbo].dataptr, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472 };
473 ccb[mbo].idlun = (target & 7) << 5 | direction | (lun & 7); /*SCSI Target Id */
474 ccb[mbo].rsalen = 16;
475 ccb[mbo].linkptr[0] = ccb[mbo].linkptr[1] = ccb[mbo].linkptr[2] = 0;
476 ccb[mbo].commlinkid = 0;
477
478#ifdef DEBUG
Ondrej Zary6ddc8cf2015-02-06 23:11:53 +0100479 print_hex_dump_bytes("sending: ", DUMP_PREFIX_NONE, &ccb[mbo], sizeof(ccb[mbo]) - 10);
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100480 printk("aha1542_queuecommand: now waiting for interrupt ");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481#endif
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100482 mb[mbo].status = 1;
483 aha1542_outb(cmd->device->host->io_port, CMD_START_SCSI);
484 spin_unlock_irqrestore(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485
486 return 0;
487}
488
489/* Initialize mailboxes */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100490static void setup_mailboxes(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491{
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100492 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 int i;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100494 struct mailbox *mb = aha1542->mb;
495 struct ccb *ccb = aha1542->ccb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100497 u8 mb_cmd[5] = { CMD_MBINIT, AHA1542_MAILBOXES, 0, 0, 0};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700498
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499 for (i = 0; i < AHA1542_MAILBOXES; i++) {
500 mb[i].status = mb[AHA1542_MAILBOXES + i].status = 0;
Ondrej Zary10be6252015-02-06 23:11:24 +0100501 any2scsi(mb[i].ccbptr, isa_virt_to_bus(&ccb[i]));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100503 aha1542_intr_reset(sh->io_port); /* reset interrupts, so they don't block */
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100504 any2scsi((mb_cmd + 2), isa_virt_to_bus(mb));
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100505 if (aha1542_out(sh->io_port, mb_cmd, 5))
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100506 shost_printk(KERN_ERR, sh, "failed setting up mailboxes\n");
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100507 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508}
509
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100510static int aha1542_getconfig(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511{
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100512 u8 inquiry_result[3];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513 int i;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100514 i = inb(STATUS(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515 if (i & DF) {
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100516 i = inb(DATA(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100518 aha1542_outb(sh->io_port, CMD_RETCONF);
519 aha1542_in(sh->io_port, inquiry_result, 3, 0);
520 if (!wait_mask(INTRFLAGS(sh->io_port), INTRMASK, HACC, 0, 0))
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100521 shost_printk(KERN_ERR, sh, "error querying board settings\n");
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100522 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 switch (inquiry_result[0]) {
524 case 0x80:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100525 sh->dma_channel = 7;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526 break;
527 case 0x40:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100528 sh->dma_channel = 6;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 break;
530 case 0x20:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100531 sh->dma_channel = 5;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 break;
533 case 0x01:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100534 sh->dma_channel = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 break;
536 case 0:
537 /* This means that the adapter, although Adaptec 1542 compatible, doesn't use a DMA channel.
538 Currently only aware of the BusLogic BT-445S VL-Bus adapter which needs this. */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100539 sh->dma_channel = 0xFF;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540 break;
541 default:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100542 shost_printk(KERN_ERR, sh, "Unable to determine DMA channel.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 return -1;
544 };
545 switch (inquiry_result[1]) {
546 case 0x40:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100547 sh->irq = 15;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700548 break;
549 case 0x20:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100550 sh->irq = 14;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 break;
552 case 0x8:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100553 sh->irq = 12;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700554 break;
555 case 0x4:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100556 sh->irq = 11;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557 break;
558 case 0x2:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100559 sh->irq = 10;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560 break;
561 case 0x1:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100562 sh->irq = 9;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563 break;
564 default:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100565 shost_printk(KERN_ERR, sh, "Unable to determine IRQ level.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566 return -1;
567 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100568 sh->this_id = inquiry_result[2] & 7;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569 return 0;
570}
571
572/* This function should only be called for 1542C boards - we can detect
573 the special firmware settings and unlock the board */
574
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100575static int aha1542_mbenable(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576{
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100577 static u8 mbenable_cmd[3];
578 static u8 mbenable_result[2];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579 int retval;
580
581 retval = BIOS_TRANSLATION_6432;
582
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100583 aha1542_outb(sh->io_port, CMD_EXTBIOS);
584 if (aha1542_in(sh->io_port, mbenable_result, 2, 100))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 return retval;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100586 if (!wait_mask(INTRFLAGS(sh->io_port), INTRMASK, HACC, 0, 100))
Ondrej Zary2093bfa2015-02-06 23:11:31 +0100587 goto fail;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100588 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589
590 if ((mbenable_result[0] & 0x08) || mbenable_result[1]) {
591 mbenable_cmd[0] = CMD_MBENABLE;
592 mbenable_cmd[1] = 0;
593 mbenable_cmd[2] = mbenable_result[1];
594
595 if ((mbenable_result[0] & 0x08) && (mbenable_result[1] & 0x03))
596 retval = BIOS_TRANSLATION_25563;
597
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100598 if (aha1542_out(sh->io_port, mbenable_cmd, 3))
Ondrej Zary2093bfa2015-02-06 23:11:31 +0100599 goto fail;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600 };
601 while (0) {
602fail:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100603 shost_printk(KERN_ERR, sh, "Mailbox init failed\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 }
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100605 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606 return retval;
607}
608
609/* Query the board to find out if it is a 1542 or a 1740, or whatever. */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100610static int aha1542_query(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611{
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100612 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100613 u8 inquiry_result[4];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 int i;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100615 i = inb(STATUS(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700616 if (i & DF) {
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100617 i = inb(DATA(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100619 aha1542_outb(sh->io_port, CMD_INQUIRY);
620 aha1542_in(sh->io_port, inquiry_result, 4, 0);
621 if (!wait_mask(INTRFLAGS(sh->io_port), INTRMASK, HACC, 0, 0))
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100622 shost_printk(KERN_ERR, sh, "error querying card type\n");
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100623 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700624
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100625 aha1542->bios_translation = BIOS_TRANSLATION_6432; /* Default case */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626
627 /* For an AHA1740 series board, we ignore the board since there is a
628 hardware bug which can lead to wrong blocks being returned if the board
629 is operating in the 1542 emulation mode. Since there is an extended mode
630 driver, we simply ignore the board and let the 1740 driver pick it up.
631 */
632
633 if (inquiry_result[0] == 0x43) {
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100634 shost_printk(KERN_INFO, sh, "Emulation mode not supported for AHA-1740 hardware, use aha1740 driver instead.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 return 1;
636 };
637
638 /* Always call this - boards that do not support extended bios translation
639 will ignore the command, and we will set the proper default */
640
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100641 aha1542->bios_translation = aha1542_mbenable(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700642
643 return 0;
644}
645
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100646static u8 dma_speed_hw(int dma_speed)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647{
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100648 switch (dma_speed) {
649 case 5:
650 return 0x00;
651 case 6:
652 return 0x04;
653 case 7:
654 return 0x01;
655 case 8:
656 return 0x02;
657 case 10:
658 return 0x03;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100661 return 0xff; /* invalid */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662}
663
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100664/* Set the Bus on/off-times as not to ruin floppy performance */
Ondrej Zary37d607b2015-02-06 23:11:50 +0100665static void aha1542_set_bus_times(struct Scsi_Host *sh, int bus_on, int bus_off, int dma_speed)
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100666{
Ondrej Zary37d607b2015-02-06 23:11:50 +0100667 if (bus_on > 0) {
668 u8 oncmd[] = { CMD_BUSON_TIME, clamp(bus_on, 2, 15) };
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100669
Ondrej Zary37d607b2015-02-06 23:11:50 +0100670 aha1542_intr_reset(sh->io_port);
671 if (aha1542_out(sh->io_port, oncmd, 2))
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100672 goto fail;
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100673 }
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100674
Ondrej Zary37d607b2015-02-06 23:11:50 +0100675 if (bus_off > 0) {
676 u8 offcmd[] = { CMD_BUSOFF_TIME, clamp(bus_off, 1, 64) };
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100677
Ondrej Zary37d607b2015-02-06 23:11:50 +0100678 aha1542_intr_reset(sh->io_port);
679 if (aha1542_out(sh->io_port, offcmd, 2))
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100680 goto fail;
681 }
682
Ondrej Zary37d607b2015-02-06 23:11:50 +0100683 if (dma_speed_hw(dma_speed) != 0xff) {
684 u8 dmacmd[] = { CMD_DMASPEED, dma_speed_hw(dma_speed) };
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100685
Ondrej Zary37d607b2015-02-06 23:11:50 +0100686 aha1542_intr_reset(sh->io_port);
687 if (aha1542_out(sh->io_port, dmacmd, 2))
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100688 goto fail;
689 }
Ondrej Zary37d607b2015-02-06 23:11:50 +0100690 aha1542_intr_reset(sh->io_port);
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100691 return;
692fail:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100693 shost_printk(KERN_ERR, sh, "setting bus on/off-time failed\n");
Ondrej Zary37d607b2015-02-06 23:11:50 +0100694 aha1542_intr_reset(sh->io_port);
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100695}
696
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697/* return non-zero on detection */
Ondrej Zary643a7c42015-02-06 23:11:22 +0100698static struct Scsi_Host *aha1542_hw_init(struct scsi_host_template *tpnt, struct device *pdev, int indx)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699{
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100700 unsigned int base_io = io[indx];
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100701 struct Scsi_Host *sh;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100702 struct aha1542_hostdata *aha1542;
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100703 char dma_info[] = "no DMA";
Linus Torvalds1da177e2005-04-16 15:20:36 -0700704
Ondrej Zary3a70c002015-02-06 23:11:40 +0100705 if (base_io == 0)
706 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707
Ondrej Zary3a70c002015-02-06 23:11:40 +0100708 if (!request_region(base_io, AHA1542_REGION_SIZE, "aha1542"))
709 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100711 sh = scsi_host_alloc(tpnt, sizeof(struct aha1542_hostdata));
712 if (!sh)
Ondrej Zary3a70c002015-02-06 23:11:40 +0100713 goto release;
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100714 aha1542 = shost_priv(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100716 sh->unique_id = base_io;
717 sh->io_port = base_io;
718 sh->n_io_port = AHA1542_REGION_SIZE;
719 aha1542->aha1542_last_mbi_used = 2 * AHA1542_MAILBOXES - 1;
720 aha1542->aha1542_last_mbo_used = AHA1542_MAILBOXES - 1;
721
722 if (!aha1542_test_port(sh))
Ondrej Zary3a70c002015-02-06 23:11:40 +0100723 goto unregister;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700724
Ondrej Zary37d607b2015-02-06 23:11:50 +0100725 aha1542_set_bus_times(sh, bus_on[indx], bus_off[indx], dma_speed[indx]);
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100726 if (aha1542_query(sh))
Ondrej Zary3a70c002015-02-06 23:11:40 +0100727 goto unregister;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100728 if (aha1542_getconfig(sh) == -1)
Ondrej Zary3a70c002015-02-06 23:11:40 +0100729 goto unregister;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100731 if (sh->dma_channel != 0xFF)
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100732 snprintf(dma_info, sizeof(dma_info), "DMA %d", sh->dma_channel);
733 shost_printk(KERN_INFO, sh, "Adaptec AHA-1542 (SCSI-ID %d) at IO 0x%x, IRQ %d, %s\n",
734 sh->this_id, base_io, sh->irq, dma_info);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100735 if (aha1542->bios_translation == BIOS_TRANSLATION_25563)
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100736 shost_printk(KERN_INFO, sh, "Using extended bios translation\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700737
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100738 setup_mailboxes(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100740 if (request_irq(sh->irq, aha1542_interrupt, 0, "aha1542", sh)) {
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100741 shost_printk(KERN_ERR, sh, "Unable to allocate IRQ.\n");
Ondrej Zary3a70c002015-02-06 23:11:40 +0100742 goto unregister;
743 }
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100744 if (sh->dma_channel != 0xFF) {
745 if (request_dma(sh->dma_channel, "aha1542")) {
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100746 shost_printk(KERN_ERR, sh, "Unable to allocate DMA channel.\n");
Ondrej Zary3a70c002015-02-06 23:11:40 +0100747 goto free_irq;
748 }
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100749 if (sh->dma_channel == 0 || sh->dma_channel >= 5) {
750 set_dma_mode(sh->dma_channel, DMA_MODE_CASCADE);
751 enable_dma(sh->dma_channel);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100752 }
753 }
Jeff Garzik87c4d7b2008-04-24 19:45:32 -0400754
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100755 if (scsi_add_host(sh, pdev))
Ondrej Zary3a70c002015-02-06 23:11:40 +0100756 goto free_dma;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700757
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100758 scsi_scan_host(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700759
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100760 return sh;
Ondrej Zary3a70c002015-02-06 23:11:40 +0100761free_dma:
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100762 if (sh->dma_channel != 0xff)
763 free_dma(sh->dma_channel);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100764free_irq:
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100765 free_irq(sh->irq, sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766unregister:
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100767 scsi_host_put(sh);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100768release:
769 release_region(base_io, AHA1542_REGION_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770
Ondrej Zary643a7c42015-02-06 23:11:22 +0100771 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772}
773
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100774static int aha1542_release(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700775{
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100776 scsi_remove_host(sh);
777 if (sh->dma_channel != 0xff)
778 free_dma(sh->dma_channel);
779 if (sh->irq)
780 free_irq(sh->irq, sh);
781 if (sh->io_port && sh->n_io_port)
782 release_region(sh->io_port, sh->n_io_port);
783 scsi_host_put(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784 return 0;
785}
786
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788/*
789 * This is a device reset. This is handled by sending a special command
790 * to the device.
791 */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100792static int aha1542_dev_reset(struct scsi_cmnd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700793{
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100794 struct Scsi_Host *sh = cmd->device->host;
795 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796 unsigned long flags;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100797 struct mailbox *mb = aha1542->mb;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100798 u8 target = cmd->device->id;
799 u8 lun = cmd->device->lun;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700800 int mbo;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100801 struct ccb *ccb = aha1542->ccb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100803 spin_lock_irqsave(sh->host_lock, flags);
Ondrej Zarye98878f2015-02-06 23:11:25 +0100804 mbo = aha1542->aha1542_last_mbo_used + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805 if (mbo >= AHA1542_MAILBOXES)
806 mbo = 0;
807
808 do {
Ondrej Zary55b28f92015-02-06 23:11:44 +0100809 if (mb[mbo].status == 0 && aha1542->int_cmds[mbo] == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810 break;
811 mbo++;
812 if (mbo >= AHA1542_MAILBOXES)
813 mbo = 0;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100814 } while (mbo != aha1542->aha1542_last_mbo_used);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700815
Ondrej Zary55b28f92015-02-06 23:11:44 +0100816 if (mb[mbo].status || aha1542->int_cmds[mbo])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700817 panic("Unable to find empty mailbox for aha1542.\n");
818
Ondrej Zary55b28f92015-02-06 23:11:44 +0100819 aha1542->int_cmds[mbo] = cmd; /* This will effectively
Ondrej Zarye98878f2015-02-06 23:11:25 +0100820 prevent someone else from
821 screwing with this cdb. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822
Ondrej Zarye98878f2015-02-06 23:11:25 +0100823 aha1542->aha1542_last_mbo_used = mbo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824
Ondrej Zary10be6252015-02-06 23:11:24 +0100825 any2scsi(mb[mbo].ccbptr, isa_virt_to_bus(&ccb[mbo])); /* This gets trashed for some reason */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700826
827 memset(&ccb[mbo], 0, sizeof(struct ccb));
828
829 ccb[mbo].op = 0x81; /* BUS DEVICE RESET */
830
831 ccb[mbo].idlun = (target & 7) << 5 | (lun & 7); /*SCSI Target Id */
832
833 ccb[mbo].linkptr[0] = ccb[mbo].linkptr[1] = ccb[mbo].linkptr[2] = 0;
834 ccb[mbo].commlinkid = 0;
835
836 /*
837 * Now tell the 1542 to flush all pending commands for this
838 * target
839 */
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100840 aha1542_outb(sh->io_port, CMD_START_SCSI);
841 spin_unlock_irqrestore(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700842
Ondrej Zary55b28f92015-02-06 23:11:44 +0100843 scmd_printk(KERN_WARNING, cmd,
Jeff Garzik017560f2005-10-24 18:04:36 -0400844 "Trying device reset for target\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845
846 return SUCCESS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847}
848
Ondrej Zary55b28f92015-02-06 23:11:44 +0100849static int aha1542_reset(struct scsi_cmnd *cmd, u8 reset_cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850{
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100851 struct Scsi_Host *sh = cmd->device->host;
852 struct aha1542_hostdata *aha1542 = shost_priv(sh);
853 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700854 int i;
855
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100856 spin_lock_irqsave(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857 /*
858 * This does a scsi reset for all devices on the bus.
859 * In principle, we could also reset the 1542 - should
860 * we do this? Try this first, and we can add that later
861 * if it turns out to be useful.
862 */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100863 outb(reset_cmd, CONTROL(cmd->device->host->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700864
Ondrej Zary55b28f92015-02-06 23:11:44 +0100865 if (!wait_mask(STATUS(cmd->device->host->io_port),
Ondrej Zary7061dec2015-02-06 23:11:56 +0100866 STATMASK, IDLE, STST | DIAGF | INVDCMD | DF | CDF, 0)) {
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100867 spin_unlock_irqrestore(sh->host_lock, flags);
Ondrej Zarya13b3722015-02-06 23:11:34 +0100868 return FAILED;
869 }
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100870
Ondrej Zary8537cba2015-02-06 23:11:37 +0100871 /*
872 * We need to do this too before the 1542 can interact with
873 * us again after host reset.
874 */
875 if (reset_cmd & HRST)
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100876 setup_mailboxes(cmd->device->host);
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100877
Linus Torvalds1da177e2005-04-16 15:20:36 -0700878 /*
879 * Now try to pick up the pieces. For all pending commands,
880 * free any internal data structures, and basically clear things
881 * out. We do not try and restart any commands or anything -
882 * the strategy handler takes care of that crap.
883 */
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100884 shost_printk(KERN_WARNING, cmd->device->host, "Sent BUS RESET to scsi host %d\n", cmd->device->host->host_no);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885
886 for (i = 0; i < AHA1542_MAILBOXES; i++) {
Ondrej Zary55b28f92015-02-06 23:11:44 +0100887 if (aha1542->int_cmds[i] != NULL) {
888 struct scsi_cmnd *tmp_cmd;
889 tmp_cmd = aha1542->int_cmds[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700890
Ondrej Zary55b28f92015-02-06 23:11:44 +0100891 if (tmp_cmd->device->soft_reset) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700892 /*
893 * If this device implements the soft reset option,
894 * then it is still holding onto the command, and
895 * may yet complete it. In this case, we don't
896 * flush the data.
897 */
898 continue;
899 }
Ondrej Zary55b28f92015-02-06 23:11:44 +0100900 kfree(tmp_cmd->host_scribble);
901 tmp_cmd->host_scribble = NULL;
902 aha1542->int_cmds[i] = NULL;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100903 aha1542->mb[i].status = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904 }
905 }
906
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100907 spin_unlock_irqrestore(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908 return SUCCESS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700909}
910
Ondrej Zary55b28f92015-02-06 23:11:44 +0100911static int aha1542_bus_reset(struct scsi_cmnd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912{
Ondrej Zary55b28f92015-02-06 23:11:44 +0100913 return aha1542_reset(cmd, SCRST);
Ondrej Zary8537cba2015-02-06 23:11:37 +0100914}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915
Ondrej Zary55b28f92015-02-06 23:11:44 +0100916static int aha1542_host_reset(struct scsi_cmnd *cmd)
Ondrej Zary8537cba2015-02-06 23:11:37 +0100917{
Ondrej Zary55b28f92015-02-06 23:11:44 +0100918 return aha1542_reset(cmd, HRST | SCRST);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700919}
920
Linus Torvalds1da177e2005-04-16 15:20:36 -0700921static int aha1542_biosparam(struct scsi_device *sdev,
Ondrej Zary17787a02015-02-06 23:11:42 +0100922 struct block_device *bdev, sector_t capacity, int geom[])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923{
Ondrej Zarye98878f2015-02-06 23:11:25 +0100924 struct aha1542_hostdata *aha1542 = shost_priv(sdev->host);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925
Ondrej Zary17787a02015-02-06 23:11:42 +0100926 if (capacity >= 0x200000 &&
927 aha1542->bios_translation == BIOS_TRANSLATION_25563) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700928 /* Please verify that this is the same as what DOS returns */
Ondrej Zary17787a02015-02-06 23:11:42 +0100929 geom[0] = 255; /* heads */
930 geom[1] = 63; /* sectors */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700931 } else {
Ondrej Zary17787a02015-02-06 23:11:42 +0100932 geom[0] = 64; /* heads */
933 geom[1] = 32; /* sectors */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700934 }
Ondrej Zary17787a02015-02-06 23:11:42 +0100935 geom[2] = sector_div(capacity, geom[0] * geom[1]); /* cylinders */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700936
937 return 0;
938}
939MODULE_LICENSE("GPL");
940
Christoph Hellwigd0be4a7d2005-10-31 18:31:40 +0100941static struct scsi_host_template driver_template = {
Ondrej Zary643a7c42015-02-06 23:11:22 +0100942 .module = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700943 .proc_name = "aha1542",
944 .name = "Adaptec 1542",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945 .queuecommand = aha1542_queuecommand,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946 .eh_device_reset_handler= aha1542_dev_reset,
947 .eh_bus_reset_handler = aha1542_bus_reset,
948 .eh_host_reset_handler = aha1542_host_reset,
949 .bios_param = aha1542_biosparam,
950 .can_queue = AHA1542_MAILBOXES,
951 .this_id = 7,
Ondrej Zary10be6252015-02-06 23:11:24 +0100952 .sg_tablesize = 16,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953 .unchecked_isa_dma = 1,
954 .use_clustering = ENABLE_CLUSTERING,
955};
Ondrej Zary643a7c42015-02-06 23:11:22 +0100956
957static int aha1542_isa_match(struct device *pdev, unsigned int ndev)
958{
959 struct Scsi_Host *sh = aha1542_hw_init(&driver_template, pdev, ndev);
960
961 if (!sh)
962 return 0;
963
964 dev_set_drvdata(pdev, sh);
965 return 1;
966}
967
968static int aha1542_isa_remove(struct device *pdev,
969 unsigned int ndev)
970{
971 aha1542_release(dev_get_drvdata(pdev));
972 dev_set_drvdata(pdev, NULL);
973 return 0;
974}
975
976static struct isa_driver aha1542_isa_driver = {
977 .match = aha1542_isa_match,
978 .remove = aha1542_isa_remove,
979 .driver = {
980 .name = "aha1542"
981 },
982};
983static int isa_registered;
984
985#ifdef CONFIG_PNP
986static struct pnp_device_id aha1542_pnp_ids[] = {
987 { .id = "ADP1542" },
988 { .id = "" }
989};
990MODULE_DEVICE_TABLE(pnp, aha1542_pnp_ids);
991
992static int aha1542_pnp_probe(struct pnp_dev *pdev, const struct pnp_device_id *id)
993{
994 int indx;
995 struct Scsi_Host *sh;
996
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100997 for (indx = 0; indx < ARRAY_SIZE(io); indx++) {
998 if (io[indx])
Ondrej Zary643a7c42015-02-06 23:11:22 +0100999 continue;
1000
1001 if (pnp_activate_dev(pdev) < 0)
1002 continue;
1003
Ondrej Zaryf71429a2015-02-06 23:11:41 +01001004 io[indx] = pnp_port_start(pdev, 0);
Ondrej Zary643a7c42015-02-06 23:11:22 +01001005
1006 /* The card can be queried for its DMA, we have
1007 the DMA set up that is enough */
1008
Ondrej Zary2906b3c2015-02-06 23:11:51 +01001009 dev_info(&pdev->dev, "ISAPnP found an AHA1535 at I/O 0x%03X", io[indx]);
Ondrej Zary643a7c42015-02-06 23:11:22 +01001010 }
1011
1012 sh = aha1542_hw_init(&driver_template, &pdev->dev, indx);
1013 if (!sh)
1014 return -ENODEV;
1015
1016 pnp_set_drvdata(pdev, sh);
1017 return 0;
1018}
1019
1020static void aha1542_pnp_remove(struct pnp_dev *pdev)
1021{
1022 aha1542_release(pnp_get_drvdata(pdev));
1023 pnp_set_drvdata(pdev, NULL);
1024}
1025
1026static struct pnp_driver aha1542_pnp_driver = {
1027 .name = "aha1542",
1028 .id_table = aha1542_pnp_ids,
1029 .probe = aha1542_pnp_probe,
1030 .remove = aha1542_pnp_remove,
1031};
1032static int pnp_registered;
1033#endif /* CONFIG_PNP */
1034
1035static int __init aha1542_init(void)
1036{
1037 int ret = 0;
Ondrej Zary643a7c42015-02-06 23:11:22 +01001038
1039#ifdef CONFIG_PNP
1040 if (isapnp) {
1041 ret = pnp_register_driver(&aha1542_pnp_driver);
1042 if (!ret)
1043 pnp_registered = 1;
1044 }
1045#endif
1046 ret = isa_register_driver(&aha1542_isa_driver, MAXBOARDS);
1047 if (!ret)
1048 isa_registered = 1;
1049
1050#ifdef CONFIG_PNP
1051 if (pnp_registered)
1052 ret = 0;
1053#endif
1054 if (isa_registered)
1055 ret = 0;
1056
1057 return ret;
1058}
1059
1060static void __exit aha1542_exit(void)
1061{
1062#ifdef CONFIG_PNP
1063 if (pnp_registered)
1064 pnp_unregister_driver(&aha1542_pnp_driver);
1065#endif
1066 if (isa_registered)
1067 isa_unregister_driver(&aha1542_isa_driver);
1068}
1069
1070module_init(aha1542_init);
1071module_exit(aha1542_exit);