[linux-2.6-block.git] / drivers / scsi / mac_scsi.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Generic Macintosh NCR5380 driver
 *
 * Copyright 1998, Michael Schmitz <mschmitz@lbl.gov>
 *
 * derived in part from:
 */
/*
 * Generic Generic NCR5380 driver
 *
 * Copyright 1995, Russell King
 */

#include <linux/types.h>
#include <linux/module.h>
#include <linux/ioport.h>
#include <linux/init.h>
#include <linux/blkdev.h>
#include <linux/interrupt.h>
#include <linux/platform_device.h>

#include <asm/hwtest.h>
#include <asm/io.h>
#include <asm/macints.h>
#include <asm/setup.h>

#include <scsi/scsi_host.h>

/* Definitions for the core NCR5380 driver. */

#define NCR5380_implementation_fields   int pdma_residual

#define NCR5380_read(reg)           in_8(hostdata->io + ((reg) << 4))
#define NCR5380_write(reg, value)   out_8(hostdata->io + ((reg) << 4), value)

#define NCR5380_dma_xfer_len            macscsi_dma_xfer_len
#define NCR5380_dma_recv_setup          macscsi_pread
#define NCR5380_dma_send_setup          macscsi_pwrite
#define NCR5380_dma_residual            macscsi_dma_residual

#define NCR5380_intr                    macscsi_intr
#define NCR5380_queue_command           macscsi_queue_command
#define NCR5380_abort                   macscsi_abort
#define NCR5380_host_reset              macscsi_host_reset
#define NCR5380_info                    macscsi_info

#include "NCR5380.h"

static int setup_can_queue = -1;
module_param(setup_can_queue, int, 0);
static int setup_cmd_per_lun = -1;
module_param(setup_cmd_per_lun, int, 0);
static int setup_sg_tablesize = -1;
module_param(setup_sg_tablesize, int, 0);
static int setup_use_pdma = -1;
module_param(setup_use_pdma, int, 0);
static int setup_hostid = -1;
module_param(setup_hostid, int, 0);
static int setup_toshiba_delay = -1;
module_param(setup_toshiba_delay, int, 0);

#ifndef MODULE
static int __init mac_scsi_setup(char *str)
{
	int ints[8];

	(void)get_options(str, ARRAY_SIZE(ints), ints);

	if (ints[0] < 1) {
		pr_err("Usage: mac5380=<can_queue>[,<cmd_per_lun>[,<sg_tablesize>[,<hostid>[,<use_tags>[,<use_pdma>[,<toshiba_delay>]]]]]]\n");
		return 0;
	}
	if (ints[0] >= 1)
		setup_can_queue = ints[1];
	if (ints[0] >= 2)
		setup_cmd_per_lun = ints[2];
	if (ints[0] >= 3)
		setup_sg_tablesize = ints[3];
	if (ints[0] >= 4)
		setup_hostid = ints[4];
	/* ints[5] (use_tagged_queuing) is ignored */
	if (ints[0] >= 6)
		setup_use_pdma = ints[6];
	if (ints[0] >= 7)
		setup_toshiba_delay = ints[7];
	return 1;
}

__setup("mac5380=", mac_scsi_setup);
#endif /* !MODULE */

/* Pseudo DMA asm originally by Ove Edlund */

#define CP_IO_TO_MEM(s,d,n)				\
__asm__ __volatile__					\
    ("    cmp.w  #4,%2\n"				\
     "    bls    8f\n"					\
     "    move.w %1,%%d0\n"				\
     "    neg.b  %%d0\n"				\
     "    and.w  #3,%%d0\n"				\
     "    sub.w  %%d0,%2\n"				\
     "    bra    2f\n"					\
     " 1: move.b (%0),(%1)+\n"				\
     " 2: dbf    %%d0,1b\n"				\
     "    move.w %2,%%d0\n"				\
     "    lsr.w  #5,%%d0\n"				\
     "    bra    4f\n"					\
     " 3: move.l (%0),(%1)+\n"				\
     "31: move.l (%0),(%1)+\n"				\
     "32: move.l (%0),(%1)+\n"				\
     "33: move.l (%0),(%1)+\n"				\
     "34: move.l (%0),(%1)+\n"				\
     "35: move.l (%0),(%1)+\n"				\
     "36: move.l (%0),(%1)+\n"				\
     "37: move.l (%0),(%1)+\n"				\
     " 4: dbf    %%d0,3b\n"				\
     "    move.w %2,%%d0\n"				\
     "    lsr.w  #2,%%d0\n"				\
     "    and.w  #7,%%d0\n"				\
     "    bra    6f\n"					\
     " 5: move.l (%0),(%1)+\n"				\
     " 6: dbf    %%d0,5b\n"				\
     "    and.w  #3,%2\n"				\
     "    bra    8f\n"					\
     " 7: move.b (%0),(%1)+\n"				\
     " 8: dbf    %2,7b\n"				\
     "    moveq.l #0, %2\n"				\
     " 9: \n"						\
     ".section .fixup,\"ax\"\n"				\
     "    .even\n"					\
     "91: moveq.l #1, %2\n"				\
     "    jra 9b\n"					\
     "94: moveq.l #4, %2\n"				\
     "    jra 9b\n"					\
     ".previous\n"					\
     ".section __ex_table,\"a\"\n"			\
     "   .align 4\n"					\
     "   .long  1b,91b\n"				\
     "   .long  3b,94b\n"				\
     "   .long 31b,94b\n"				\
     "   .long 32b,94b\n"				\
     "   .long 33b,94b\n"				\
     "   .long 34b,94b\n"				\
     "   .long 35b,94b\n"				\
     "   .long 36b,94b\n"				\
     "   .long 37b,94b\n"				\
     "   .long  5b,94b\n"				\
     "   .long  7b,91b\n"				\
     ".previous"					\
     : "=a"(s), "=a"(d), "=d"(n)			\
     : "0"(s), "1"(d), "2"(n)				\
     : "d0")

