162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * SCSI low-level driver for the 53c94 SCSI bus adaptor found
462306a36Sopenharmony_ci * on Power Macintosh computers, controlling the external SCSI chain.
562306a36Sopenharmony_ci * We assume the 53c94 is connected to a DBDMA (descriptor-based DMA)
662306a36Sopenharmony_ci * controller.
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * Paul Mackerras, August 1996.
962306a36Sopenharmony_ci * Copyright (C) 1996 Paul Mackerras.
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci#include <linux/kernel.h>
1262306a36Sopenharmony_ci#include <linux/delay.h>
1362306a36Sopenharmony_ci#include <linux/types.h>
1462306a36Sopenharmony_ci#include <linux/string.h>
1562306a36Sopenharmony_ci#include <linux/slab.h>
1662306a36Sopenharmony_ci#include <linux/blkdev.h>
1762306a36Sopenharmony_ci#include <linux/proc_fs.h>
1862306a36Sopenharmony_ci#include <linux/stat.h>
1962306a36Sopenharmony_ci#include <linux/spinlock.h>
2062306a36Sopenharmony_ci#include <linux/interrupt.h>
2162306a36Sopenharmony_ci#include <linux/module.h>
2262306a36Sopenharmony_ci#include <linux/pci.h>
2362306a36Sopenharmony_ci#include <linux/pgtable.h>
2462306a36Sopenharmony_ci#include <asm/dbdma.h>
2562306a36Sopenharmony_ci#include <asm/io.h>
2662306a36Sopenharmony_ci#include <asm/prom.h>
2762306a36Sopenharmony_ci#include <asm/macio.h>
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci#include <scsi/scsi.h>
3062306a36Sopenharmony_ci#include <scsi/scsi_cmnd.h>
3162306a36Sopenharmony_ci#include <scsi/scsi_device.h>
3262306a36Sopenharmony_ci#include <scsi/scsi_host.h>
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci#include "mac53c94.h"
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_cienum fsc_phase {
3762306a36Sopenharmony_ci	idle,
3862306a36Sopenharmony_ci	selecting,
3962306a36Sopenharmony_ci	dataing,
4062306a36Sopenharmony_ci	completing,
4162306a36Sopenharmony_ci	busfreeing,
4262306a36Sopenharmony_ci};
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_cistruct fsc_state {
4562306a36Sopenharmony_ci	struct	mac53c94_regs __iomem *regs;
4662306a36Sopenharmony_ci	int	intr;
4762306a36Sopenharmony_ci	struct	dbdma_regs __iomem *dma;
4862306a36Sopenharmony_ci	int	dmaintr;
4962306a36Sopenharmony_ci	int	clk_freq;
5062306a36Sopenharmony_ci	struct	Scsi_Host *host;
5162306a36Sopenharmony_ci	struct scsi_cmnd *request_q;
5262306a36Sopenharmony_ci	struct scsi_cmnd *request_qtail;
5362306a36Sopenharmony_ci	struct scsi_cmnd *current_req;		/* req we're currently working on */
5462306a36Sopenharmony_ci	enum fsc_phase phase;		/* what we're currently trying to do */
5562306a36Sopenharmony_ci	struct dbdma_cmd *dma_cmds;	/* space for dbdma commands, aligned */
5662306a36Sopenharmony_ci	void	*dma_cmd_space;
5762306a36Sopenharmony_ci	struct	pci_dev *pdev;
5862306a36Sopenharmony_ci	dma_addr_t dma_addr;
5962306a36Sopenharmony_ci	struct macio_dev *mdev;
6062306a36Sopenharmony_ci};
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_cistatic void mac53c94_init(struct fsc_state *);
6362306a36Sopenharmony_cistatic void mac53c94_start(struct fsc_state *);
6462306a36Sopenharmony_cistatic void mac53c94_interrupt(int, void *);
6562306a36Sopenharmony_cistatic irqreturn_t do_mac53c94_interrupt(int, void *);
6662306a36Sopenharmony_cistatic void cmd_done(struct fsc_state *, int result);
6762306a36Sopenharmony_cistatic void set_dma_cmds(struct fsc_state *, struct scsi_cmnd *);
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_cistatic int mac53c94_queue_lck(struct scsi_cmnd *cmd)
7062306a36Sopenharmony_ci{
7162306a36Sopenharmony_ci	struct fsc_state *state;
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci#if 0
7462306a36Sopenharmony_ci	if (cmd->sc_data_direction == DMA_TO_DEVICE) {
7562306a36Sopenharmony_ci		int i;
7662306a36Sopenharmony_ci		printk(KERN_DEBUG "mac53c94_queue %p: command is", cmd);
7762306a36Sopenharmony_ci		for (i = 0; i < cmd->cmd_len; ++i)
7862306a36Sopenharmony_ci			printk(KERN_CONT " %.2x", cmd->cmnd[i]);
7962306a36Sopenharmony_ci		printk(KERN_CONT "\n");
8062306a36Sopenharmony_ci		printk(KERN_DEBUG "use_sg=%d request_bufflen=%d request_buffer=%p\n",
8162306a36Sopenharmony_ci		       scsi_sg_count(cmd), scsi_bufflen(cmd), scsi_sglist(cmd));
8262306a36Sopenharmony_ci	}
8362306a36Sopenharmony_ci#endif
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci	cmd->host_scribble = NULL;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	state = (struct fsc_state *) cmd->device->host->hostdata;
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	if (state->request_q == NULL)
9062306a36Sopenharmony_ci		state->request_q = cmd;
9162306a36Sopenharmony_ci	else
9262306a36Sopenharmony_ci		state->request_qtail->host_scribble = (void *) cmd;
9362306a36Sopenharmony_ci	state->request_qtail = cmd;
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	if (state->phase == idle)
9662306a36Sopenharmony_ci		mac53c94_start(state);
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci	return 0;
9962306a36Sopenharmony_ci}
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_cistatic DEF_SCSI_QCMD(mac53c94_queue)
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_cistatic int mac53c94_host_reset(struct scsi_cmnd *cmd)
10462306a36Sopenharmony_ci{
10562306a36Sopenharmony_ci	struct fsc_state *state = (struct fsc_state *) cmd->device->host->hostdata;
10662306a36Sopenharmony_ci	struct mac53c94_regs __iomem *regs = state->regs;
10762306a36Sopenharmony_ci	struct dbdma_regs __iomem *dma = state->dma;
10862306a36Sopenharmony_ci	unsigned long flags;
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	spin_lock_irqsave(cmd->device->host->host_lock, flags);
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_ci	writel((RUN|PAUSE|FLUSH|WAKE) << 16, &dma->control);
11362306a36Sopenharmony_ci	writeb(CMD_SCSI_RESET, &regs->command);	/* assert RST */
11462306a36Sopenharmony_ci	udelay(100);			/* leave it on for a while (>= 25us) */
11562306a36Sopenharmony_ci	writeb(CMD_RESET, &regs->command);
11662306a36Sopenharmony_ci	udelay(20);
11762306a36Sopenharmony_ci	mac53c94_init(state);
11862306a36Sopenharmony_ci	writeb(CMD_NOP, &regs->command);
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	spin_unlock_irqrestore(cmd->device->host->host_lock, flags);
12162306a36Sopenharmony_ci	return SUCCESS;
12262306a36Sopenharmony_ci}
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_cistatic void mac53c94_init(struct fsc_state *state)
12562306a36Sopenharmony_ci{
12662306a36Sopenharmony_ci	struct mac53c94_regs __iomem *regs = state->regs;
12762306a36Sopenharmony_ci	struct dbdma_regs __iomem *dma = state->dma;
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci	writeb(state->host->this_id | CF1_PAR_ENABLE, &regs->config1);
13062306a36Sopenharmony_ci	writeb(TIMO_VAL(250), &regs->sel_timeout);	/* 250ms */
13162306a36Sopenharmony_ci	writeb(CLKF_VAL(state->clk_freq), &regs->clk_factor);
13262306a36Sopenharmony_ci	writeb(CF2_FEATURE_EN, &regs->config2);
13362306a36Sopenharmony_ci	writeb(0, &regs->config3);
13462306a36Sopenharmony_ci	writeb(0, &regs->sync_period);
13562306a36Sopenharmony_ci	writeb(0, &regs->sync_offset);
13662306a36Sopenharmony_ci	(void)readb(&regs->interrupt);
13762306a36Sopenharmony_ci	writel((RUN|PAUSE|FLUSH|WAKE) << 16, &dma->control);
13862306a36Sopenharmony_ci}
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci/*
14162306a36Sopenharmony_ci * Start the next command for a 53C94.
14262306a36Sopenharmony_ci * Should be called with interrupts disabled.
14362306a36Sopenharmony_ci */
14462306a36Sopenharmony_cistatic void mac53c94_start(struct fsc_state *state)
14562306a36Sopenharmony_ci{
14662306a36Sopenharmony_ci	struct scsi_cmnd *cmd;
14762306a36Sopenharmony_ci	struct mac53c94_regs __iomem *regs = state->regs;
14862306a36Sopenharmony_ci	int i;
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci	if (state->phase != idle || state->current_req != NULL)
15162306a36Sopenharmony_ci		panic("inappropriate mac53c94_start (state=%p)", state);
15262306a36Sopenharmony_ci	if (state->request_q == NULL)
15362306a36Sopenharmony_ci		return;
15462306a36Sopenharmony_ci	state->current_req = cmd = state->request_q;
15562306a36Sopenharmony_ci	state->request_q = (struct scsi_cmnd *) cmd->host_scribble;
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ci	/* Off we go */
15862306a36Sopenharmony_ci	writeb(0, &regs->count_lo);
15962306a36Sopenharmony_ci	writeb(0, &regs->count_mid);
16062306a36Sopenharmony_ci	writeb(0, &regs->count_hi);
16162306a36Sopenharmony_ci	writeb(CMD_NOP + CMD_DMA_MODE, &regs->command);
16262306a36Sopenharmony_ci	udelay(1);
16362306a36Sopenharmony_ci	writeb(CMD_FLUSH, &regs->command);
16462306a36Sopenharmony_ci	udelay(1);
16562306a36Sopenharmony_ci	writeb(cmd->device->id, &regs->dest_id);
16662306a36Sopenharmony_ci	writeb(0, &regs->sync_period);
16762306a36Sopenharmony_ci	writeb(0, &regs->sync_offset);
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	/* load the command into the FIFO */
17062306a36Sopenharmony_ci	for (i = 0; i < cmd->cmd_len; ++i)
17162306a36Sopenharmony_ci		writeb(cmd->cmnd[i], &regs->fifo);
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	/* do select without ATN XXX */
17462306a36Sopenharmony_ci	writeb(CMD_SELECT, &regs->command);
17562306a36Sopenharmony_ci	state->phase = selecting;
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	set_dma_cmds(state, cmd);
17862306a36Sopenharmony_ci}
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_cistatic irqreturn_t do_mac53c94_interrupt(int irq, void *dev_id)
18162306a36Sopenharmony_ci{
18262306a36Sopenharmony_ci	unsigned long flags;
18362306a36Sopenharmony_ci	struct Scsi_Host *dev = ((struct fsc_state *) dev_id)->current_req->device->host;
18462306a36Sopenharmony_ci
18562306a36Sopenharmony_ci	spin_lock_irqsave(dev->host_lock, flags);
18662306a36Sopenharmony_ci	mac53c94_interrupt(irq, dev_id);
18762306a36Sopenharmony_ci	spin_unlock_irqrestore(dev->host_lock, flags);
18862306a36Sopenharmony_ci	return IRQ_HANDLED;
18962306a36Sopenharmony_ci}
19062306a36Sopenharmony_ci
19162306a36Sopenharmony_cistatic void mac53c94_interrupt(int irq, void *dev_id)
19262306a36Sopenharmony_ci{
19362306a36Sopenharmony_ci	struct fsc_state *state = (struct fsc_state *) dev_id;
19462306a36Sopenharmony_ci	struct mac53c94_regs __iomem *regs = state->regs;
19562306a36Sopenharmony_ci	struct dbdma_regs __iomem *dma = state->dma;
19662306a36Sopenharmony_ci	struct scsi_cmnd *const cmd = state->current_req;
19762306a36Sopenharmony_ci	struct mac53c94_cmd_priv *const mcmd = mac53c94_priv(cmd);
19862306a36Sopenharmony_ci	int nb, stat, seq, intr;
19962306a36Sopenharmony_ci	static int mac53c94_errors;
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci	/*
20262306a36Sopenharmony_ci	 * Apparently, reading the interrupt register unlatches
20362306a36Sopenharmony_ci	 * the status and sequence step registers.
20462306a36Sopenharmony_ci	 */
20562306a36Sopenharmony_ci	seq = readb(&regs->seqstep);
20662306a36Sopenharmony_ci	stat = readb(&regs->status);
20762306a36Sopenharmony_ci	intr = readb(&regs->interrupt);
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci#if 0
21062306a36Sopenharmony_ci	printk(KERN_DEBUG "mac53c94_intr, intr=%x stat=%x seq=%x phase=%d\n",
21162306a36Sopenharmony_ci	       intr, stat, seq, state->phase);
21262306a36Sopenharmony_ci#endif
21362306a36Sopenharmony_ci
21462306a36Sopenharmony_ci	if (intr & INTR_RESET) {
21562306a36Sopenharmony_ci		/* SCSI bus was reset */
21662306a36Sopenharmony_ci		printk(KERN_INFO "external SCSI bus reset detected\n");
21762306a36Sopenharmony_ci		writeb(CMD_NOP, &regs->command);
21862306a36Sopenharmony_ci		writel(RUN << 16, &dma->control);	/* stop dma */
21962306a36Sopenharmony_ci		cmd_done(state, DID_RESET << 16);
22062306a36Sopenharmony_ci		return;
22162306a36Sopenharmony_ci	}
22262306a36Sopenharmony_ci	if (intr & INTR_ILL_CMD) {
22362306a36Sopenharmony_ci		printk(KERN_ERR "53c94: invalid cmd, intr=%x stat=%x seq=%x phase=%d\n",
22462306a36Sopenharmony_ci		       intr, stat, seq, state->phase);
22562306a36Sopenharmony_ci		cmd_done(state, DID_ERROR << 16);
22662306a36Sopenharmony_ci		return;
22762306a36Sopenharmony_ci	}
22862306a36Sopenharmony_ci	if (stat & STAT_ERROR) {
22962306a36Sopenharmony_ci#if 0
23062306a36Sopenharmony_ci		/* XXX these seem to be harmless? */
23162306a36Sopenharmony_ci		printk("53c94: bad error, intr=%x stat=%x seq=%x phase=%d\n",
23262306a36Sopenharmony_ci		       intr, stat, seq, state->phase);
23362306a36Sopenharmony_ci#endif
23462306a36Sopenharmony_ci		++mac53c94_errors;
23562306a36Sopenharmony_ci		writeb(CMD_NOP + CMD_DMA_MODE, &regs->command);
23662306a36Sopenharmony_ci	}
23762306a36Sopenharmony_ci	if (!cmd) {
23862306a36Sopenharmony_ci		printk(KERN_DEBUG "53c94: interrupt with no command active?\n");
23962306a36Sopenharmony_ci		return;
24062306a36Sopenharmony_ci	}
24162306a36Sopenharmony_ci	if (stat & STAT_PARITY) {
24262306a36Sopenharmony_ci		printk(KERN_ERR "mac53c94: parity error\n");
24362306a36Sopenharmony_ci		cmd_done(state, DID_PARITY << 16);
24462306a36Sopenharmony_ci		return;
24562306a36Sopenharmony_ci	}
24662306a36Sopenharmony_ci	switch (state->phase) {
24762306a36Sopenharmony_ci	case selecting:
24862306a36Sopenharmony_ci		if (intr & INTR_DISCONNECT) {
24962306a36Sopenharmony_ci			/* selection timed out */
25062306a36Sopenharmony_ci			cmd_done(state, DID_BAD_TARGET << 16);
25162306a36Sopenharmony_ci			return;
25262306a36Sopenharmony_ci		}
25362306a36Sopenharmony_ci		if (intr != INTR_BUS_SERV + INTR_DONE) {
25462306a36Sopenharmony_ci			printk(KERN_DEBUG "got intr %x during selection\n", intr);
25562306a36Sopenharmony_ci			cmd_done(state, DID_ERROR << 16);
25662306a36Sopenharmony_ci			return;
25762306a36Sopenharmony_ci		}
25862306a36Sopenharmony_ci		if ((seq & SS_MASK) != SS_DONE) {
25962306a36Sopenharmony_ci			printk(KERN_DEBUG "seq step %x after command\n", seq);
26062306a36Sopenharmony_ci			cmd_done(state, DID_ERROR << 16);
26162306a36Sopenharmony_ci			return;
26262306a36Sopenharmony_ci		}
26362306a36Sopenharmony_ci		writeb(CMD_NOP, &regs->command);
26462306a36Sopenharmony_ci		/* set DMA controller going if any data to transfer */
26562306a36Sopenharmony_ci		if ((stat & (STAT_MSG|STAT_CD)) == 0
26662306a36Sopenharmony_ci		    && (scsi_sg_count(cmd) > 0 || scsi_bufflen(cmd))) {
26762306a36Sopenharmony_ci			nb = mcmd->this_residual;
26862306a36Sopenharmony_ci			if (nb > 0xfff0)
26962306a36Sopenharmony_ci				nb = 0xfff0;
27062306a36Sopenharmony_ci			mcmd->this_residual -= nb;
27162306a36Sopenharmony_ci			writeb(nb, &regs->count_lo);
27262306a36Sopenharmony_ci			writeb(nb >> 8, &regs->count_mid);
27362306a36Sopenharmony_ci			writeb(CMD_DMA_MODE + CMD_NOP, &regs->command);
27462306a36Sopenharmony_ci			writel(virt_to_phys(state->dma_cmds), &dma->cmdptr);
27562306a36Sopenharmony_ci			writel((RUN << 16) | RUN, &dma->control);
27662306a36Sopenharmony_ci			writeb(CMD_DMA_MODE + CMD_XFER_DATA, &regs->command);
27762306a36Sopenharmony_ci			state->phase = dataing;
27862306a36Sopenharmony_ci			break;
27962306a36Sopenharmony_ci		} else if ((stat & STAT_PHASE) == STAT_CD + STAT_IO) {
28062306a36Sopenharmony_ci			/* up to status phase already */
28162306a36Sopenharmony_ci			writeb(CMD_I_COMPLETE, &regs->command);
28262306a36Sopenharmony_ci			state->phase = completing;
28362306a36Sopenharmony_ci		} else {
28462306a36Sopenharmony_ci			printk(KERN_DEBUG "in unexpected phase %x after cmd\n",
28562306a36Sopenharmony_ci			       stat & STAT_PHASE);
28662306a36Sopenharmony_ci			cmd_done(state, DID_ERROR << 16);
28762306a36Sopenharmony_ci			return;
28862306a36Sopenharmony_ci		}
28962306a36Sopenharmony_ci		break;
29062306a36Sopenharmony_ci
29162306a36Sopenharmony_ci	case dataing:
29262306a36Sopenharmony_ci		if (intr != INTR_BUS_SERV) {
29362306a36Sopenharmony_ci			printk(KERN_DEBUG "got intr %x before status\n", intr);
29462306a36Sopenharmony_ci			cmd_done(state, DID_ERROR << 16);
29562306a36Sopenharmony_ci			return;
29662306a36Sopenharmony_ci		}
29762306a36Sopenharmony_ci		if (mcmd->this_residual != 0
29862306a36Sopenharmony_ci		    && (stat & (STAT_MSG|STAT_CD)) == 0) {
29962306a36Sopenharmony_ci			/* Set up the count regs to transfer more */
30062306a36Sopenharmony_ci			nb = mcmd->this_residual;
30162306a36Sopenharmony_ci			if (nb > 0xfff0)
30262306a36Sopenharmony_ci				nb = 0xfff0;
30362306a36Sopenharmony_ci			mcmd->this_residual -= nb;
30462306a36Sopenharmony_ci			writeb(nb, &regs->count_lo);
30562306a36Sopenharmony_ci			writeb(nb >> 8, &regs->count_mid);
30662306a36Sopenharmony_ci			writeb(CMD_DMA_MODE + CMD_NOP, &regs->command);
30762306a36Sopenharmony_ci			writeb(CMD_DMA_MODE + CMD_XFER_DATA, &regs->command);
30862306a36Sopenharmony_ci			break;
30962306a36Sopenharmony_ci		}
31062306a36Sopenharmony_ci		if ((stat & STAT_PHASE) != STAT_CD + STAT_IO) {
31162306a36Sopenharmony_ci			printk(KERN_DEBUG "intr %x before data xfer complete\n", intr);
31262306a36Sopenharmony_ci		}
31362306a36Sopenharmony_ci		writel(RUN << 16, &dma->control);	/* stop dma */
31462306a36Sopenharmony_ci		scsi_dma_unmap(cmd);
31562306a36Sopenharmony_ci		/* should check dma status */
31662306a36Sopenharmony_ci		writeb(CMD_I_COMPLETE, &regs->command);
31762306a36Sopenharmony_ci		state->phase = completing;
31862306a36Sopenharmony_ci		break;
31962306a36Sopenharmony_ci	case completing:
32062306a36Sopenharmony_ci		if (intr != INTR_DONE) {
32162306a36Sopenharmony_ci			printk(KERN_DEBUG "got intr %x on completion\n", intr);
32262306a36Sopenharmony_ci			cmd_done(state, DID_ERROR << 16);
32362306a36Sopenharmony_ci			return;
32462306a36Sopenharmony_ci		}
32562306a36Sopenharmony_ci		mcmd->status = readb(&regs->fifo);
32662306a36Sopenharmony_ci		mcmd->message = readb(&regs->fifo);
32762306a36Sopenharmony_ci		writeb(CMD_ACCEPT_MSG, &regs->command);
32862306a36Sopenharmony_ci		state->phase = busfreeing;
32962306a36Sopenharmony_ci		break;
33062306a36Sopenharmony_ci	case busfreeing:
33162306a36Sopenharmony_ci		if (intr != INTR_DISCONNECT) {
33262306a36Sopenharmony_ci			printk(KERN_DEBUG "got intr %x when expected disconnect\n", intr);
33362306a36Sopenharmony_ci		}
33462306a36Sopenharmony_ci		cmd_done(state, (DID_OK << 16) + (mcmd->message << 8) + mcmd->status);
33562306a36Sopenharmony_ci		break;
33662306a36Sopenharmony_ci	default:
33762306a36Sopenharmony_ci		printk(KERN_DEBUG "don't know about phase %d\n", state->phase);
33862306a36Sopenharmony_ci	}
33962306a36Sopenharmony_ci}
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_cistatic void cmd_done(struct fsc_state *state, int result)
34262306a36Sopenharmony_ci{
34362306a36Sopenharmony_ci	struct scsi_cmnd *cmd;
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci	cmd = state->current_req;
34662306a36Sopenharmony_ci	if (cmd) {
34762306a36Sopenharmony_ci		cmd->result = result;
34862306a36Sopenharmony_ci		scsi_done(cmd);
34962306a36Sopenharmony_ci		state->current_req = NULL;
35062306a36Sopenharmony_ci	}
35162306a36Sopenharmony_ci	state->phase = idle;
35262306a36Sopenharmony_ci	mac53c94_start(state);
35362306a36Sopenharmony_ci}
35462306a36Sopenharmony_ci
35562306a36Sopenharmony_ci/*
35662306a36Sopenharmony_ci * Set up DMA commands for transferring data.
35762306a36Sopenharmony_ci */
35862306a36Sopenharmony_cistatic void set_dma_cmds(struct fsc_state *state, struct scsi_cmnd *cmd)
35962306a36Sopenharmony_ci{
36062306a36Sopenharmony_ci	int i, dma_cmd, total, nseg;
36162306a36Sopenharmony_ci	struct scatterlist *scl;
36262306a36Sopenharmony_ci	struct dbdma_cmd *dcmds;
36362306a36Sopenharmony_ci	dma_addr_t dma_addr;
36462306a36Sopenharmony_ci	u32 dma_len;
36562306a36Sopenharmony_ci
36662306a36Sopenharmony_ci	nseg = scsi_dma_map(cmd);
36762306a36Sopenharmony_ci	BUG_ON(nseg < 0);
36862306a36Sopenharmony_ci	if (!nseg)
36962306a36Sopenharmony_ci		return;
37062306a36Sopenharmony_ci
37162306a36Sopenharmony_ci	dma_cmd = cmd->sc_data_direction == DMA_TO_DEVICE ?
37262306a36Sopenharmony_ci			OUTPUT_MORE : INPUT_MORE;
37362306a36Sopenharmony_ci	dcmds = state->dma_cmds;
37462306a36Sopenharmony_ci	total = 0;
37562306a36Sopenharmony_ci
37662306a36Sopenharmony_ci	scsi_for_each_sg(cmd, scl, nseg, i) {
37762306a36Sopenharmony_ci		dma_addr = sg_dma_address(scl);
37862306a36Sopenharmony_ci		dma_len = sg_dma_len(scl);
37962306a36Sopenharmony_ci		if (dma_len > 0xffff)
38062306a36Sopenharmony_ci			panic("mac53c94: scatterlist element >= 64k");
38162306a36Sopenharmony_ci		total += dma_len;
38262306a36Sopenharmony_ci		dcmds->req_count = cpu_to_le16(dma_len);
38362306a36Sopenharmony_ci		dcmds->command = cpu_to_le16(dma_cmd);
38462306a36Sopenharmony_ci		dcmds->phy_addr = cpu_to_le32(dma_addr);
38562306a36Sopenharmony_ci		dcmds->xfer_status = 0;
38662306a36Sopenharmony_ci		++dcmds;
38762306a36Sopenharmony_ci	}
38862306a36Sopenharmony_ci
38962306a36Sopenharmony_ci	dma_cmd += OUTPUT_LAST - OUTPUT_MORE;
39062306a36Sopenharmony_ci	dcmds[-1].command = cpu_to_le16(dma_cmd);
39162306a36Sopenharmony_ci	dcmds->command = cpu_to_le16(DBDMA_STOP);
39262306a36Sopenharmony_ci	mac53c94_priv(cmd)->this_residual = total;
39362306a36Sopenharmony_ci}
39462306a36Sopenharmony_ci
39562306a36Sopenharmony_cistatic const struct scsi_host_template mac53c94_template = {
39662306a36Sopenharmony_ci	.proc_name	= "53c94",
39762306a36Sopenharmony_ci	.name		= "53C94",
39862306a36Sopenharmony_ci	.queuecommand	= mac53c94_queue,
39962306a36Sopenharmony_ci	.eh_host_reset_handler = mac53c94_host_reset,
40062306a36Sopenharmony_ci	.can_queue	= 1,
40162306a36Sopenharmony_ci	.this_id	= 7,
40262306a36Sopenharmony_ci	.sg_tablesize	= SG_ALL,
40362306a36Sopenharmony_ci	.max_segment_size = 65535,
40462306a36Sopenharmony_ci	.cmd_size	= sizeof(struct mac53c94_cmd_priv),
40562306a36Sopenharmony_ci};
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_cistatic int mac53c94_probe(struct macio_dev *mdev, const struct of_device_id *match)
40862306a36Sopenharmony_ci{
40962306a36Sopenharmony_ci	struct device_node *node = macio_get_of_node(mdev);
41062306a36Sopenharmony_ci	struct pci_dev *pdev = macio_get_pci_dev(mdev);
41162306a36Sopenharmony_ci	struct fsc_state *state;
41262306a36Sopenharmony_ci	struct Scsi_Host *host;
41362306a36Sopenharmony_ci	void *dma_cmd_space;
41462306a36Sopenharmony_ci	const unsigned char *clkprop;
41562306a36Sopenharmony_ci	int proplen, rc = -ENODEV;
41662306a36Sopenharmony_ci
41762306a36Sopenharmony_ci	if (macio_resource_count(mdev) != 2 || macio_irq_count(mdev) != 2) {
41862306a36Sopenharmony_ci		printk(KERN_ERR "mac53c94: expected 2 addrs and intrs"
41962306a36Sopenharmony_ci		       " (got %d/%d)\n",
42062306a36Sopenharmony_ci		       macio_resource_count(mdev), macio_irq_count(mdev));
42162306a36Sopenharmony_ci		return -ENODEV;
42262306a36Sopenharmony_ci	}
42362306a36Sopenharmony_ci
42462306a36Sopenharmony_ci	if (macio_request_resources(mdev, "mac53c94") != 0) {
42562306a36Sopenharmony_ci       		printk(KERN_ERR "mac53c94: unable to request memory resources");
42662306a36Sopenharmony_ci		return -EBUSY;
42762306a36Sopenharmony_ci	}
42862306a36Sopenharmony_ci
42962306a36Sopenharmony_ci       	host = scsi_host_alloc(&mac53c94_template, sizeof(struct fsc_state));
43062306a36Sopenharmony_ci	if (host == NULL) {
43162306a36Sopenharmony_ci		printk(KERN_ERR "mac53c94: couldn't register host");
43262306a36Sopenharmony_ci		rc = -ENOMEM;
43362306a36Sopenharmony_ci		goto out_release;
43462306a36Sopenharmony_ci	}
43562306a36Sopenharmony_ci
43662306a36Sopenharmony_ci	state = (struct fsc_state *) host->hostdata;
43762306a36Sopenharmony_ci	macio_set_drvdata(mdev, state);
43862306a36Sopenharmony_ci	state->host = host;
43962306a36Sopenharmony_ci	state->pdev = pdev;
44062306a36Sopenharmony_ci	state->mdev = mdev;
44162306a36Sopenharmony_ci
44262306a36Sopenharmony_ci	state->regs = (struct mac53c94_regs __iomem *)
44362306a36Sopenharmony_ci		ioremap(macio_resource_start(mdev, 0), 0x1000);
44462306a36Sopenharmony_ci	state->intr = macio_irq(mdev, 0);
44562306a36Sopenharmony_ci	state->dma = (struct dbdma_regs __iomem *)
44662306a36Sopenharmony_ci		ioremap(macio_resource_start(mdev, 1), 0x1000);
44762306a36Sopenharmony_ci	state->dmaintr = macio_irq(mdev, 1);
44862306a36Sopenharmony_ci	if (state->regs == NULL || state->dma == NULL) {
44962306a36Sopenharmony_ci		printk(KERN_ERR "mac53c94: ioremap failed for %pOF\n", node);
45062306a36Sopenharmony_ci		goto out_free;
45162306a36Sopenharmony_ci	}
45262306a36Sopenharmony_ci
45362306a36Sopenharmony_ci	clkprop = of_get_property(node, "clock-frequency", &proplen);
45462306a36Sopenharmony_ci       	if (clkprop == NULL || proplen != sizeof(int)) {
45562306a36Sopenharmony_ci       		printk(KERN_ERR "%pOF: can't get clock frequency, "
45662306a36Sopenharmony_ci       		       "assuming 25MHz\n", node);
45762306a36Sopenharmony_ci       		state->clk_freq = 25000000;
45862306a36Sopenharmony_ci       	} else
45962306a36Sopenharmony_ci       		state->clk_freq = *(int *)clkprop;
46062306a36Sopenharmony_ci
46162306a36Sopenharmony_ci       	/* Space for dma command list: +1 for stop command,
46262306a36Sopenharmony_ci       	 * +1 to allow for aligning.
46362306a36Sopenharmony_ci	 * XXX FIXME: Use DMA consistent routines
46462306a36Sopenharmony_ci	 */
46562306a36Sopenharmony_ci       	dma_cmd_space = kmalloc_array(host->sg_tablesize + 2,
46662306a36Sopenharmony_ci					     sizeof(struct dbdma_cmd),
46762306a36Sopenharmony_ci					     GFP_KERNEL);
46862306a36Sopenharmony_ci	if (!dma_cmd_space) {
46962306a36Sopenharmony_ci		printk(KERN_ERR "mac53c94: couldn't allocate dma "
47062306a36Sopenharmony_ci		       "command space for %pOF\n", node);
47162306a36Sopenharmony_ci		rc = -ENOMEM;
47262306a36Sopenharmony_ci		goto out_free;
47362306a36Sopenharmony_ci	}
47462306a36Sopenharmony_ci
47562306a36Sopenharmony_ci	state->dma_cmds = (struct dbdma_cmd *)DBDMA_ALIGN(dma_cmd_space);
47662306a36Sopenharmony_ci	memset(state->dma_cmds, 0, (host->sg_tablesize + 1)
47762306a36Sopenharmony_ci	       * sizeof(struct dbdma_cmd));
47862306a36Sopenharmony_ci	state->dma_cmd_space = dma_cmd_space;
47962306a36Sopenharmony_ci
48062306a36Sopenharmony_ci	mac53c94_init(state);
48162306a36Sopenharmony_ci
48262306a36Sopenharmony_ci	if (request_irq(state->intr, do_mac53c94_interrupt, 0, "53C94",state)) {
48362306a36Sopenharmony_ci		printk(KERN_ERR "mac53C94: can't get irq %d for %pOF\n",
48462306a36Sopenharmony_ci		       state->intr, node);
48562306a36Sopenharmony_ci		goto out_free_dma;
48662306a36Sopenharmony_ci	}
48762306a36Sopenharmony_ci
48862306a36Sopenharmony_ci	rc = scsi_add_host(host, &mdev->ofdev.dev);
48962306a36Sopenharmony_ci	if (rc != 0)
49062306a36Sopenharmony_ci		goto out_release_irq;
49162306a36Sopenharmony_ci
49262306a36Sopenharmony_ci	scsi_scan_host(host);
49362306a36Sopenharmony_ci	return 0;
49462306a36Sopenharmony_ci
49562306a36Sopenharmony_ci out_release_irq:
49662306a36Sopenharmony_ci	free_irq(state->intr, state);
49762306a36Sopenharmony_ci out_free_dma:
49862306a36Sopenharmony_ci	kfree(state->dma_cmd_space);
49962306a36Sopenharmony_ci out_free:
50062306a36Sopenharmony_ci	if (state->dma != NULL)
50162306a36Sopenharmony_ci		iounmap(state->dma);
50262306a36Sopenharmony_ci	if (state->regs != NULL)
50362306a36Sopenharmony_ci		iounmap(state->regs);
50462306a36Sopenharmony_ci	scsi_host_put(host);
50562306a36Sopenharmony_ci out_release:
50662306a36Sopenharmony_ci	macio_release_resources(mdev);
50762306a36Sopenharmony_ci
50862306a36Sopenharmony_ci	return rc;
50962306a36Sopenharmony_ci}
51062306a36Sopenharmony_ci
51162306a36Sopenharmony_cistatic int mac53c94_remove(struct macio_dev *mdev)
51262306a36Sopenharmony_ci{
51362306a36Sopenharmony_ci	struct fsc_state *fp = (struct fsc_state *)macio_get_drvdata(mdev);
51462306a36Sopenharmony_ci	struct Scsi_Host *host = fp->host;
51562306a36Sopenharmony_ci
51662306a36Sopenharmony_ci	scsi_remove_host(host);
51762306a36Sopenharmony_ci
51862306a36Sopenharmony_ci	free_irq(fp->intr, fp);
51962306a36Sopenharmony_ci
52062306a36Sopenharmony_ci	if (fp->regs)
52162306a36Sopenharmony_ci		iounmap(fp->regs);
52262306a36Sopenharmony_ci	if (fp->dma)
52362306a36Sopenharmony_ci		iounmap(fp->dma);
52462306a36Sopenharmony_ci	kfree(fp->dma_cmd_space);
52562306a36Sopenharmony_ci
52662306a36Sopenharmony_ci	scsi_host_put(host);
52762306a36Sopenharmony_ci
52862306a36Sopenharmony_ci	macio_release_resources(mdev);
52962306a36Sopenharmony_ci
53062306a36Sopenharmony_ci	return 0;
53162306a36Sopenharmony_ci}
53262306a36Sopenharmony_ci
53362306a36Sopenharmony_ci
53462306a36Sopenharmony_cistatic struct of_device_id mac53c94_match[] =
53562306a36Sopenharmony_ci{
53662306a36Sopenharmony_ci	{
53762306a36Sopenharmony_ci	.name 		= "53c94",
53862306a36Sopenharmony_ci	},
53962306a36Sopenharmony_ci	{},
54062306a36Sopenharmony_ci};
54162306a36Sopenharmony_ciMODULE_DEVICE_TABLE (of, mac53c94_match);
54262306a36Sopenharmony_ci
54362306a36Sopenharmony_cistatic struct macio_driver mac53c94_driver =
54462306a36Sopenharmony_ci{
54562306a36Sopenharmony_ci	.driver = {
54662306a36Sopenharmony_ci		.name 		= "mac53c94",
54762306a36Sopenharmony_ci		.owner		= THIS_MODULE,
54862306a36Sopenharmony_ci		.of_match_table	= mac53c94_match,
54962306a36Sopenharmony_ci	},
55062306a36Sopenharmony_ci	.probe		= mac53c94_probe,
55162306a36Sopenharmony_ci	.remove		= mac53c94_remove,
55262306a36Sopenharmony_ci};
55362306a36Sopenharmony_ci
55462306a36Sopenharmony_ci
55562306a36Sopenharmony_cistatic int __init init_mac53c94(void)
55662306a36Sopenharmony_ci{
55762306a36Sopenharmony_ci	return macio_register_driver(&mac53c94_driver);
55862306a36Sopenharmony_ci}
55962306a36Sopenharmony_ci
56062306a36Sopenharmony_cistatic void __exit exit_mac53c94(void)
56162306a36Sopenharmony_ci{
56262306a36Sopenharmony_ci	return macio_unregister_driver(&mac53c94_driver);
56362306a36Sopenharmony_ci}
56462306a36Sopenharmony_ci
56562306a36Sopenharmony_cimodule_init(init_mac53c94);
56662306a36Sopenharmony_cimodule_exit(exit_mac53c94);
56762306a36Sopenharmony_ci
56862306a36Sopenharmony_ciMODULE_DESCRIPTION("PowerMac 53c94 SCSI driver");
56962306a36Sopenharmony_ciMODULE_AUTHOR("Paul Mackerras <paulus@samba.org>");
57062306a36Sopenharmony_ciMODULE_LICENSE("GPL");
571