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, ®s->command); /* assert RST */ 11462306a36Sopenharmony_ci udelay(100); /* leave it on for a while (>= 25us) */ 11562306a36Sopenharmony_ci writeb(CMD_RESET, ®s->command); 11662306a36Sopenharmony_ci udelay(20); 11762306a36Sopenharmony_ci mac53c94_init(state); 11862306a36Sopenharmony_ci writeb(CMD_NOP, ®s->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, ®s->config1); 13062306a36Sopenharmony_ci writeb(TIMO_VAL(250), ®s->sel_timeout); /* 250ms */ 13162306a36Sopenharmony_ci writeb(CLKF_VAL(state->clk_freq), ®s->clk_factor); 13262306a36Sopenharmony_ci writeb(CF2_FEATURE_EN, ®s->config2); 13362306a36Sopenharmony_ci writeb(0, ®s->config3); 13462306a36Sopenharmony_ci writeb(0, ®s->sync_period); 13562306a36Sopenharmony_ci writeb(0, ®s->sync_offset); 13662306a36Sopenharmony_ci (void)readb(®s->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, ®s->count_lo); 15962306a36Sopenharmony_ci writeb(0, ®s->count_mid); 16062306a36Sopenharmony_ci writeb(0, ®s->count_hi); 16162306a36Sopenharmony_ci writeb(CMD_NOP + CMD_DMA_MODE, ®s->command); 16262306a36Sopenharmony_ci udelay(1); 16362306a36Sopenharmony_ci writeb(CMD_FLUSH, ®s->command); 16462306a36Sopenharmony_ci udelay(1); 16562306a36Sopenharmony_ci writeb(cmd->device->id, ®s->dest_id); 16662306a36Sopenharmony_ci writeb(0, ®s->sync_period); 16762306a36Sopenharmony_ci writeb(0, ®s->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], ®s->fifo); 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_ci /* do select without ATN XXX */ 17462306a36Sopenharmony_ci writeb(CMD_SELECT, ®s->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(®s->seqstep); 20662306a36Sopenharmony_ci stat = readb(®s->status); 20762306a36Sopenharmony_ci intr = readb(®s->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, ®s->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, ®s->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, ®s->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, ®s->count_lo); 27262306a36Sopenharmony_ci writeb(nb >> 8, ®s->count_mid); 27362306a36Sopenharmony_ci writeb(CMD_DMA_MODE + CMD_NOP, ®s->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, ®s->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, ®s->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, ®s->count_lo); 30562306a36Sopenharmony_ci writeb(nb >> 8, ®s->count_mid); 30662306a36Sopenharmony_ci writeb(CMD_DMA_MODE + CMD_NOP, ®s->command); 30762306a36Sopenharmony_ci writeb(CMD_DMA_MODE + CMD_XFER_DATA, ®s->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, ®s->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(®s->fifo); 32662306a36Sopenharmony_ci mcmd->message = readb(®s->fifo); 32762306a36Sopenharmony_ci writeb(CMD_ACCEPT_MSG, ®s->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