static inline int macscsi_pread(struct NCR5380_hostdata *hostdata,
                                unsigned char *dst, int len)
{
	u8 __iomem *s = hostdata->pdma_io + (INPUT_DATA_REG << 4);
	unsigned char *d = dst;
	int n = len;
	int transferred;

	while (!NCR5380_poll_politely(hostdata, BUS_AND_STATUS_REG,
	                              BASR_DRQ | BASR_PHASE_MATCH,
	                              BASR_DRQ | BASR_PHASE_MATCH, HZ / 64)) {
		CP_IO_TO_MEM(s, d, n);

		transferred = d - dst - n;
		hostdata->pdma_residual = len - transferred;

		/* No bus error. */
		if (n == 0)
			return 0;

		/* Target changed phase early? */
		if (NCR5380_poll_politely2(hostdata, STATUS_REG, SR_REQ, SR_REQ,
		                           BUS_AND_STATUS_REG, BASR_ACK, BASR_ACK, HZ / 64) < 0)
			scmd_printk(KERN_ERR, hostdata->connected,
			            "%s: !REQ and !ACK\n", __func__);
		if (!(NCR5380_read(BUS_AND_STATUS_REG) & BASR_PHASE_MATCH))
			return 0;

		dsprintk(NDEBUG_PSEUDO_DMA, hostdata->host,
		         "%s: bus error (%d/%d)\n", __func__, transferred, len);
		NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);
		d = dst + transferred;
		n = len - transferred;
	}

	scmd_printk(KERN_ERR, hostdata->connected,
	            "%s: phase mismatch or !DRQ\n", __func__);
	NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);
	return -1;
}


#define CP_MEM_TO_IO(s,d,n)				\
__asm__ __volatile__					\
    ("    cmp.w  #4,%2\n"				\
     "    bls    8f\n"					\
     "    move.w %0,%%d0\n"				\
     "    neg.b  %%d0\n"				\
     "    and.w  #3,%%d0\n"				\
     "    sub.w  %%d0,%2\n"				\
     "    bra    2f\n"					\
     " 1: move.b (%0)+,(%1)\n"				\
     " 2: dbf    %%d0,1b\n"				\
     "    move.w %2,%%d0\n"				\
     "    lsr.w  #5,%%d0\n"				\
     "    bra    4f\n"					\
     " 3: move.l (%0)+,(%1)\n"				\
     "31: move.l (%0)+,(%1)\n"				\
     "32: move.l (%0)+,(%1)\n"				\
     "33: move.l (%0)+,(%1)\n"				\
     "34: move.l (%0)+,(%1)\n"				\
     "35: move.l (%0)+,(%1)\n"				\
     "36: move.l (%0)+,(%1)\n"				\
     "37: move.l (%0)+,(%1)\n"				\
     " 4: dbf    %%d0,3b\n"				\
     "    move.w %2,%%d0\n"				\
     "    lsr.w  #2,%%d0\n"				\
     "    and.w  #7,%%d0\n"				\
     "    bra    6f\n"					\
     " 5: move.l (%0)+,(%1)\n"				\
     " 6: dbf    %%d0,5b\n"				\
     "    and.w  #3,%2\n"				\
     "    bra    8f\n"					\
     " 7: move.b (%0)+,(%1)\n"				\
     " 8: dbf    %2,7b\n"				\
     "    moveq.l #0, %2\n"				\
     " 9: \n"						\
     ".section .fixup,\"ax\"\n"				\
     "    .even\n"					\
     "91: moveq.l #1, %2\n"				\
     "    jra 9b\n"					\
     "94: moveq.l #4, %2\n"				\
     "    jra 9b\n"					\
     ".previous\n"					\
     ".section __ex_table,\"a\"\n"			\
     "   .align 4\n"					\
     "   .long  1b,91b\n"				\
     "   .long  3b,94b\n"				\
     "   .long 31b,94b\n"				\
     "   .long 32b,94b\n"				\
     "   .long 33b,94b\n"				\
     "   .long 34b,94b\n"				\
     "   .long 35b,94b\n"				\
     "   .long 36b,94b\n"				\
     "   .long 37b,94b\n"				\
     "   .long  5b,94b\n"				\
     "   .long  7b,91b\n"				\
     ".previous"					\
     : "=a"(s), "=a"(d), "=d"(n)			\
     : "0"(s), "1"(d), "2"(n)				\
     : "d0")

