[mirror_ubuntu-zesty-kernel.git] / drivers / ide / ide-generic.c

/*
 * generic/default IDE host driver
 *
 * Copyright (C) 2004, 2008 Bartlomiej Zolnierkiewicz
 * This code was split off from ide.c.  See it for original copyrights.
 *
 * May be copied or modified under the terms of the GNU General Public License.
 */

/*
 * For special cases new interfaces may be added using sysfs, i.e.
 *
 *	echo -n "0x168:0x36e:10" > /sys/class/ide_generic/add
 *
 * will add an interface using I/O ports 0x168-0x16f/0x36e and IRQ 10.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/ide.h>

#define DRV_NAME	"ide_generic"

static int probe_mask = 0x03;
module_param(probe_mask, int, 0);
MODULE_PARM_DESC(probe_mask, "probe mask for legacy ISA IDE ports");

static ssize_t store_add(struct class *cls, const char *buf, size_t n)
{
	unsigned int base, ctl;
	int irq, rc;
	hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };

	if (sscanf(buf, "%x:%x:%d", &base, &ctl, &irq) != 3)
		return -EINVAL;

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

	rc = ide_host_add(NULL, hws, NULL);
	if (rc)
		return rc;

	return n;
};

static struct class_attribute ide_generic_class_attrs[] = {
	__ATTR(add, S_IWUSR, NULL, store_add),
	__ATTR_NULL
};

static void ide_generic_class_release(struct class *cls)
{
	kfree(cls);
}

static int __init ide_generic_sysfs_init(void)
{
	struct class *cls;
	int rc;

	cls = kzalloc(sizeof(*cls), GFP_KERNEL);
	if (!cls)
		return -ENOMEM;

	cls->name = DRV_NAME;
	cls->owner = THIS_MODULE;
	cls->class_release = ide_generic_class_release;
	cls->class_attrs = ide_generic_class_attrs;

	rc = class_register(cls);
	if (rc) {
		kfree(cls);
		return rc;
	}

	return 0;
}

static int __init ide_generic_init(void)
{
	hw_regs_t hw[MAX_HWIFS], *hws[MAX_HWIFS];
	struct ide_host *host;
	unsigned long io_addr;
	int i, rc;

#ifdef CONFIG_MIPS
	if (!ide_probe_legacy())
		return -ENODEV;
#endif
	printk(KERN_INFO DRV_NAME ": please use \"probe_mask=0x3f\" module "
			 "parameter for probing all legacy ISA IDE ports\n");

	for (i = 0; i < MAX_HWIFS; i++) {
		io_addr = ide_default_io_base(i);

		hws[i] = NULL;

		if ((probe_mask & (1 << i)) && io_addr) {
			if (!request_region(io_addr, 8, DRV_NAME)) {
				printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX "
						"not free.\n",
						DRV_NAME, io_addr, io_addr + 7);
				continue;
			}

			if (!request_region(io_addr + 0x206, 1, DRV_NAME)) {
				printk(KERN_ERR "%s: I/O resource 0x%lX "
						"not free.\n",
						DRV_NAME, io_addr + 0x206);
				release_region(io_addr, 8);
				continue;
			}

			memset(&hw[i], 0, sizeof(hw[i]));
			ide_std_init_ports(&hw[i], io_addr, io_addr + 0x206);
			hw[i].irq = ide_default_irq(io_addr);
			hw[i].chipset = ide_generic;

			hws[i] = &hw[i];
		}
	}

	host = ide_host_alloc_all(NULL, hws);
	if (host == NULL) {
		rc = -ENOMEM;
		goto err;
	}

	rc = ide_host_register(host, NULL, hws);
	if (rc)
		goto err_free;

	if (ide_generic_sysfs_init())
		printk(KERN_ERR DRV_NAME ": failed to create ide_generic "
					 "class\n");

	return 0;
err_free:
	ide_host_free(host);
err:
	for (i = 0; i < MAX_HWIFS; i++) {
		if (hws[i] == NULL)
			continue;

		io_addr = hws[i]->io_ports.data_addr;
		release_region(io_addr + 0x206, 1);
		release_region(io_addr, 8);
	}
	return rc;
}

module_init(ide_generic_init);

MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4 LT	1	/*
	2	* generic/default IDE host driver
	3	*
f0298512	4	* Copyright (C) 2004, 2008 Bartlomiej Zolnierkiewicz
1da177e4 LT	5	* This code was split off from ide.c. See it for original copyrights.
	6	*
	7	* May be copied or modified under the terms of the GNU General Public License.
	8	*/
	9
f0298512 BZ	10	/*
	11	* For special cases new interfaces may be added using sysfs, i.e.
	12	*
	13	* echo -n "0x168:0x36e:10" > /sys/class/ide_generic/add
	14	*
	15	* will add an interface using I/O ports 0x168-0x16f/0x36e and IRQ 10.
	16	*/
	17
1da177e4 LT	18	#include <linux/kernel.h>
	19	#include <linux/init.h>
	20	#include <linux/module.h>
	21	#include <linux/ide.h>
	22
