[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / scsi / mvme16x_scsi.c

/*
 * Detection routine for the NCR53c710 based MVME16x SCSI Controllers for Linux.
 *
 * Based on work by Alan Hourihane
 *
 * Rewritten to use 53c700.c by Kars de Jong <jongk@linux-m68k.org>
 */

#include <linux/module.h>
#include <linux/blkdev.h>
#include <linux/device.h>
#include <linux/platform_device.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/slab.h>
#include <asm/mvme16xhw.h>
#include <scsi/scsi_host.h>
#include <scsi/scsi_device.h>
#include <scsi/scsi_transport.h>
#include <scsi/scsi_transport_spi.h>

#include "53c700.h"

MODULE_AUTHOR("Kars de Jong <jongk@linux-m68k.org>");
MODULE_DESCRIPTION("MVME16x NCR53C710 driver");
MODULE_LICENSE("GPL");

static struct scsi_host_template mvme16x_scsi_driver_template = {
	.name			= "MVME16x NCR53c710 SCSI",
	.proc_name		= "MVME16x",
	.this_id		= 7,
	.module			= THIS_MODULE,
};

static struct platform_device *mvme16x_scsi_device;

static int mvme16x_probe(struct platform_device *dev)
{
	struct Scsi_Host * host = NULL;
	struct NCR_700_Host_Parameters *hostdata;

	if (!MACH_IS_MVME16x)
		goto out;

	if (mvme16x_config & MVME16x_CONFIG_NO_SCSICHIP) {
		printk(KERN_INFO "mvme16x-scsi: detection disabled, "
				 "SCSI chip not present\n");
		goto out;
	}

	hostdata = kzalloc(sizeof(struct NCR_700_Host_Parameters), GFP_KERNEL);
	if (hostdata == NULL) {
		printk(KERN_ERR "mvme16x-scsi: "
				"Failed to allocate host data\n");
		goto out;
	}

	/* Fill in the required pieces of hostdata */
	hostdata->base = (void __iomem *)0xfff47000UL;
	hostdata->clock = 50;	/* XXX - depends on the CPU clock! */
	hostdata->chip710 = 1;
	hostdata->dmode_extra = DMODE_FC2;
	hostdata->dcntl_extra = EA_710;
	hostdata->ctest7_extra = CTEST7_TT1;

	/* and register the chip */
	host = NCR_700_detect(&mvme16x_scsi_driver_template, hostdata,
			      &dev->dev);
	if (!host) {
		printk(KERN_ERR "mvme16x-scsi: No host detected; "
				"board configuration problem?\n");
		goto out_free;
	}
	host->this_id = 7;
	host->base = 0xfff47000UL;
	host->irq = MVME16x_IRQ_SCSI;
	if (request_irq(host->irq, NCR_700_intr, 0, "mvme16x-scsi", host)) {
		printk(KERN_ERR "mvme16x-scsi: request_irq failed\n");
		goto out_put_host;
	}

	/* Enable scsi chip ints */
	{
		volatile unsigned long v;

		/* Enable scsi interrupts at level 4 in PCCchip2 */
		v = in_be32(0xfff4202c);
		v = (v & ~0xff) | 0x10 | 4;
		out_be32(0xfff4202c, v);
	}

	platform_set_drvdata(dev, host);
	scsi_scan_host(host);

	return 0;

 out_put_host:
	scsi_host_put(host);
 out_free:
	kfree(hostdata);
 out:
	return -ENODEV;
}

static int mvme16x_device_remove(struct platform_device *dev)
{
	struct Scsi_Host *host = platform_get_drvdata(dev);
	struct NCR_700_Host_Parameters *hostdata = shost_priv(host);

	/* Disable scsi chip ints */
	{
		volatile unsigned long v;

		v = in_be32(0xfff4202c);
		v &= ~0x10;
		out_be32(0xfff4202c, v);
	}
	scsi_remove_host(host);
	NCR_700_release(host);
	kfree(hostdata);
	free_irq(host->irq, host);

	return 0;
}

static struct platform_driver mvme16x_scsi_driver = {
	.driver = {
		.name           = "mvme16x-scsi",
		.owner          = THIS_MODULE,
	},
	.probe          = mvme16x_probe,
	.remove         = mvme16x_device_remove,
};

static int __init mvme16x_scsi_init(void)
{
	int err;

	err = platform_driver_register(&mvme16x_scsi_driver);
	if (err)
		return err;

	mvme16x_scsi_device = platform_device_register_simple("mvme16x-scsi",
							      -1, NULL, 0);
	if (IS_ERR(mvme16x_scsi_device)) {
		platform_driver_unregister(&mvme16x_scsi_driver);
		return PTR_ERR(mvme16x_scsi_device);
	}

	return 0;
}

static void __exit mvme16x_scsi_exit(void)
{
	platform_device_unregister(mvme16x_scsi_device);
	platform_driver_unregister(&mvme16x_scsi_driver);
}

module_init(mvme16x_scsi_init);
module_exit(mvme16x_scsi_exit);
Commit	Line	Data
506c7bbc KJ	1	/*
	2	* Detection routine for the NCR53c710 based MVME16x SCSI Controllers for Linux.
	3	*
	4	* Based on work by Alan Hourihane
	5	*
	6	* Rewritten to use 53c700.c by Kars de Jong <jongk@linux-m68k.org>
	7	*/
	8
	9	#include <linux/module.h>
	10	#include <linux/blkdev.h>
	11	#include <linux/device.h>
	12	#include <linux/platform_device.h>
	13	#include <linux/init.h>
	14	#include <linux/interrupt.h>
5a0e3ad6	15	#include <linux/slab.h>
506c7bbc KJ	16	#include <asm/mvme16xhw.h>
	17	#include <scsi/scsi_host.h>
	18	#include <scsi/scsi_device.h>
	19	#include <scsi/scsi_transport.h>
	20	#include <scsi/scsi_transport_spi.h>
	21
	22	#include "53c700.h"
	23
	24	MODULE_AUTHOR("Kars de Jong <jongk@linux-m68k.org>");
	25	MODULE_DESCRIPTION("MVME16x NCR53C710 driver");
	26	MODULE_LICENSE("GPL");
	27
	28	static struct scsi_host_template mvme16x_scsi_driver_template = {
	29	.name = "MVME16x NCR53c710 SCSI",
	30	.proc_name = "MVME16x",
	31	.this_id = 7,
	32	.module = THIS_MODULE,
	33	};
	34
	35	static struct platform_device *mvme16x_scsi_device;
	36
6f039790	37	static int mvme16x_probe(struct platform_device *dev)
506c7bbc KJ	38	{
	39	struct Scsi_Host * host = NULL;
	40	struct NCR_700_Host_Parameters *hostdata;
	41
	42	if (!MACH_IS_MVME16x)
	43	goto out;
	44
	45	if (mvme16x_config & MVME16x_CONFIG_NO_SCSICHIP) {
	46	printk(KERN_INFO "mvme16x-scsi: detection disabled, "
	47	"SCSI chip not present\n");
	48	goto out;
	49	}
	50
bbfbbbc1	51	hostdata = kzalloc(sizeof(struct NCR_700_Host_Parameters), GFP_KERNEL);
506c7bbc KJ	52	if (hostdata == NULL) {
	53	printk(KERN_ERR "mvme16x-scsi: "
	54	"Failed to allocate host data\n");
	55	goto out;
	56	}
506c7bbc KJ	57
	58	/* Fill in the required pieces of hostdata */
	59	hostdata->base = (void __iomem *)0xfff47000UL;
	60	hostdata->clock = 50; /* XXX - depends on the CPU clock! */
	61	hostdata->chip710 = 1;
	62	hostdata->dmode_extra = DMODE_FC2;
	63	hostdata->dcntl_extra = EA_710;
	64	hostdata->ctest7_extra = CTEST7_TT1;
	65
	66	/* and register the chip */
e5779a58 GU	67	host = NCR_700_detect(&mvme16x_scsi_driver_template, hostdata,
e5779a58 GU	68	&dev->dev);
506c7bbc KJ	69	if (!host) {
	70	printk(KERN_ERR "mvme16x-scsi: No host detected; "
	71	"board configuration problem?\n");
	72	goto out_free;
	73	}
	74	host->this_id = 7;
	75	host->base = 0xfff47000UL;
	76	host->irq = MVME16x_IRQ_SCSI;
	77	if (request_irq(host->irq, NCR_700_intr, 0, "mvme16x-scsi", host)) {
	78	printk(KERN_ERR "mvme16x-scsi: request_irq failed\n");
	79	goto out_put_host;
	80	}
	81
	82	/* Enable scsi chip ints */
	83	{
	84	volatile unsigned long v;
	85
	86	/* Enable scsi interrupts at level 4 in PCCchip2 */
	87	v = in_be32(0xfff4202c);
	88	v = (v & ~0xff) \| 0x10 \| 4;
	89	out_be32(0xfff4202c, v);
	90	}
	91
7a192ec3	92	platform_set_drvdata(dev, host);
506c7bbc KJ	93	scsi_scan_host(host);
	94
	95	return 0;
	96
	97	out_put_host:
	98	scsi_host_put(host);
	99	out_free:
	100	kfree(hostdata);
	101	out:
	102	return -ENODEV;
	103	}
	104
6f039790	105	static int mvme16x_device_remove(struct platform_device *dev)
506c7bbc	106	{
7a192ec3	107	struct Scsi_Host *host = platform_get_drvdata(dev);
506c7bbc KJ	108	struct NCR_700_Host_Parameters *hostdata = shost_priv(host);
	109
	110	/* Disable scsi chip ints */
	111	{
	112	volatile unsigned long v;
	113
	114	v = in_be32(0xfff4202c);
	115	v &= ~0x10;
	116	out_be32(0xfff4202c, v);
	117	}
	118	scsi_remove_host(host);
	119	NCR_700_release(host);
	120	kfree(hostdata);
	121	free_irq(host->irq, host);
	122
	123	return 0;
	124	}
	125
7a192ec3 ML	126	static struct platform_driver mvme16x_scsi_driver = {
	127	.driver = {
	128	.name = "mvme16x-scsi",
	129	.owner = THIS_MODULE,
	130	},
	131	.probe = mvme16x_probe,
6f039790	132	.remove = mvme16x_device_remove,
506c7bbc KJ	133	};
	134
	135	static int __init mvme16x_scsi_init(void)
	136	{
	137	int err;
	138
7a192ec3	139	err = platform_driver_register(&mvme16x_scsi_driver);
506c7bbc KJ	140	if (err)
	141	return err;
	142
	143	mvme16x_scsi_device = platform_device_register_simple("mvme16x-scsi",
	144	-1, NULL, 0);
	145	if (IS_ERR(mvme16x_scsi_device)) {
7a192ec3	146	platform_driver_unregister(&mvme16x_scsi_driver);
506c7bbc KJ	147	return PTR_ERR(mvme16x_scsi_device);
	148	}
	149
	150	return 0;
	151	}
	152
	153	static void __exit mvme16x_scsi_exit(void)
	154	{
	155	platform_device_unregister(mvme16x_scsi_device);
7a192ec3	156	platform_driver_unregister(&mvme16x_scsi_driver);
506c7bbc KJ	157	}
	158
	159	module_init(mvme16x_scsi_init);
	160	module_exit(mvme16x_scsi_exit);