static inline int macscsi_pwrite(struct NCR5380_hostdata *hostdata,
                                 unsigned char *src, int len)
{
	unsigned char *s = src;
	u8 __iomem *d = hostdata->pdma_io + (OUTPUT_DATA_REG << 4);
	int n = len;
	int transferred;

	while (!NCR5380_poll_politely(hostdata, BUS_AND_STATUS_REG,
	                              BASR_DRQ | BASR_PHASE_MATCH,
	                              BASR_DRQ | BASR_PHASE_MATCH, HZ / 64)) {
		CP_MEM_TO_IO(s, d, n);

		transferred = s - src - n;
		hostdata->pdma_residual = len - transferred;

		/* Target changed phase early? */
		if (NCR5380_poll_politely2(hostdata, STATUS_REG, SR_REQ, SR_REQ,
		                           BUS_AND_STATUS_REG, BASR_ACK, BASR_ACK, HZ / 64) < 0)
			scmd_printk(KERN_ERR, hostdata->connected,
			            "%s: !REQ and !ACK\n", __func__);
		if (!(NCR5380_read(BUS_AND_STATUS_REG) & BASR_PHASE_MATCH))
			return 0;

		/* No bus error. */
		if (n == 0) {
			if (NCR5380_poll_politely(hostdata, TARGET_COMMAND_REG,
			                          TCR_LAST_BYTE_SENT,
			                          TCR_LAST_BYTE_SENT, HZ / 64) < 0)
				scmd_printk(KERN_ERR, hostdata->connected,
				            "%s: Last Byte Sent timeout\n", __func__);
			return 0;
		}

		dsprintk(NDEBUG_PSEUDO_DMA, hostdata->host,
		         "%s: bus error (%d/%d)\n", __func__, transferred, len);
		NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);
		s = src + transferred;
		n = len - transferred;
	}

	scmd_printk(KERN_ERR, hostdata->connected,
	            "%s: phase mismatch or !DRQ\n", __func__);
	NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);

	return -1;
}

static int macscsi_dma_xfer_len(struct NCR5380_hostdata *hostdata,
                                struct scsi_cmnd *cmd)
{
	if (hostdata->flags & FLAG_NO_PSEUDO_DMA ||
	    cmd->SCp.this_residual < 16)
		return 0;

	return cmd->SCp.this_residual;
}

static int macscsi_dma_residual(struct NCR5380_hostdata *hostdata)
{
	return hostdata->pdma_residual;
}

#include "NCR5380.c"

#define DRV_MODULE_NAME         "mac_scsi"
#define PFX                     DRV_MODULE_NAME ": "

static struct scsi_host_template mac_scsi_template = {
	.module			= THIS_MODULE,
	.proc_name		= DRV_MODULE_NAME,
	.name			= "Macintosh NCR5380 SCSI",
	.info			= macscsi_info,
	.queuecommand		= macscsi_queue_command,
	.eh_abort_handler	= macscsi_abort,
	.eh_host_reset_handler	= macscsi_host_reset,
	.can_queue		= 16,
	.this_id		= 7,
	.sg_tablesize		= 1,
	.cmd_per_lun		= 2,
	.dma_boundary		= PAGE_SIZE - 1,
	.cmd_size		= NCR5380_CMD_SIZE,
	.max_sectors		= 128,
};