f0298512 BZ	23	#define DRV_NAME "ide_generic"
f0298512 BZ	24
0cbccbc3 BZ	25	static int probe_mask = 0x03;
	26	module_param(probe_mask, int, 0);
	27	MODULE_PARM_DESC(probe_mask, "probe mask for legacy ISA IDE ports");
	28
f0298512 BZ	29	static ssize_t store_add(struct class cls, const char buf, size_t n)
f0298512 BZ	30	{
f0298512	31	unsigned int base, ctl;
6f904d01	32	int irq, rc;
c97c6aca	33	hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
f0298512 BZ	34
	35	if (sscanf(buf, "%x:%x:%d", &base, &ctl, &irq) != 3)
	36	return -EINVAL;
	37
f0298512 BZ	38	memset(&hw, 0, sizeof(hw));
	39	ide_std_init_ports(&hw, base, ctl);
	40	hw.irq = irq;
	41	hw.chipset = ide_generic;
	42
6f904d01 BZ	43	rc = ide_host_add(NULL, hws, NULL);
	44	if (rc)
	45	return rc;
f0298512 BZ	46
	47	return n;
	48	};
	49
	50	static struct class_attribute ide_generic_class_attrs[] = {
	51	__ATTR(add, S_IWUSR, NULL, store_add),
	52	__ATTR_NULL
	53	};
	54
	55	static void ide_generic_class_release(struct class *cls)
	56	{
	57	kfree(cls);
	58	}
	59
	60	static int __init ide_generic_sysfs_init(void)
	61	{
	62	struct class *cls;
	63	int rc;
	64
	65	cls = kzalloc(sizeof(*cls), GFP_KERNEL);
	66	if (!cls)
	67	return -ENOMEM;
	68
	69	cls->name = DRV_NAME;
	70	cls->owner = THIS_MODULE;
	71	cls->class_release = ide_generic_class_release;
	72	cls->class_attrs = ide_generic_class_attrs;
	73
	74	rc = class_register(cls);
	75	if (rc) {
	76	kfree(cls);
	77	return rc;
	78	}
	79
	80	return 0;
	81	}
	82
1da177e4 LT	83	static int __init ide_generic_init(void)
1da177e4 LT	84	{
c97c6aca	85	hw_regs_t hw[MAX_HWIFS], *hws[MAX_HWIFS];
48c3c107	86	struct ide_host *host;
8a69580e BZ	87	unsigned long io_addr;
8a69580e BZ	88	int i, rc;
151575e4	89
dbdec839 BZ	90	#ifdef CONFIG_MIPS
	91	if (!ide_probe_legacy())
	92	return -ENODEV;
	93	#endif
0cbccbc3 BZ	94	printk(KERN_INFO DRV_NAME ": please use \"probe_mask=0x3f\" module "
	95	"parameter for probing all legacy ISA IDE ports\n");
	96
b2a53bc6	97	for (i = 0; i < MAX_HWIFS; i++) {
8a69580e	98	io_addr = ide_default_io_base(i);
486c92e2	99
c97c6aca	100	hws[i] = NULL;
16649498	101
0cbccbc3	102	if ((probe_mask & (1 << i)) && io_addr) {
16649498 BZ	103	if (!request_region(io_addr, 8, DRV_NAME)) {
	104	printk(KERN_ERR "%s: I/O resource 0x%lX-0x%lX "
	105	"not free.\n",
	106	DRV_NAME, io_addr, io_addr + 7);
	107	continue;
	108	}
	109
	110	if (!request_region(io_addr + 0x206, 1, DRV_NAME)) {
	111	printk(KERN_ERR "%s: I/O resource 0x%lX "
	112	"not free.\n",
	113	DRV_NAME, io_addr + 0x206);
	114	release_region(io_addr, 8);
	115	continue;
	116	}
	117
c97c6aca BZ	118	memset(&hw[i], 0, sizeof(hw[i]));
	119	ide_std_init_ports(&hw[i], io_addr, io_addr + 0x206);
	120	hw[i].irq = ide_default_irq(io_addr);
	121	hw[i].chipset = ide_generic;
b2a53bc6	122
c97c6aca	123	hws[i] = &hw[i];
16649498	124	}
b2a53bc6	125	}
151575e4	126
48c3c107	127	host = ide_host_alloc_all(NULL, hws);
8a69580e BZ	128	if (host == NULL) {
	129	rc = -ENOMEM;
	130	goto err;
	131	}
	132
	133	rc = ide_host_register(host, NULL, hws);
	134	if (rc)
	135	goto err_free;
1da177e4	136
f0298512 BZ	137	if (ide_generic_sysfs_init())
	138	printk(KERN_ERR DRV_NAME ": failed to create ide_generic "
	139	"class\n");
	140
1da177e4	141	return 0;
8a69580e BZ	142	err_free:
	143	ide_host_free(host);
	144	err:
	145	for (i = 0; i < MAX_HWIFS; i++) {
	146	if (hws[i] == NULL)
	147	continue;
	148
	149	io_addr = hws[i]->io_ports.data_addr;
	150	release_region(io_addr + 0x206, 1);
	151	release_region(io_addr, 8);
	152	}
	153	return rc;
1da177e4 LT	154	}
	155
	156	module_init(ide_generic_init);
	157
	158	MODULE_LICENSE("GPL");