blob: f75928f7773ec78231da663e1e89e39b412ecd51 [file] [log] [blame]
Thomas Gleixner09c434b2019-05-19 13:08:20 +01001// SPDX-License-Identifier: GPL-2.0-only
Linus Torvalds1da177e2005-04-16 15:20:36 -07002/*
3 * SCSI low-level driver for the 53c94 SCSI bus adaptor found
4 * on Power Macintosh computers, controlling the external SCSI chain.
5 * We assume the 53c94 is connected to a DBDMA (descriptor-based DMA)
6 * controller.
7 *
8 * Paul Mackerras, August 1996.
9 * Copyright (C) 1996 Paul Mackerras.
10 */
11#include <linux/kernel.h>
12#include <linux/delay.h>
13#include <linux/types.h>
14#include <linux/string.h>
15#include <linux/slab.h>
16#include <linux/blkdev.h>
17#include <linux/proc_fs.h>
18#include <linux/stat.h>
19#include <linux/spinlock.h>
20#include <linux/interrupt.h>
Paul Gortmakeracf3368f2011-05-27 09:47:43 -040021#include <linux/module.h>
Bjorn Helgaas952bbcb2016-02-05 14:58:12 -060022#include <linux/pci.h>
Mike Rapoport65fddcf2020-06-08 21:32:42 -070023#include <linux/pgtable.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <asm/dbdma.h>
25#include <asm/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070026#include <asm/prom.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <asm/macio.h>
28
29#include <scsi/scsi.h>
30#include <scsi/scsi_cmnd.h>
31#include <scsi/scsi_device.h>
32#include <scsi/scsi_host.h>
33
34#include "mac53c94.h"
35
36enum fsc_phase {
37 idle,
38 selecting,
39 dataing,
40 completing,
41 busfreeing,
42};
43
44struct fsc_state {
45 struct mac53c94_regs __iomem *regs;
46 int intr;
47 struct dbdma_regs __iomem *dma;
48 int dmaintr;
49 int clk_freq;
50 struct Scsi_Host *host;
51 struct scsi_cmnd *request_q;
52 struct scsi_cmnd *request_qtail;
53 struct scsi_cmnd *current_req; /* req we're currently working on */
54 enum fsc_phase phase; /* what we're currently trying to do */
55 struct dbdma_cmd *dma_cmds; /* space for dbdma commands, aligned */
56 void *dma_cmd_space;
57 struct pci_dev *pdev;
58 dma_addr_t dma_addr;
59 struct macio_dev *mdev;
60};
61
62static void mac53c94_init(struct fsc_state *);
63static void mac53c94_start(struct fsc_state *);
David Howells7d12e782006-10-05 14:55:46 +010064static void mac53c94_interrupt(int, void *);
65static irqreturn_t do_mac53c94_interrupt(int, void *);
Linus Torvalds1da177e2005-04-16 15:20:36 -070066static void cmd_done(struct fsc_state *, int result);
67static void set_dma_cmds(struct fsc_state *, struct scsi_cmnd *);
68
Bart Van Asscheaf049df2021-10-07 13:46:14 -070069static int mac53c94_queue_lck(struct scsi_cmnd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -070070{
71 struct fsc_state *state;
72
73#if 0
74 if (cmd->sc_data_direction == DMA_TO_DEVICE) {
75 int i;
76 printk(KERN_DEBUG "mac53c94_queue %p: command is", cmd);
77 for (i = 0; i < cmd->cmd_len; ++i)
Joe Perchesad361c92009-07-06 13:05:40 -070078 printk(KERN_CONT " %.2x", cmd->cmnd[i]);
79 printk(KERN_CONT "\n");
80 printk(KERN_DEBUG "use_sg=%d request_bufflen=%d request_buffer=%p\n",
FUJITA Tomonori646158c2007-05-26 12:46:30 +090081 scsi_sg_count(cmd), scsi_bufflen(cmd), scsi_sglist(cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -070082 }
83#endif
84
Linus Torvalds1da177e2005-04-16 15:20:36 -070085 cmd->host_scribble = NULL;
86
87 state = (struct fsc_state *) cmd->device->host->hostdata;
88
89 if (state->request_q == NULL)
90 state->request_q = cmd;
91 else
92 state->request_qtail->host_scribble = (void *) cmd;
93 state->request_qtail = cmd;
94
95 if (state->phase == idle)
96 mac53c94_start(state);
97
98 return 0;
99}
100
Jeff Garzikf2812332010-11-16 02:10:29 -0500101static DEF_SCSI_QCMD(mac53c94_queue)
102
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103static int mac53c94_host_reset(struct scsi_cmnd *cmd)
104{
105 struct fsc_state *state = (struct fsc_state *) cmd->device->host->hostdata;
106 struct mac53c94_regs __iomem *regs = state->regs;
107 struct dbdma_regs __iomem *dma = state->dma;
Jeff Garzik df0ae242005-05-28 07:57:14 -0400108 unsigned long flags;
109
110 spin_lock_irqsave(cmd->device->host->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111
112 writel((RUN|PAUSE|FLUSH|WAKE) << 16, &dma->control);
113 writeb(CMD_SCSI_RESET, &regs->command); /* assert RST */
114 udelay(100); /* leave it on for a while (>= 25us) */
115 writeb(CMD_RESET, &regs->command);
116 udelay(20);
117 mac53c94_init(state);
118 writeb(CMD_NOP, &regs->command);
Jeff Garzik df0ae242005-05-28 07:57:14 -0400119
120 spin_unlock_irqrestore(cmd->device->host->host_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121 return SUCCESS;
122}
123
124static void mac53c94_init(struct fsc_state *state)
125{
126 struct mac53c94_regs __iomem *regs = state->regs;
127 struct dbdma_regs __iomem *dma = state->dma;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128
129 writeb(state->host->this_id | CF1_PAR_ENABLE, &regs->config1);
130 writeb(TIMO_VAL(250), &regs->sel_timeout); /* 250ms */
131 writeb(CLKF_VAL(state->clk_freq), &regs->clk_factor);
132 writeb(CF2_FEATURE_EN, &regs->config2);
133 writeb(0, &regs->config3);
134 writeb(0, &regs->sync_period);
135 writeb(0, &regs->sync_offset);
Bart Van Assche8c0156b2022-02-18 11:50:58 -0800136 (void)readb(&regs->interrupt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 writel((RUN|PAUSE|FLUSH|WAKE) << 16, &dma->control);
138}
139
140/*
141 * Start the next command for a 53C94.
142 * Should be called with interrupts disabled.
143 */
144static void mac53c94_start(struct fsc_state *state)
145{
146 struct scsi_cmnd *cmd;
147 struct mac53c94_regs __iomem *regs = state->regs;
148 int i;
149
150 if (state->phase != idle || state->current_req != NULL)
151 panic("inappropriate mac53c94_start (state=%p)", state);
152 if (state->request_q == NULL)
153 return;
154 state->current_req = cmd = state->request_q;
155 state->request_q = (struct scsi_cmnd *) cmd->host_scribble;
156
157 /* Off we go */
158 writeb(0, &regs->count_lo);
159 writeb(0, &regs->count_mid);
160 writeb(0, &regs->count_hi);
161 writeb(CMD_NOP + CMD_DMA_MODE, &regs->command);
162 udelay(1);
163 writeb(CMD_FLUSH, &regs->command);
164 udelay(1);
165 writeb(cmd->device->id, &regs->dest_id);
166 writeb(0, &regs->sync_period);
167 writeb(0, &regs->sync_offset);
168
169 /* load the command into the FIFO */
170 for (i = 0; i < cmd->cmd_len; ++i)
171 writeb(cmd->cmnd[i], &regs->fifo);
172
173 /* do select without ATN XXX */
174 writeb(CMD_SELECT, &regs->command);
175 state->phase = selecting;
176
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900177 set_dma_cmds(state, cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178}
179
David Howells7d12e782006-10-05 14:55:46 +0100180static irqreturn_t do_mac53c94_interrupt(int irq, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181{
182 unsigned long flags;
183 struct Scsi_Host *dev = ((struct fsc_state *) dev_id)->current_req->device->host;
184
185 spin_lock_irqsave(dev->host_lock, flags);
David Howells7d12e782006-10-05 14:55:46 +0100186 mac53c94_interrupt(irq, dev_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187 spin_unlock_irqrestore(dev->host_lock, flags);
188 return IRQ_HANDLED;
189}
190
David Howells7d12e782006-10-05 14:55:46 +0100191static void mac53c94_interrupt(int irq, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192{
193 struct fsc_state *state = (struct fsc_state *) dev_id;
194 struct mac53c94_regs __iomem *regs = state->regs;
195 struct dbdma_regs __iomem *dma = state->dma;
Bart Van Asschecb2b6202022-02-18 11:50:59 -0800196 struct scsi_cmnd *const cmd = state->current_req;
Finn Thain55a94552022-02-22 10:09:42 +1100197 struct mac53c94_cmd_priv *const mcmd = mac53c94_priv(cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 int nb, stat, seq, intr;
199 static int mac53c94_errors;
200
201 /*
202 * Apparently, reading the interrupt register unlatches
203 * the status and sequence step registers.
204 */
205 seq = readb(&regs->seqstep);
206 stat = readb(&regs->status);
207 intr = readb(&regs->interrupt);
208
209#if 0
210 printk(KERN_DEBUG "mac53c94_intr, intr=%x stat=%x seq=%x phase=%d\n",
211 intr, stat, seq, state->phase);
212#endif
213
214 if (intr & INTR_RESET) {
215 /* SCSI bus was reset */
216 printk(KERN_INFO "external SCSI bus reset detected\n");
217 writeb(CMD_NOP, &regs->command);
218 writel(RUN << 16, &dma->control); /* stop dma */
219 cmd_done(state, DID_RESET << 16);
220 return;
221 }
222 if (intr & INTR_ILL_CMD) {
223 printk(KERN_ERR "53c94: invalid cmd, intr=%x stat=%x seq=%x phase=%d\n",
224 intr, stat, seq, state->phase);
225 cmd_done(state, DID_ERROR << 16);
226 return;
227 }
228 if (stat & STAT_ERROR) {
229#if 0
230 /* XXX these seem to be harmless? */
231 printk("53c94: bad error, intr=%x stat=%x seq=%x phase=%d\n",
232 intr, stat, seq, state->phase);
233#endif
234 ++mac53c94_errors;
235 writeb(CMD_NOP + CMD_DMA_MODE, &regs->command);
236 }
Haowen Bai93de8df2022-03-14 15:58:31 +0800237 if (!cmd) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238 printk(KERN_DEBUG "53c94: interrupt with no command active?\n");
239 return;
240 }
241 if (stat & STAT_PARITY) {
242 printk(KERN_ERR "mac53c94: parity error\n");
243 cmd_done(state, DID_PARITY << 16);
244 return;
245 }
246 switch (state->phase) {
247 case selecting:
248 if (intr & INTR_DISCONNECT) {
249 /* selection timed out */
250 cmd_done(state, DID_BAD_TARGET << 16);
251 return;
252 }
253 if (intr != INTR_BUS_SERV + INTR_DONE) {
254 printk(KERN_DEBUG "got intr %x during selection\n", intr);
255 cmd_done(state, DID_ERROR << 16);
256 return;
257 }
258 if ((seq & SS_MASK) != SS_DONE) {
259 printk(KERN_DEBUG "seq step %x after command\n", seq);
260 cmd_done(state, DID_ERROR << 16);
261 return;
262 }
263 writeb(CMD_NOP, &regs->command);
264 /* set DMA controller going if any data to transfer */
265 if ((stat & (STAT_MSG|STAT_CD)) == 0
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900266 && (scsi_sg_count(cmd) > 0 || scsi_bufflen(cmd))) {
Finn Thain55a94552022-02-22 10:09:42 +1100267 nb = mcmd->this_residual;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268 if (nb > 0xfff0)
269 nb = 0xfff0;
Finn Thain55a94552022-02-22 10:09:42 +1100270 mcmd->this_residual -= nb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 writeb(nb, &regs->count_lo);
272 writeb(nb >> 8, &regs->count_mid);
273 writeb(CMD_DMA_MODE + CMD_NOP, &regs->command);
274 writel(virt_to_phys(state->dma_cmds), &dma->cmdptr);
275 writel((RUN << 16) | RUN, &dma->control);
276 writeb(CMD_DMA_MODE + CMD_XFER_DATA, &regs->command);
277 state->phase = dataing;
278 break;
279 } else if ((stat & STAT_PHASE) == STAT_CD + STAT_IO) {
280 /* up to status phase already */
281 writeb(CMD_I_COMPLETE, &regs->command);
282 state->phase = completing;
283 } else {
284 printk(KERN_DEBUG "in unexpected phase %x after cmd\n",
285 stat & STAT_PHASE);
286 cmd_done(state, DID_ERROR << 16);
287 return;
288 }
289 break;
290
291 case dataing:
292 if (intr != INTR_BUS_SERV) {
293 printk(KERN_DEBUG "got intr %x before status\n", intr);
294 cmd_done(state, DID_ERROR << 16);
295 return;
296 }
Finn Thain55a94552022-02-22 10:09:42 +1100297 if (mcmd->this_residual != 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 && (stat & (STAT_MSG|STAT_CD)) == 0) {
299 /* Set up the count regs to transfer more */
Finn Thain55a94552022-02-22 10:09:42 +1100300 nb = mcmd->this_residual;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301 if (nb > 0xfff0)
302 nb = 0xfff0;
Finn Thain55a94552022-02-22 10:09:42 +1100303 mcmd->this_residual -= nb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304 writeb(nb, &regs->count_lo);
305 writeb(nb >> 8, &regs->count_mid);
306 writeb(CMD_DMA_MODE + CMD_NOP, &regs->command);
307 writeb(CMD_DMA_MODE + CMD_XFER_DATA, &regs->command);
308 break;
309 }
310 if ((stat & STAT_PHASE) != STAT_CD + STAT_IO) {
311 printk(KERN_DEBUG "intr %x before data xfer complete\n", intr);
312 }
313 writel(RUN << 16, &dma->control); /* stop dma */
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900314 scsi_dma_unmap(cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315 /* should check dma status */
316 writeb(CMD_I_COMPLETE, &regs->command);
317 state->phase = completing;
318 break;
319 case completing:
320 if (intr != INTR_DONE) {
321 printk(KERN_DEBUG "got intr %x on completion\n", intr);
322 cmd_done(state, DID_ERROR << 16);
323 return;
324 }
Finn Thain55a94552022-02-22 10:09:42 +1100325 mcmd->status = readb(&regs->fifo);
326 mcmd->message = readb(&regs->fifo);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327 writeb(CMD_ACCEPT_MSG, &regs->command);
328 state->phase = busfreeing;
329 break;
330 case busfreeing:
331 if (intr != INTR_DISCONNECT) {
332 printk(KERN_DEBUG "got intr %x when expected disconnect\n", intr);
333 }
Finn Thain55a94552022-02-22 10:09:42 +1100334 cmd_done(state, (DID_OK << 16) + (mcmd->message << 8) + mcmd->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 break;
336 default:
337 printk(KERN_DEBUG "don't know about phase %d\n", state->phase);
338 }
339}
340
341static void cmd_done(struct fsc_state *state, int result)
342{
343 struct scsi_cmnd *cmd;
344
345 cmd = state->current_req;
Jiapeng Chongbe20b962021-03-10 12:16:11 +0800346 if (cmd) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347 cmd->result = result;
Bart Van Asschec0e70ea2021-10-07 13:28:42 -0700348 scsi_done(cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349 state->current_req = NULL;
350 }
351 state->phase = idle;
352 mac53c94_start(state);
353}
354
355/*
356 * Set up DMA commands for transferring data.
357 */
358static void set_dma_cmds(struct fsc_state *state, struct scsi_cmnd *cmd)
359{
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900360 int i, dma_cmd, total, nseg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 struct scatterlist *scl;
362 struct dbdma_cmd *dcmds;
363 dma_addr_t dma_addr;
364 u32 dma_len;
365
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900366 nseg = scsi_dma_map(cmd);
367 BUG_ON(nseg < 0);
368 if (!nseg)
369 return;
370
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 dma_cmd = cmd->sc_data_direction == DMA_TO_DEVICE ?
372 OUTPUT_MORE : INPUT_MORE;
373 dcmds = state->dma_cmds;
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900374 total = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900376 scsi_for_each_sg(cmd, scl, nseg, i) {
377 dma_addr = sg_dma_address(scl);
378 dma_len = sg_dma_len(scl);
379 if (dma_len > 0xffff)
380 panic("mac53c94: scatterlist element >= 64k");
381 total += dma_len;
David Gibsonf5718722015-02-03 16:36:21 +1100382 dcmds->req_count = cpu_to_le16(dma_len);
383 dcmds->command = cpu_to_le16(dma_cmd);
384 dcmds->phy_addr = cpu_to_le32(dma_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385 dcmds->xfer_status = 0;
386 ++dcmds;
387 }
FUJITA Tomonori646158c2007-05-26 12:46:30 +0900388
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389 dma_cmd += OUTPUT_LAST - OUTPUT_MORE;
David Gibsonf5718722015-02-03 16:36:21 +1100390 dcmds[-1].command = cpu_to_le16(dma_cmd);
391 dcmds->command = cpu_to_le16(DBDMA_STOP);
Finn Thain55a94552022-02-22 10:09:42 +1100392 mac53c94_priv(cmd)->this_residual = total;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393}
394
395static struct scsi_host_template mac53c94_template = {
396 .proc_name = "53c94",
397 .name = "53C94",
398 .queuecommand = mac53c94_queue,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 .eh_host_reset_handler = mac53c94_host_reset,
400 .can_queue = 1,
401 .this_id = 7,
402 .sg_tablesize = SG_ALL,
Christoph Hellwig1c3726a2018-12-13 16:17:08 +0100403 .max_segment_size = 65535,
Bart Van Asschecb2b6202022-02-18 11:50:59 -0800404 .cmd_size = sizeof(struct mac53c94_cmd_priv),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405};
406
Jeff Mahoney5e655772005-07-06 15:44:41 -0400407static int mac53c94_probe(struct macio_dev *mdev, const struct of_device_id *match)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408{
409 struct device_node *node = macio_get_of_node(mdev);
410 struct pci_dev *pdev = macio_get_pci_dev(mdev);
411 struct fsc_state *state;
412 struct Scsi_Host *host;
413 void *dma_cmd_space;
Jeremy Kerr294ef162006-07-12 15:40:51 +1000414 const unsigned char *clkprop;
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100415 int proplen, rc = -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416
417 if (macio_resource_count(mdev) != 2 || macio_irq_count(mdev) != 2) {
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100418 printk(KERN_ERR "mac53c94: expected 2 addrs and intrs"
419 " (got %d/%d)\n",
420 macio_resource_count(mdev), macio_irq_count(mdev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421 return -ENODEV;
422 }
423
424 if (macio_request_resources(mdev, "mac53c94") != 0) {
425 printk(KERN_ERR "mac53c94: unable to request memory resources");
426 return -EBUSY;
427 }
428
429 host = scsi_host_alloc(&mac53c94_template, sizeof(struct fsc_state));
430 if (host == NULL) {
431 printk(KERN_ERR "mac53c94: couldn't register host");
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100432 rc = -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433 goto out_release;
434 }
435
436 state = (struct fsc_state *) host->hostdata;
437 macio_set_drvdata(mdev, state);
438 state->host = host;
439 state->pdev = pdev;
440 state->mdev = mdev;
441
442 state->regs = (struct mac53c94_regs __iomem *)
443 ioremap(macio_resource_start(mdev, 0), 0x1000);
444 state->intr = macio_irq(mdev, 0);
445 state->dma = (struct dbdma_regs __iomem *)
446 ioremap(macio_resource_start(mdev, 1), 0x1000);
447 state->dmaintr = macio_irq(mdev, 1);
448 if (state->regs == NULL || state->dma == NULL) {
Rob Herring22fe5672017-07-18 16:43:28 -0500449 printk(KERN_ERR "mac53c94: ioremap failed for %pOF\n", node);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450 goto out_free;
451 }
452
Stephen Rothwell40cd3a42007-05-01 13:54:02 +1000453 clkprop = of_get_property(node, "clock-frequency", &proplen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454 if (clkprop == NULL || proplen != sizeof(int)) {
Rob Herring22fe5672017-07-18 16:43:28 -0500455 printk(KERN_ERR "%pOF: can't get clock frequency, "
456 "assuming 25MHz\n", node);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457 state->clk_freq = 25000000;
458 } else
459 state->clk_freq = *(int *)clkprop;
460
461 /* Space for dma command list: +1 for stop command,
462 * +1 to allow for aligning.
463 * XXX FIXME: Use DMA consistent routines
464 */
Kees Cook6da2ec52018-06-12 13:55:00 -0700465 dma_cmd_space = kmalloc_array(host->sg_tablesize + 2,
466 sizeof(struct dbdma_cmd),
467 GFP_KERNEL);
Jiapeng Chongbe20b962021-03-10 12:16:11 +0800468 if (!dma_cmd_space) {
469 printk(KERN_ERR "mac53c94: couldn't allocate dma "
470 "command space for %pOF\n", node);
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100471 rc = -ENOMEM;
Jiapeng Chongbe20b962021-03-10 12:16:11 +0800472 goto out_free;
473 }
474
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475 state->dma_cmds = (struct dbdma_cmd *)DBDMA_ALIGN(dma_cmd_space);
476 memset(state->dma_cmds, 0, (host->sg_tablesize + 1)
477 * sizeof(struct dbdma_cmd));
478 state->dma_cmd_space = dma_cmd_space;
479
480 mac53c94_init(state);
481
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100482 if (request_irq(state->intr, do_mac53c94_interrupt, 0, "53C94",state)) {
Rob Herring22fe5672017-07-18 16:43:28 -0500483 printk(KERN_ERR "mac53C94: can't get irq %d for %pOF\n",
484 state->intr, node);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 goto out_free_dma;
486 }
487
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100488 rc = scsi_add_host(host, &mdev->ofdev.dev);
489 if (rc != 0)
490 goto out_release_irq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100492 scsi_scan_host(host);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 return 0;
494
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100495 out_release_irq:
496 free_irq(state->intr, state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497 out_free_dma:
498 kfree(state->dma_cmd_space);
499 out_free:
500 if (state->dma != NULL)
501 iounmap(state->dma);
502 if (state->regs != NULL)
503 iounmap(state->regs);
504 scsi_host_put(host);
505 out_release:
506 macio_release_resources(mdev);
507
Benjamin Herrenschmidtcc5d0182005-12-13 18:01:21 +1100508 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509}
510
511static int mac53c94_remove(struct macio_dev *mdev)
512{
513 struct fsc_state *fp = (struct fsc_state *)macio_get_drvdata(mdev);
514 struct Scsi_Host *host = fp->host;
515
516 scsi_remove_host(host);
517
518 free_irq(fp->intr, fp);
519
520 if (fp->regs)
Al Viro7be7cbf2005-12-06 06:01:14 -0500521 iounmap(fp->regs);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522 if (fp->dma)
Al Viro7be7cbf2005-12-06 06:01:14 -0500523 iounmap(fp->dma);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 kfree(fp->dma_cmd_space);
525
526 scsi_host_put(host);
527
528 macio_release_resources(mdev);
529
530 return 0;
531}
532
533
Jeff Mahoney5e655772005-07-06 15:44:41 -0400534static struct of_device_id mac53c94_match[] =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535{
536 {
537 .name = "53c94",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 },
539 {},
540};
Jeff Mahoney5e655772005-07-06 15:44:41 -0400541MODULE_DEVICE_TABLE (of, mac53c94_match);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542
543static struct macio_driver mac53c94_driver =
544{
Benjamin Herrenschmidtc2cdf6a2010-06-02 17:09:18 +1000545 .driver = {
546 .name = "mac53c94",
547 .owner = THIS_MODULE,
548 .of_match_table = mac53c94_match,
549 },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 .probe = mac53c94_probe,
551 .remove = mac53c94_remove,
552};
553
554
555static int __init init_mac53c94(void)
556{
557 return macio_register_driver(&mac53c94_driver);
558}
559
560static void __exit exit_mac53c94(void)
561{
562 return macio_unregister_driver(&mac53c94_driver);
563}
564
565module_init(init_mac53c94);
566module_exit(exit_mac53c94);
567
568MODULE_DESCRIPTION("PowerMac 53c94 SCSI driver");
569MODULE_AUTHOR("Paul Mackerras <paulus@samba.org>");
570MODULE_LICENSE("GPL");