static int __init mac_scsi_probe(struct platform_device *pdev)
{
	struct Scsi_Host *instance;
	struct NCR5380_hostdata *hostdata;
	int error;
	int host_flags = 0;
	struct resource *irq, *pio_mem, *pdma_mem = NULL;

	pio_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!pio_mem)
		return -ENODEV;

	pdma_mem = platform_get_resource(pdev, IORESOURCE_MEM, 1);

	irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);

	if (!hwreg_present((unsigned char *)pio_mem->start +
	                   (STATUS_REG << 4))) {
		pr_info(PFX "no device detected at %pap\n", &pio_mem->start);
		return -ENODEV;
	}

	if (setup_can_queue > 0)
		mac_scsi_template.can_queue = setup_can_queue;
	if (setup_cmd_per_lun > 0)
		mac_scsi_template.cmd_per_lun = setup_cmd_per_lun;
	if (setup_sg_tablesize >= 0)
		mac_scsi_template.sg_tablesize = setup_sg_tablesize;
	if (setup_hostid >= 0)
		mac_scsi_template.this_id = setup_hostid & 7;

	instance = scsi_host_alloc(&mac_scsi_template,
	                           sizeof(struct NCR5380_hostdata));
	if (!instance)
		return -ENOMEM;

	if (irq)
		instance->irq = irq->start;
	else
		instance->irq = NO_IRQ;

	hostdata = shost_priv(instance);
	hostdata->base = pio_mem->start;
	hostdata->io = (u8 __iomem *)pio_mem->start;

	if (pdma_mem && setup_use_pdma)
		hostdata->pdma_io = (u8 __iomem *)pdma_mem->start;
	else
		host_flags |= FLAG_NO_PSEUDO_DMA;

	host_flags |= setup_toshiba_delay > 0 ? FLAG_TOSHIBA_DELAY : 0;

	error = NCR5380_init(instance, host_flags | FLAG_LATE_DMA_SETUP);
	if (error)
		goto fail_init;

	if (instance->irq != NO_IRQ) {
		error = request_irq(instance->irq, macscsi_intr, IRQF_SHARED,
		                    "NCR5380", instance);
		if (error)
			goto fail_irq;
	}

	NCR5380_maybe_reset_bus(instance);

	error = scsi_add_host(instance, NULL);
	if (error)
		goto fail_host;

	platform_set_drvdata(pdev, instance);

	scsi_scan_host(instance);
	return 0;

fail_host:
	if (instance->irq != NO_IRQ)
		free_irq(instance->irq, instance);
fail_irq:
	NCR5380_exit(instance);
fail_init:
	scsi_host_put(instance);
	return error;
}

static int __exit mac_scsi_remove(struct platform_device *pdev)
{
	struct Scsi_Host *instance = platform_get_drvdata(pdev);

	scsi_remove_host(instance);
	if (instance->irq != NO_IRQ)
		free_irq(instance->irq, instance);
	NCR5380_exit(instance);
	scsi_host_put(instance);
	return 0;
}

static struct platform_driver mac_scsi_driver = {
	.remove = __exit_p(mac_scsi_remove),
	.driver = {
		.name	= DRV_MODULE_NAME,
	},
};

module_platform_driver_probe(mac_scsi_driver, mac_scsi_probe);

MODULE_ALIAS("platform:" DRV_MODULE_NAME);
MODULE_LICENSE("GPL");
Commit	Line	Data
09c434b8	1	// SPDX-License-Identifier: GPL-2.0-only
1da177e4 LT	2	/*
	3	* Generic Macintosh NCR5380 driver
	4	*
	5	* Copyright 1998, Michael Schmitz <mschmitz@lbl.gov>
	6	*
	7	* derived in part from:
	8	*/
	9	/*
	10	* Generic Generic NCR5380 driver
	11	*
	12	* Copyright 1995, Russell King
1da177e4 LT	13	*/
1da177e4 LT	14
1da177e4	15	#include <linux/types.h>
1da177e4	16	#include <linux/module.h>
1da177e4 LT	17	#include <linux/ioport.h>
	18	#include <linux/init.h>
	19	#include <linux/blkdev.h>
	20	#include <linux/interrupt.h>
cbad48de	21	#include <linux/platform_device.h>
1da177e4	22
cbad48de	23	#include <asm/hwtest.h>
1da177e4	24	#include <asm/io.h>
1da177e4	25	#include <asm/macints.h>
cbad48de	26	#include <asm/setup.h>
1da177e4	27
1da177e4	28	#include <scsi/scsi_host.h>
92de3831 FT	29
92de3831 FT	30	/* Definitions for the core NCR5380 driver. */
e744fdea	31
820682b1	32	#define NCR5380_implementation_fields int pdma_residual
92de3831	33
61e1ce58 FT	34	#define NCR5380_read(reg) in_8(hostdata->io + ((reg) << 4))
61e1ce58 FT	35	#define NCR5380_write(reg, value) out_8(hostdata->io + ((reg) << 4), value)
92de3831	36
4a98f896	37	#define NCR5380_dma_xfer_len macscsi_dma_xfer_len
6c4b88ca FT	38	#define NCR5380_dma_recv_setup macscsi_pread
6c4b88ca FT	39	#define NCR5380_dma_send_setup macscsi_pwrite
4a98f896	40	#define NCR5380_dma_residual macscsi_dma_residual
92de3831 FT	41
	42	#define NCR5380_intr macscsi_intr
	43	#define NCR5380_queue_command macscsi_queue_command
	44	#define NCR5380_abort macscsi_abort
