[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / ide / ide-pnp.c

/*
 * This file provides autodetection for ISA PnP IDE interfaces.
 * It was tested with "ESS ES1868 Plug and Play AudioDrive" IDE interface.
 *
 * Copyright (C) 2000 Andrey Panin <pazke@donpac.ru>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * You should have received a copy of the GNU General Public License
 * (for example /usr/src/linux/COPYING); if not, write to the Free
 * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/init.h>
#include <linux/pnp.h>
#include <linux/ide.h>

#define DRV_NAME "ide-pnp"

/* Add your devices here :)) */
static struct pnp_device_id idepnp_devices[] = {
	/* Generic ESDI/IDE/ATA compatible hard disk controller */
	{.id = "PNP0600", .driver_data = 0},
	{.id = ""}
};

static int idepnp_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id)
{
	ide_hwif_t *hwif;
	unsigned long base, ctl;
	hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };

	printk(KERN_INFO DRV_NAME ": generic PnP IDE interface\n");

	if (!(pnp_port_valid(dev, 0) && pnp_port_valid(dev, 1) && pnp_irq_valid(dev, 0)))
		return -1;

	base = pnp_port_start(dev, 0);
	ctl = pnp_port_start(dev, 1);

	if (!request_region(base, 8, DRV_NAME)) {
		printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX not free.\n",
				DRV_NAME, base, base + 7);
		return -EBUSY;
	}

	if (!request_region(ctl, 1, DRV_NAME)) {
		printk(KERN_ERR "%s: I/O resource 0x%lX not free.\n",
				DRV_NAME, ctl);
		release_region(base, 8);
		return -EBUSY;
	}

	memset(&hw, 0, sizeof(hw));
	ide_std_init_ports(&hw, base, ctl);
	hw.irq = pnp_irq(dev, 0);
	hw.chipset = ide_generic;

	hwif = ide_find_port();
	if (hwif) {
		u8 index = hwif->index;
		u8 idx[4] = { index, 0xff, 0xff, 0xff };

		pnp_set_drvdata(dev, hwif);

		ide_device_add(idx, NULL, hws);

		return 0;
	}

	release_region(ctl, 1);
	release_region(base, 8);

	return -1;
}

static void idepnp_remove(struct pnp_dev *dev)
{
	ide_hwif_t *hwif = pnp_get_drvdata(dev);

	ide_unregister(hwif);

	release_region(pnp_port_start(dev, 1), 1);
	release_region(pnp_port_start(dev, 0), 8);
}

static struct pnp_driver idepnp_driver = {
	.name		= "ide",
	.id_table	= idepnp_devices,
	.probe		= idepnp_probe,
	.remove		= idepnp_remove,
};

static int __init pnpide_init(void)
{
	return pnp_register_driver(&idepnp_driver);
}

static void __exit pnpide_exit(void)
{
	pnp_unregister_driver(&idepnp_driver);
}

module_init(pnpide_init);
module_exit(pnpide_exit);

MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4	1	/*
1da177e4 LT	2	* This file provides autodetection for ISA PnP IDE interfaces.
	3	* It was tested with "ESS ES1868 Plug and Play AudioDrive" IDE interface.
	4	*
	5	* Copyright (C) 2000 Andrey Panin <pazke@donpac.ru>
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2, or (at your option)
	10	* any later version.
	11	*
	12	* You should have received a copy of the GNU General Public License
	13	* (for example /usr/src/linux/COPYING); if not, write to the Free
177b8fe9	14	* Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
1da177e4 LT	15	*/
	16
	17	#include <linux/init.h>
	18	#include <linux/pnp.h>
	19	#include <linux/ide.h>
	20
134d4548 BZ	21	#define DRV_NAME "ide-pnp"
134d4548 BZ	22
1da177e4 LT	23	/* Add your devices here :)) */
1da177e4 LT	24	static struct pnp_device_id idepnp_devices[] = {
177b8fe9	25	/* Generic ESDI/IDE/ATA compatible hard disk controller */
1da177e4 LT	26	{.id = "PNP0600", .driver_data = 0},
	27	{.id = ""}
	28	};
	29
177b8fe9	30	static int idepnp_probe(struct pnp_dev dev, const struct pnp_device_id dev_id)
1da177e4	31	{
1da177e4	32	ide_hwif_t *hwif;
134d4548	33	unsigned long base, ctl;
c97c6aca	34	hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
1da177e4	35
e193c3e1 BZ	36	printk(KERN_INFO DRV_NAME ": generic PnP IDE interface\n");
e193c3e1 BZ	37
1da177e4 LT	38	if (!(pnp_port_valid(dev, 0) && pnp_port_valid(dev, 1) && pnp_irq_valid(dev, 0)))
	39	return -1;
	40
134d4548 BZ	41	base = pnp_port_start(dev, 0);
	42	ctl = pnp_port_start(dev, 1);
	43
	44	if (!request_region(base, 8, DRV_NAME)) {
	45	printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX not free.\n",
	46	DRV_NAME, base, base + 7);
	47	return -EBUSY;
	48	}
	49
	50	if (!request_region(ctl, 1, DRV_NAME)) {
	51	printk(KERN_ERR "%s: I/O resource 0x%lX not free.\n",
	52	DRV_NAME, ctl);
	53	release_region(base, 8);
	54	return -EBUSY;
	55	}
	56
1da177e4	57	memset(&hw, 0, sizeof(hw));
134d4548	58	ide_std_init_ports(&hw, base, ctl);
1da177e4	59	hw.irq = pnp_irq(dev, 0);
d427e836	60	hw.chipset = ide_generic;
1da177e4	61
59bff5ba	62	hwif = ide_find_port();
cbb010c1 BZ	63	if (hwif) {
cbb010c1 BZ	64	u8 index = hwif->index;
8ac4ce74	65	u8 idx[4] = { index, 0xff, 0xff, 0xff };
cbb010c1	66
177b8fe9	67	pnp_set_drvdata(dev, hwif);
8ac4ce74	68
c97c6aca	69	ide_device_add(idx, NULL, hws);
8ac4ce74	70
1da177e4 LT	71	return 0;
	72	}
	73
134d4548 BZ	74	release_region(ctl, 1);
	75	release_region(base, 8);
	76
1da177e4 LT	77	return -1;
	78	}
	79
177b8fe9	80	static void idepnp_remove(struct pnp_dev *dev)
1da177e4 LT	81	{
1da177e4 LT	82	ide_hwif_t *hwif = pnp_get_drvdata(dev);
f82c2b17	83
387750c3	84	ide_unregister(hwif);
134d4548 BZ	85
	86	release_region(pnp_port_start(dev, 1), 1);
	87	release_region(pnp_port_start(dev, 0), 8);
1da177e4 LT	88	}
	89
	90	static struct pnp_driver idepnp_driver = {
	91	.name = "ide",
	92	.id_table = idepnp_devices,
	93	.probe = idepnp_probe,
	94	.remove = idepnp_remove,
	95	};
	96
ade2daf9	97	static int __init pnpide_init(void)
1da177e4	98	{
ade2daf9	99	return pnp_register_driver(&idepnp_driver);
1da177e4	100	}
6855036a	101
ade2daf9	102	static void __exit pnpide_exit(void)
6855036a TH	103	{
	104	pnp_unregister_driver(&idepnp_driver);
	105	}
ade2daf9 BZ	106
	107	module_init(pnpide_init);
	108	module_exit(pnpide_exit);
a62ee641 AB	109
a62ee641 AB	110	MODULE_LICENSE("GPL");