blob: 7db448ec8bebe7a97c7edfbf1249d092c50d6e5b [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;
Arnd Bergmannec54adf2016-01-27 16:57:22 +0100406 } else {
407 sg_count = 0;
408 cptr = NULL;
Ondrej Zary8c08a622015-04-21 23:27:50 +0200409 }
410
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 /* Use the outgoing mailboxes in a round-robin fashion, because this
412 is how the host adapter will scan for them */
413
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100414 spin_lock_irqsave(sh->host_lock, flags);
Ondrej Zarye98878f2015-02-06 23:11:25 +0100415 mbo = aha1542->aha1542_last_mbo_used + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 if (mbo >= AHA1542_MAILBOXES)
417 mbo = 0;
418
419 do {
Ondrej Zary55b28f92015-02-06 23:11:44 +0100420 if (mb[mbo].status == 0 && aha1542->int_cmds[mbo] == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421 break;
422 mbo++;
423 if (mbo >= AHA1542_MAILBOXES)
424 mbo = 0;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100425 } while (mbo != aha1542->aha1542_last_mbo_used);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426
Ondrej Zary55b28f92015-02-06 23:11:44 +0100427 if (mb[mbo].status || aha1542->int_cmds[mbo])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700428 panic("Unable to find empty mailbox for aha1542.\n");
429
Ondrej Zary55b28f92015-02-06 23:11:44 +0100430 aha1542->int_cmds[mbo] = cmd; /* This will effectively prevent someone else from
Ondrej Zarye98878f2015-02-06 23:11:25 +0100431 screwing with this cdb. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432
Ondrej Zarye98878f2015-02-06 23:11:25 +0100433 aha1542->aha1542_last_mbo_used = mbo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700434
435#ifdef DEBUG
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100436 shost_printk(KERN_DEBUG, sh, "Sending command (%d %p)...", mbo, cmd->scsi_done);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437#endif
438
Ondrej Zary10be6252015-02-06 23:11:24 +0100439 any2scsi(mb[mbo].ccbptr, isa_virt_to_bus(&ccb[mbo])); /* This gets trashed for some reason */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440
441 memset(&ccb[mbo], 0, sizeof(struct ccb));
442
Ondrej Zary55b28f92015-02-06 23:11:44 +0100443 ccb[mbo].cdblen = cmd->cmd_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444
445 direction = 0;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100446 if (*cmd->cmnd == READ_10 || *cmd->cmnd == READ_6)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447 direction = 8;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100448 else if (*cmd->cmnd == WRITE_10 || *cmd->cmnd == WRITE_6)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 direction = 16;
450
Ondrej Zary55b28f92015-02-06 23:11:44 +0100451 memcpy(ccb[mbo].cdb, cmd->cmnd, ccb[mbo].cdblen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452
Boaz Harroshfc3fdfc2007-09-09 21:02:45 +0300453 if (bufflen) {
Jens Axboe51cf2242007-07-16 10:00:31 +0200454 struct scatterlist *sg;
Ondrej Zary8c08a622015-04-21 23:27:50 +0200455 int i;
Ondrej Zary6ddc8cf2015-02-06 23:11:53 +0100456
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457 ccb[mbo].op = 2; /* SCSI Initiator Command w/scatter-gather */
Ondrej Zary8c08a622015-04-21 23:27:50 +0200458 cmd->host_scribble = (void *)cptr;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100459 scsi_for_each_sg(cmd, sg, sg_count, i) {
Ondrej Zary10be6252015-02-06 23:11:24 +0100460 any2scsi(cptr[i].dataptr, isa_page_to_bus(sg_page(sg))
461 + sg->offset);
Jens Axboe51cf2242007-07-16 10:00:31 +0200462 any2scsi(cptr[i].datalen, sg->length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463 };
Boaz Harroshfc3fdfc2007-09-09 21:02:45 +0300464 any2scsi(ccb[mbo].datalen, sg_count * sizeof(struct chain));
Ondrej Zary10be6252015-02-06 23:11:24 +0100465 any2scsi(ccb[mbo].dataptr, isa_virt_to_bus(cptr));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466#ifdef DEBUG
Ondrej Zary6ddc8cf2015-02-06 23:11:53 +0100467 shost_printk(KERN_DEBUG, sh, "cptr %p: ", cptr);
468 print_hex_dump_bytes("cptr: ", DUMP_PREFIX_NONE, cptr, 18);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700469#endif
470 } else {
471 ccb[mbo].op = 0; /* SCSI Initiator Command */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100472 cmd->host_scribble = NULL;
Boaz Harroshfc3fdfc2007-09-09 21:02:45 +0300473 any2scsi(ccb[mbo].datalen, 0);
474 any2scsi(ccb[mbo].dataptr, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475 };
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
Ondrej Zary6ddc8cf2015-02-06 23:11:53 +0100482 print_hex_dump_bytes("sending: ", DUMP_PREFIX_NONE, &ccb[mbo], sizeof(ccb[mbo]) - 10);
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100483 printk("aha1542_queuecommand: now waiting for interrupt ");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484#endif
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100485 mb[mbo].status = 1;
486 aha1542_outb(cmd->device->host->io_port, CMD_START_SCSI);
487 spin_unlock_irqrestore(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488
489 return 0;
490}
491
492/* Initialize mailboxes */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100493static void setup_mailboxes(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700494{
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100495 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 int i;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100497 struct mailbox *mb = aha1542->mb;
498 struct ccb *ccb = aha1542->ccb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100500 u8 mb_cmd[5] = { CMD_MBINIT, AHA1542_MAILBOXES, 0, 0, 0};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502 for (i = 0; i < AHA1542_MAILBOXES; i++) {
503 mb[i].status = mb[AHA1542_MAILBOXES + i].status = 0;
Ondrej Zary10be6252015-02-06 23:11:24 +0100504 any2scsi(mb[i].ccbptr, isa_virt_to_bus(&ccb[i]));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100506 aha1542_intr_reset(sh->io_port); /* reset interrupts, so they don't block */
Ondrej Zarycad2fc72015-02-06 23:11:43 +0100507 any2scsi((mb_cmd + 2), isa_virt_to_bus(mb));
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100508 if (aha1542_out(sh->io_port, mb_cmd, 5))
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100509 shost_printk(KERN_ERR, sh, "failed setting up mailboxes\n");
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100510 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511}
512
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100513static int aha1542_getconfig(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514{
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100515 u8 inquiry_result[3];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516 int i;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100517 i = inb(STATUS(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 if (i & DF) {
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100519 i = inb(DATA(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100521 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))
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100524 shost_printk(KERN_ERR, sh, "error querying board settings\n");
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100525 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526 switch (inquiry_result[0]) {
527 case 0x80:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100528 sh->dma_channel = 7;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 break;
530 case 0x40:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100531 sh->dma_channel = 6;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 break;
533 case 0x20:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100534 sh->dma_channel = 5;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 break;
536 case 0x01:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100537 sh->dma_channel = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 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. */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100542 sh->dma_channel = 0xFF;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 break;
544 default:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100545 shost_printk(KERN_ERR, sh, "Unable to determine DMA channel.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546 return -1;
547 };
548 switch (inquiry_result[1]) {
549 case 0x40:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100550 sh->irq = 15;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 break;
552 case 0x20:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100553 sh->irq = 14;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700554 break;
555 case 0x8:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100556 sh->irq = 12;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557 break;
558 case 0x4:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100559 sh->irq = 11;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560 break;
561 case 0x2:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100562 sh->irq = 10;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563 break;
564 case 0x1:
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100565 sh->irq = 9;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566 break;
567 default:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100568 shost_printk(KERN_ERR, sh, "Unable to determine IRQ level.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569 return -1;
570 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100571 sh->this_id = inquiry_result[2] & 7;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 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
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100578static int aha1542_mbenable(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579{
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100580 static u8 mbenable_cmd[3];
581 static u8 mbenable_result[2];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700582 int retval;
583
584 retval = BIOS_TRANSLATION_6432;
585
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100586 aha1542_outb(sh->io_port, CMD_EXTBIOS);
587 if (aha1542_in(sh->io_port, mbenable_result, 2, 100))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588 return retval;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100589 if (!wait_mask(INTRFLAGS(sh->io_port), INTRMASK, HACC, 0, 100))
Ondrej Zary2093bfa2015-02-06 23:11:31 +0100590 goto fail;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100591 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592
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
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100601 if (aha1542_out(sh->io_port, mbenable_cmd, 3))
Ondrej Zary2093bfa2015-02-06 23:11:31 +0100602 goto fail;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603 };
604 while (0) {
605fail:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100606 shost_printk(KERN_ERR, sh, "Mailbox init failed\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607 }
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100608 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609 return retval;
610}
611
612/* Query the board to find out if it is a 1542 or a 1740, or whatever. */
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100613static int aha1542_query(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614{
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100615 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Ondrej Zarycb5b5702015-02-06 23:11:27 +0100616 u8 inquiry_result[4];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617 int i;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100618 i = inb(STATUS(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700619 if (i & DF) {
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100620 i = inb(DATA(sh->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621 };
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100622 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))
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100625 shost_printk(KERN_ERR, sh, "error querying card type\n");
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100626 aha1542_intr_reset(sh->io_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100628 aha1542->bios_translation = BIOS_TRANSLATION_6432; /* Default case */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629
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) {
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100637 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 -0700638 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
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100644 aha1542->bios_translation = aha1542_mbenable(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700645
646 return 0;
647}
648
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100649static u8 dma_speed_hw(int dma_speed)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650{
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100651 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700663
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100664 return 0xff; /* invalid */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665}
666
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100667/* Set the Bus on/off-times as not to ruin floppy performance */
Ondrej Zary37d607b2015-02-06 23:11:50 +0100668static 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 +0100669{
Ondrej Zary37d607b2015-02-06 23:11:50 +0100670 if (bus_on > 0) {
671 u8 oncmd[] = { CMD_BUSON_TIME, clamp(bus_on, 2, 15) };
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100672
Ondrej Zary37d607b2015-02-06 23:11:50 +0100673 aha1542_intr_reset(sh->io_port);
674 if (aha1542_out(sh->io_port, oncmd, 2))
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100675 goto fail;
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100676 }
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100677
Ondrej Zary37d607b2015-02-06 23:11:50 +0100678 if (bus_off > 0) {
679 u8 offcmd[] = { CMD_BUSOFF_TIME, clamp(bus_off, 1, 64) };
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100680
Ondrej Zary37d607b2015-02-06 23:11:50 +0100681 aha1542_intr_reset(sh->io_port);
682 if (aha1542_out(sh->io_port, offcmd, 2))
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100683 goto fail;
684 }
685
Ondrej Zary37d607b2015-02-06 23:11:50 +0100686 if (dma_speed_hw(dma_speed) != 0xff) {
687 u8 dmacmd[] = { CMD_DMASPEED, dma_speed_hw(dma_speed) };
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100688
Ondrej Zary37d607b2015-02-06 23:11:50 +0100689 aha1542_intr_reset(sh->io_port);
690 if (aha1542_out(sh->io_port, dmacmd, 2))
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100691 goto fail;
692 }
Ondrej Zary37d607b2015-02-06 23:11:50 +0100693 aha1542_intr_reset(sh->io_port);
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100694 return;
695fail:
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100696 shost_printk(KERN_ERR, sh, "setting bus on/off-time failed\n");
Ondrej Zary37d607b2015-02-06 23:11:50 +0100697 aha1542_intr_reset(sh->io_port);
Ondrej Zaryb847fd02015-02-06 23:11:38 +0100698}
699
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700/* return non-zero on detection */
Ondrej Zary643a7c42015-02-06 23:11:22 +0100701static struct Scsi_Host *aha1542_hw_init(struct scsi_host_template *tpnt, struct device *pdev, int indx)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702{
Ondrej Zaryf71429a2015-02-06 23:11:41 +0100703 unsigned int base_io = io[indx];
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100704 struct Scsi_Host *sh;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100705 struct aha1542_hostdata *aha1542;
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100706 char dma_info[] = "no DMA";
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707
Ondrej Zary3a70c002015-02-06 23:11:40 +0100708 if (base_io == 0)
709 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710
Ondrej Zary3a70c002015-02-06 23:11:40 +0100711 if (!request_region(base_io, AHA1542_REGION_SIZE, "aha1542"))
712 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100714 sh = scsi_host_alloc(tpnt, sizeof(struct aha1542_hostdata));
715 if (!sh)
Ondrej Zary3a70c002015-02-06 23:11:40 +0100716 goto release;
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100717 aha1542 = shost_priv(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700718
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100719 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))
Ondrej Zary3a70c002015-02-06 23:11:40 +0100726 goto unregister;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700727
Ondrej Zary37d607b2015-02-06 23:11:50 +0100728 aha1542_set_bus_times(sh, bus_on[indx], bus_off[indx], dma_speed[indx]);
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100729 if (aha1542_query(sh))
Ondrej Zary3a70c002015-02-06 23:11:40 +0100730 goto unregister;
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100731 if (aha1542_getconfig(sh) == -1)
Ondrej Zary3a70c002015-02-06 23:11:40 +0100732 goto unregister;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700733
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100734 if (sh->dma_channel != 0xFF)
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100735 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);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100738 if (aha1542->bios_translation == BIOS_TRANSLATION_25563)
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100739 shost_printk(KERN_INFO, sh, "Using extended bios translation\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700740
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100741 setup_mailboxes(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100743 if (request_irq(sh->irq, aha1542_interrupt, 0, "aha1542", sh)) {
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100744 shost_printk(KERN_ERR, sh, "Unable to allocate IRQ.\n");
Ondrej Zary3a70c002015-02-06 23:11:40 +0100745 goto unregister;
746 }
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100747 if (sh->dma_channel != 0xFF) {
748 if (request_dma(sh->dma_channel, "aha1542")) {
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100749 shost_printk(KERN_ERR, sh, "Unable to allocate DMA channel.\n");
Ondrej Zary3a70c002015-02-06 23:11:40 +0100750 goto free_irq;
751 }
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100752 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);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100755 }
756 }
Jeff Garzik87c4d7b2008-04-24 19:45:32 -0400757
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100758 if (scsi_add_host(sh, pdev))
Ondrej Zary3a70c002015-02-06 23:11:40 +0100759 goto free_dma;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700760
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100761 scsi_scan_host(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100763 return sh;
Ondrej Zary3a70c002015-02-06 23:11:40 +0100764free_dma:
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100765 if (sh->dma_channel != 0xff)
766 free_dma(sh->dma_channel);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100767free_irq:
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100768 free_irq(sh->irq, sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700769unregister:
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100770 scsi_host_put(sh);
Ondrej Zary3a70c002015-02-06 23:11:40 +0100771release:
772 release_region(base_io, AHA1542_REGION_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700773
Ondrej Zary643a7c42015-02-06 23:11:22 +0100774 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700775}
776
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100777static int aha1542_release(struct Scsi_Host *sh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700778{
Ondrej Zaryc2532f62015-02-06 23:11:45 +0100779 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 return 0;
788}
789
Linus Torvalds1da177e2005-04-16 15:20:36 -0700790
Linus Torvalds1da177e2005-04-16 15:20:36 -0700791/*
792 * This is a device reset. This is handled by sending a special command
793 * to the device.
794 */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100795static int aha1542_dev_reset(struct scsi_cmnd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796{
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100797 struct Scsi_Host *sh = cmd->device->host;
798 struct aha1542_hostdata *aha1542 = shost_priv(sh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799 unsigned long flags;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100800 struct mailbox *mb = aha1542->mb;
Ondrej Zary55b28f92015-02-06 23:11:44 +0100801 u8 target = cmd->device->id;
802 u8 lun = cmd->device->lun;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700803 int mbo;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100804 struct ccb *ccb = aha1542->ccb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100806 spin_lock_irqsave(sh->host_lock, flags);
Ondrej Zarye98878f2015-02-06 23:11:25 +0100807 mbo = aha1542->aha1542_last_mbo_used + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808 if (mbo >= AHA1542_MAILBOXES)
809 mbo = 0;
810
811 do {
Ondrej Zary55b28f92015-02-06 23:11:44 +0100812 if (mb[mbo].status == 0 && aha1542->int_cmds[mbo] == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813 break;
814 mbo++;
815 if (mbo >= AHA1542_MAILBOXES)
816 mbo = 0;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100817 } while (mbo != aha1542->aha1542_last_mbo_used);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700818
Ondrej Zary55b28f92015-02-06 23:11:44 +0100819 if (mb[mbo].status || aha1542->int_cmds[mbo])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700820 panic("Unable to find empty mailbox for aha1542.\n");
821
Ondrej Zary55b28f92015-02-06 23:11:44 +0100822 aha1542->int_cmds[mbo] = cmd; /* This will effectively
Ondrej Zarye98878f2015-02-06 23:11:25 +0100823 prevent someone else from
824 screwing with this cdb. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825
Ondrej Zarye98878f2015-02-06 23:11:25 +0100826 aha1542->aha1542_last_mbo_used = mbo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827
Ondrej Zary10be6252015-02-06 23:11:24 +0100828 any2scsi(mb[mbo].ccbptr, isa_virt_to_bus(&ccb[mbo])); /* This gets trashed for some reason */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829
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 */
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100843 aha1542_outb(sh->io_port, CMD_START_SCSI);
844 spin_unlock_irqrestore(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845
Ondrej Zary55b28f92015-02-06 23:11:44 +0100846 scmd_printk(KERN_WARNING, cmd,
Jeff Garzik017560f2005-10-24 18:04:36 -0400847 "Trying device reset for target\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700848
849 return SUCCESS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850}
851
Ondrej Zary55b28f92015-02-06 23:11:44 +0100852static int aha1542_reset(struct scsi_cmnd *cmd, u8 reset_cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700853{
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100854 struct Scsi_Host *sh = cmd->device->host;
855 struct aha1542_hostdata *aha1542 = shost_priv(sh);
856 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857 int i;
858
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100859 spin_lock_irqsave(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860 /*
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 */
Ondrej Zary55b28f92015-02-06 23:11:44 +0100866 outb(reset_cmd, CONTROL(cmd->device->host->io_port));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700867
Ondrej Zary55b28f92015-02-06 23:11:44 +0100868 if (!wait_mask(STATUS(cmd->device->host->io_port),
Ondrej Zary7061dec2015-02-06 23:11:56 +0100869 STATMASK, IDLE, STST | DIAGF | INVDCMD | DF | CDF, 0)) {
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100870 spin_unlock_irqrestore(sh->host_lock, flags);
Ondrej Zarya13b3722015-02-06 23:11:34 +0100871 return FAILED;
872 }
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100873
Ondrej Zary8537cba2015-02-06 23:11:37 +0100874 /*
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)
Ondrej Zary68ea9de2015-02-06 23:11:49 +0100879 setup_mailboxes(cmd->device->host);
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100880
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881 /*
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 */
Ondrej Zary2906b3c2015-02-06 23:11:51 +0100887 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 -0700888
889 for (i = 0; i < AHA1542_MAILBOXES; i++) {
Ondrej Zary55b28f92015-02-06 23:11:44 +0100890 if (aha1542->int_cmds[i] != NULL) {
891 struct scsi_cmnd *tmp_cmd;
892 tmp_cmd = aha1542->int_cmds[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893
Ondrej Zary55b28f92015-02-06 23:11:44 +0100894 if (tmp_cmd->device->soft_reset) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700895 /*
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 }
Ondrej Zary55b28f92015-02-06 23:11:44 +0100903 kfree(tmp_cmd->host_scribble);
904 tmp_cmd->host_scribble = NULL;
905 aha1542->int_cmds[i] = NULL;
Ondrej Zarye98878f2015-02-06 23:11:25 +0100906 aha1542->mb[i].status = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907 }
908 }
909
Ondrej Zary1b0224b2015-02-06 23:11:55 +0100910 spin_unlock_irqrestore(sh->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911 return SUCCESS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912}
913
Ondrej Zary55b28f92015-02-06 23:11:44 +0100914static int aha1542_bus_reset(struct scsi_cmnd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915{
Ondrej Zary55b28f92015-02-06 23:11:44 +0100916 return aha1542_reset(cmd, SCRST);
Ondrej Zary8537cba2015-02-06 23:11:37 +0100917}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918
Ondrej Zary55b28f92015-02-06 23:11:44 +0100919static int aha1542_host_reset(struct scsi_cmnd *cmd)
Ondrej Zary8537cba2015-02-06 23:11:37 +0100920{
Ondrej Zary55b28f92015-02-06 23:11:44 +0100921 return aha1542_reset(cmd, HRST | SCRST);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700922}
923
Linus Torvalds1da177e2005-04-16 15:20:36 -0700924static int aha1542_biosparam(struct scsi_device *sdev,
Ondrej Zary17787a02015-02-06 23:11:42 +0100925 struct block_device *bdev, sector_t capacity, int geom[])
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926{
Ondrej Zarye98878f2015-02-06 23:11:25 +0100927 struct aha1542_hostdata *aha1542 = shost_priv(sdev->host);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700928
Ondrej Zary17787a02015-02-06 23:11:42 +0100929 if (capacity >= 0x200000 &&
930 aha1542->bios_translation == BIOS_TRANSLATION_25563) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700931 /* Please verify that this is the same as what DOS returns */
Ondrej Zary17787a02015-02-06 23:11:42 +0100932 geom[0] = 255; /* heads */
933 geom[1] = 63; /* sectors */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700934 } else {
Ondrej Zary17787a02015-02-06 23:11:42 +0100935 geom[0] = 64; /* heads */
936 geom[1] = 32; /* sectors */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 }
Ondrej Zary17787a02015-02-06 23:11:42 +0100938 geom[2] = sector_div(capacity, geom[0] * geom[1]); /* cylinders */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700939
940 return 0;
941}
942MODULE_LICENSE("GPL");
943
Christoph Hellwigd0be4a7d2005-10-31 18:31:40 +0100944static struct scsi_host_template driver_template = {
Ondrej Zary643a7c42015-02-06 23:11:22 +0100945 .module = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946 .proc_name = "aha1542",
947 .name = "Adaptec 1542",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700948 .queuecommand = aha1542_queuecommand,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700949 .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,
Ondrej Zary10be6252015-02-06 23:11:24 +0100955 .sg_tablesize = 16,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956 .unchecked_isa_dma = 1,
957 .use_clustering = ENABLE_CLUSTERING,
958};
Ondrej Zary643a7c42015-02-06 23:11:22 +0100959
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
Ondrej Zaryf71429a2015-02-06 23:11:41 +01001000 for (indx = 0; indx < ARRAY_SIZE(io); indx++) {
1001 if (io[indx])
Ondrej Zary643a7c42015-02-06 23:11:22 +01001002 continue;
1003
1004 if (pnp_activate_dev(pdev) < 0)
1005 continue;
1006
Ondrej Zaryf71429a2015-02-06 23:11:41 +01001007 io[indx] = pnp_port_start(pdev, 0);
Ondrej Zary643a7c42015-02-06 23:11:22 +01001008
1009 /* The card can be queried for its DMA, we have
1010 the DMA set up that is enough */
1011
Ondrej Zary2906b3c2015-02-06 23:11:51 +01001012 dev_info(&pdev->dev, "ISAPnP found an AHA1535 at I/O 0x%03X", io[indx]);
Ondrej Zary643a7c42015-02-06 23:11:22 +01001013 }
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;
Ondrej Zary643a7c42015-02-06 23:11:22 +01001041
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);