12e5fc66	45	#define NCR5380_host_reset macscsi_host_reset
92de3831	46	#define NCR5380_info macscsi_info
92de3831	47
1da177e4 LT	48	#include "NCR5380.h"
1da177e4 LT	49
1da177e4	50	static int setup_can_queue = -1;
6e9ae6d5	51	module_param(setup_can_queue, int, 0);
1da177e4	52	static int setup_cmd_per_lun = -1;
6e9ae6d5	53	module_param(setup_cmd_per_lun, int, 0);
1da177e4	54	static int setup_sg_tablesize = -1;
6e9ae6d5	55	module_param(setup_sg_tablesize, int, 0);
1da177e4	56	static int setup_use_pdma = -1;
6e9ae6d5	57	module_param(setup_use_pdma, int, 0);
1da177e4	58	static int setup_hostid = -1;
6e9ae6d5	59	module_param(setup_hostid, int, 0);
9c3f0e2b FT	60	static int setup_toshiba_delay = -1;
9c3f0e2b FT	61	module_param(setup_toshiba_delay, int, 0);
1da177e4	62
6e9ae6d5 FT	63	#ifndef MODULE
	64	static int __init mac_scsi_setup(char *str)
	65	{
9c3f0e2b	66	int ints[8];
6e9ae6d5 FT	67
	68	(void)get_options(str, ARRAY_SIZE(ints), ints);
	69
9c3f0e2b FT	70	if (ints[0] < 1) {
9c3f0e2b FT	71	pr_err("Usage: mac5380=<can_queue>[,<cmd_per_lun>[,<sg_tablesize>[,<hostid>[,<use_tags>[,<use_pdma>[,<toshiba_delay>]]]]]]\n");
6e9ae6d5	72	return 0;
1da177e4	73	}
6e9ae6d5 FT	74	if (ints[0] >= 1)
	75	setup_can_queue = ints[1];
	76	if (ints[0] >= 2)
	77	setup_cmd_per_lun = ints[2];
	78	if (ints[0] >= 3)
	79	setup_sg_tablesize = ints[3];
	80	if (ints[0] >= 4)
	81	setup_hostid = ints[4];
c4ec6f92	82	/* ints[5] (use_tagged_queuing) is ignored */
6e9ae6d5	83	if (ints[0] >= 6)
1da177e4	84	setup_use_pdma = ints[6];
9c3f0e2b FT	85	if (ints[0] >= 7)
9c3f0e2b FT	86	setup_toshiba_delay = ints[7];
1da177e4 LT	87	return 1;
	88	}
	89
	90	__setup("mac5380=", mac_scsi_setup);
6e9ae6d5	91	#endif /* !MODULE */
1da177e4	92
3a0f64bf FT	93	/* Pseudo DMA asm originally by Ove Edlund */
	94
	95	#define CP_IO_TO_MEM(s,d,n) \
1da177e4 LT	96	__asm__ __volatile__ \
	97	(" cmp.w #4,%2\n" \
	98	" bls 8f\n" \
	99	" move.w %1,%%d0\n" \
	100	" neg.b %%d0\n" \
	101	" and.w #3,%%d0\n" \
	102	" sub.w %%d0,%2\n" \
	103	" bra 2f\n" \
	104	" 1: move.b (%0),(%1)+\n" \
	105	" 2: dbf %%d0,1b\n" \
	106	" move.w %2,%%d0\n" \
	107	" lsr.w #5,%%d0\n" \
	108	" bra 4f\n" \
	109	" 3: move.l (%0),(%1)+\n" \
	110	"31: move.l (%0),(%1)+\n" \
	111	"32: move.l (%0),(%1)+\n" \
	112	"33: move.l (%0),(%1)+\n" \
	113	"34: move.l (%0),(%1)+\n" \
	114	"35: move.l (%0),(%1)+\n" \
	115	"36: move.l (%0),(%1)+\n" \
	116	"37: move.l (%0),(%1)+\n" \
	117	" 4: dbf %%d0,3b\n" \
	118	" move.w %2,%%d0\n" \
	119	" lsr.w #2,%%d0\n" \
	120	" and.w #7,%%d0\n" \
	121	" bra 6f\n" \
	122	" 5: move.l (%0),(%1)+\n" \
	123	" 6: dbf %%d0,5b\n" \
	124	" and.w #3,%2\n" \
	125	" bra 8f\n" \
	126	" 7: move.b (%0),(%1)+\n" \
	127	" 8: dbf %2,7b\n" \
	128	" moveq.l #0, %2\n" \
	129	" 9: \n" \
	130	".section .fixup,\"ax\"\n" \
	131	" .even\n" \
3a0f64bf FT	132	"91: moveq.l #1, %2\n" \
	133	" jra 9b\n" \
	134	"94: moveq.l #4, %2\n" \
1da177e4 LT	135	" jra 9b\n" \
	136	".previous\n" \
	137	".section __ex_table,\"a\"\n" \
	138	" .align 4\n" \
3a0f64bf FT	139	" .long 1b,91b\n" \
	140	" .long 3b,94b\n" \
	141	" .long 31b,94b\n" \
	142	" .long 32b,94b\n" \
	143	" .long 33b,94b\n" \
	144	" .long 34b,94b\n" \
	145	" .long 35b,94b\n" \
	146	" .long 36b,94b\n" \
	147	" .long 37b,94b\n" \
	148	" .long 5b,94b\n" \
	149	" .long 7b,91b\n" \
1da177e4	150	".previous" \
3a0f64bf FT	151	: "=a"(s), "=a"(d), "=d"(n) \
3a0f64bf FT	152	: "0"(s), "1"(d), "2"(n) \
1da177e4 LT	153	: "d0")
1da177e4 LT	154
4a98f896 FT	155	static inline int macscsi_pread(struct NCR5380_hostdata *hostdata,
4a98f896 FT	156	unsigned char *dst, int len)
1da177e4	157	{
4ab2a787	158	u8 __iomem *s = hostdata->pdma_io + (INPUT_DATA_REG << 4);
3a0f64bf FT	159	unsigned char *d = dst;
	160	int n = len;
	161	int transferred;
	162
d5d37a0a	163	while (!NCR5380_poll_politely(hostdata, BUS_AND_STATUS_REG,
3a0f64bf FT	164	BASR_DRQ \| BASR_PHASE_MATCH,
	165	BASR_DRQ \| BASR_PHASE_MATCH, HZ / 64)) {
	166	CP_IO_TO_MEM(s, d, n);
	167
	168	transferred = d - dst - n;
	169	hostdata->pdma_residual = len - transferred;
	170
	171	/* No bus error. */
	172	if (n == 0)
	173	return 0;
	174
	175	/* Target changed phase early? */
d5d37a0a	176	if (NCR5380_poll_politely2(hostdata, STATUS_REG, SR_REQ, SR_REQ,
3a0f64bf FT	177	BUS_AND_STATUS_REG, BASR_ACK, BASR_ACK, HZ / 64) < 0)
	178	scmd_printk(KERN_ERR, hostdata->connected,
	179	"%s: !REQ and !ACK\n", __func__);
	180	if (!(NCR5380_read(BUS_AND_STATUS_REG) & BASR_PHASE_MATCH))
	181	return 0;
	182
4a98f896	183	dsprintk(NDEBUG_PSEUDO_DMA, hostdata->host,
3a0f64bf	184	"%s: bus error (%d/%d)\n", __func__, transferred, len);
4a98f896	185	NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);
3a0f64bf FT	186	d = dst + transferred;
3a0f64bf FT	187	n = len - transferred;
ffdede67 FT	188	}
ffdede67 FT	189
3a0f64bf FT	190	scmd_printk(KERN_ERR, hostdata->connected,
3a0f64bf FT	191	"%s: phase mismatch or !DRQ\n", __func__);
4a98f896	192	NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);
3a0f64bf	193	return -1;
1da177e4 LT	194	}
	195
	196
3a0f64bf	197	#define CP_MEM_TO_IO(s,d,n) \
1da177e4 LT	198	__asm__ __volatile__ \
	199	(" cmp.w #4,%2\n" \
	200	" bls 8f\n" \
	201	" move.w %0,%%d0\n" \
	202	" neg.b %%d0\n" \
	203	" and.w #3,%%d0\n" \
	204	" sub.w %%d0,%2\n" \
	205	" bra 2f\n" \
	206	" 1: move.b (%0)+,(%1)\n" \
	207	" 2: dbf %%d0,1b\n" \
	208	" move.w %2,%%d0\n" \
	209	" lsr.w #5,%%d0\n" \
	210	" bra 4f\n" \
	211	" 3: move.l (%0)+,(%1)\n" \
	212	"31: move.l (%0)+,(%1)\n" \
	213	"32: move.l (%0)+,(%1)\n" \
	214	"33: move.l (%0)+,(%1)\n" \
	215	"34: move.l (%0)+,(%1)\n" \
	216	"35: move.l (%0)+,(%1)\n" \
	217	"36: move.l (%0)+,(%1)\n" \
	218	"37: move.l (%0)+,(%1)\n" \
	219	" 4: dbf %%d0,3b\n" \
	220	" move.w %2,%%d0\n" \
	221	" lsr.w #2,%%d0\n" \
	222	" and.w #7,%%d0\n" \
	223	" bra 6f\n" \
	224	" 5: move.l (%0)+,(%1)\n" \
	225	" 6: dbf %%d0,5b\n" \
	226	" and.w #3,%2\n" \
	227	" bra 8f\n" \
	228	" 7: move.b (%0)+,(%1)\n" \
	229	" 8: dbf %2,7b\n" \
	230	" moveq.l #0, %2\n" \
	231	" 9: \n" \
	232	".section .fixup,\"ax\"\n" \
	233	" .even\n" \
3a0f64bf FT	234	"91: moveq.l #1, %2\n" \
	235	" jra 9b\n" \
	236	"94: moveq.l #4, %2\n" \
1da177e4 LT	237	" jra 9b\n" \
	238	".previous\n" \
	239	".section __ex_table,\"a\"\n" \
	240	" .align 4\n" \
3a0f64bf FT	241	" .long 1b,91b\n" \
	242	" .long 3b,94b\n" \
	243	" .long 31b,94b\n" \
	244	" .long 32b,94b\n" \
	245	" .long 33b,94b\n" \
	246	" .long 34b,94b\n" \
	247	" .long 35b,94b\n" \
	248	" .long 36b,94b\n" \
	249	" .long 37b,94b\n" \
	250	" .long 5b,94b\n" \
	251	" .long 7b,91b\n" \
1da177e4	252	".previous" \
3a0f64bf FT	253	: "=a"(s), "=a"(d), "=d"(n) \
3a0f64bf FT	254	: "0"(s), "1"(d), "2"(n) \
1da177e4 LT	255	: "d0")
1da177e4 LT	256
4a98f896 FT	257	static inline int macscsi_pwrite(struct NCR5380_hostdata *hostdata,
4a98f896 FT	258	unsigned char *src, int len)
1da177e4	259	{
3a0f64bf	260	unsigned char *s = src;
4ab2a787	261	u8 __iomem *d = hostdata->pdma_io + (OUTPUT_DATA_REG << 4);
3a0f64bf FT	262	int n = len;
	263	int transferred;
	264
d5d37a0a	265	while (!NCR5380_poll_politely(hostdata, BUS_AND_STATUS_REG,
3a0f64bf FT	266	BASR_DRQ \| BASR_PHASE_MATCH,
	267	BASR_DRQ \| BASR_PHASE_MATCH, HZ / 64)) {
	268	CP_MEM_TO_IO(s, d, n);
	269
	270	transferred = s - src - n;
	271	hostdata->pdma_residual = len - transferred;
	272
	273	/* Target changed phase early? */
d5d37a0a	274	if (NCR5380_poll_politely2(hostdata, STATUS_REG, SR_REQ, SR_REQ,
3a0f64bf FT	275	BUS_AND_STATUS_REG, BASR_ACK, BASR_ACK, HZ / 64) < 0)
	276	scmd_printk(KERN_ERR, hostdata->connected,
	277	"%s: !REQ and !ACK\n", __func__);
	278	if (!(NCR5380_read(BUS_AND_STATUS_REG) & BASR_PHASE_MATCH))
	279	return 0;
	280
	281	/* No bus error. */
	282	if (n == 0) {
d5d37a0a	283	if (NCR5380_poll_politely(hostdata, TARGET_COMMAND_REG,
3a0f64bf FT	284	TCR_LAST_BYTE_SENT,
	285	TCR_LAST_BYTE_SENT, HZ / 64) < 0)
	286	scmd_printk(KERN_ERR, hostdata->connected,
	287	"%s: Last Byte Sent timeout\n", __func__);
	288	return 0;
	289	}
	290
4a98f896	291	dsprintk(NDEBUG_PSEUDO_DMA, hostdata->host,
3a0f64bf	292	"%s: bus error (%d/%d)\n", __func__, transferred, len);
4a98f896	293	NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);
3a0f64bf FT	294	s = src + transferred;
3a0f64bf FT	295	n = len - transferred;
ffdede67 FT	296	}
ffdede67 FT	297
3a0f64bf FT	298	scmd_printk(KERN_ERR, hostdata->connected,
3a0f64bf FT	299	"%s: phase mismatch or !DRQ\n", __func__);
4a98f896	300	NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host);
ffdede67	301
3a0f64bf	302	return -1;
ffdede67	303	}
1da177e4	304
4a98f896	305	static int macscsi_dma_xfer_len(struct NCR5380_hostdata *hostdata,
7e9ec8d9 FT	306	struct scsi_cmnd *cmd)
7e9ec8d9 FT	307	{
3a0f64bf FT	308	if (hostdata->flags & FLAG_NO_PSEUDO_DMA \|\|
3a0f64bf FT	309	cmd->SCp.this_residual < 16)
7e9ec8d9 FT	310	return 0;
7e9ec8d9 FT	311
3a0f64bf	312	return cmd->SCp.this_residual;
7e9ec8d9 FT	313	}
7e9ec8d9 FT	314
4a98f896 FT	315	static int macscsi_dma_residual(struct NCR5380_hostdata *hostdata)
	316	{
	317	return hostdata->pdma_residual;
	318	}
	319
1da177e4 LT	320	#include "NCR5380.c"
1da177e4 LT	321
cbad48de FT	322	#define DRV_MODULE_NAME "mac_scsi"
	323	#define PFX DRV_MODULE_NAME ": "
	324
	325	static struct scsi_host_template mac_scsi_template = {
aa2e2cb1 FT	326	.module = THIS_MODULE,
aa2e2cb1 FT	327	.proc_name = DRV_MODULE_NAME,
aa2e2cb1 FT	328	.name = "Macintosh NCR5380 SCSI",
	329	.info = macscsi_info,
	330	.queuecommand = macscsi_queue_command,
	331	.eh_abort_handler = macscsi_abort,
12e5fc66	332	.eh_host_reset_handler = macscsi_host_reset,
aa2e2cb1 FT	333	.can_queue = 16,
aa2e2cb1 FT	334	.this_id = 7,
3a0f64bf	335	.sg_tablesize = 1,
aa2e2cb1	336	.cmd_per_lun = 2,
4af14d11	337	.dma_boundary = PAGE_SIZE - 1,
32b26a10	338	.cmd_size = NCR5380_CMD_SIZE,
0a4e3612	339	.max_sectors = 128,
1da177e4 LT	340	};
1da177e4 LT	341
cbad48de FT	342	static int __init mac_scsi_probe(struct platform_device *pdev)
	343	{
	344	struct Scsi_Host *instance;
820682b1	345	struct NCR5380_hostdata *hostdata;
cbad48de FT	346	int error;
	347	int host_flags = 0;
	348	struct resource irq, pio_mem, *pdma_mem = NULL;
	349
	350	pio_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	351	if (!pio_mem)
	352	return -ENODEV;
	353
cbad48de	354	pdma_mem = platform_get_resource(pdev, IORESOURCE_MEM, 1);
cbad48de FT	355
	356	irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
	357
	358	if (!hwreg_present((unsigned char *)pio_mem->start +
	359	(STATUS_REG << 4))) {
	360	pr_info(PFX "no device detected at %pap\n", &pio_mem->start);
	361	return -ENODEV;
	362	}
	363
	364	if (setup_can_queue > 0)
	365	mac_scsi_template.can_queue = setup_can_queue;
	366	if (setup_cmd_per_lun > 0)
	367	mac_scsi_template.cmd_per_lun = setup_cmd_per_lun;
	368	if (setup_sg_tablesize >= 0)
	369	mac_scsi_template.sg_tablesize = setup_sg_tablesize;
	370	if (setup_hostid >= 0)
	371	mac_scsi_template.this_id = setup_hostid & 7;
cbad48de FT	372
	373	instance = scsi_host_alloc(&mac_scsi_template,
	374	sizeof(struct NCR5380_hostdata));
	375	if (!instance)
	376	return -ENOMEM;
	377
cbad48de FT	378	if (irq)
	379	instance->irq = irq->start;
	380	else
	381	instance->irq = NO_IRQ;
	382
820682b1 FT	383	hostdata = shost_priv(instance);
820682b1 FT	384	hostdata->base = pio_mem->start;
4ab2a787	385	hostdata->io = (u8 __iomem *)pio_mem->start;
cbad48de	386
820682b1	387	if (pdma_mem && setup_use_pdma)
4ab2a787	388	hostdata->pdma_io = (u8 __iomem *)pdma_mem->start;
820682b1	389	else
cbad48de FT	390	host_flags \|= FLAG_NO_PSEUDO_DMA;
cbad48de FT	391
9c3f0e2b	392	host_flags \|= setup_toshiba_delay > 0 ? FLAG_TOSHIBA_DELAY : 0;
ca513fc9	393
8053b0ee	394	error = NCR5380_init(instance, host_flags \| FLAG_LATE_DMA_SETUP);
0ad0eff9 FT	395	if (error)
0ad0eff9 FT	396	goto fail_init;
cbad48de FT	397
	398	if (instance->irq != NO_IRQ) {
	399	error = request_irq(instance->irq, macscsi_intr, IRQF_SHARED,
	400	"NCR5380", instance);
	401	if (error)
	402	goto fail_irq;
	403	}
	404
9c3f0e2b FT	405	NCR5380_maybe_reset_bus(instance);
9c3f0e2b FT	406
cbad48de FT	407	error = scsi_add_host(instance, NULL);
	408	if (error)
	409	goto fail_host;
	410
	411	platform_set_drvdata(pdev, instance);
	412
	413	scsi_scan_host(instance);
	414	return 0;
	415
	416	fail_host:
	417	if (instance->irq != NO_IRQ)
	418	free_irq(instance->irq, instance);
	419	fail_irq:
	420	NCR5380_exit(instance);
0ad0eff9	421	fail_init:
cbad48de FT	422	scsi_host_put(instance);
	423	return error;
	424	}
	425
	426	static int __exit mac_scsi_remove(struct platform_device *pdev)
	427	{
	428	struct Scsi_Host *instance = platform_get_drvdata(pdev);
	429
	430	scsi_remove_host(instance);
	431	if (instance->irq != NO_IRQ)
	432	free_irq(instance->irq, instance);
	433	NCR5380_exit(instance);
	434	scsi_host_put(instance);
	435	return 0;
	436	}
	437
	438	static struct platform_driver mac_scsi_driver = {
	439	.remove = __exit_p(mac_scsi_remove),
	440	.driver = {
	441	.name = DRV_MODULE_NAME,
cbad48de FT	442	},
cbad48de FT	443	};
1da177e4	444
cbad48de	445	module_platform_driver_probe(mac_scsi_driver, mac_scsi_probe);
6e9ae6d5	446
cbad48de	447	MODULE_ALIAS("platform:" DRV_MODULE_NAME);
6e9ae6d5	448	MODULE_LICENSE("GPL");