[net-next-2.6.git] / drivers / usb / host / sl811_cs.c

/*
 * PCMCIA driver for SL811HS (as found in REX-CFU1U)
 * Filename: sl811_cs.c
 * Author:   Yukio Yamamoto
 *
 *  Port to sl811-hcd and 2.6.x by
 *    Botond Botyanszki <boti@rocketmail.com>
 *    Simon Pickering
 *
 *  Last update: 2005-05-12
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/ptrace.h>
#include <linux/slab.h>
#include <linux/string.h>
#include <linux/timer.h>
#include <linux/ioport.h>
#include <linux/platform_device.h>

#include <pcmcia/cs_types.h>
#include <pcmcia/cs.h>
#include <pcmcia/cistpl.h>
#include <pcmcia/cisreg.h>
#include <pcmcia/ds.h>

#include <linux/usb/sl811.h>

MODULE_AUTHOR("Botond Botyanszki");
MODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6");
MODULE_LICENSE("GPL");


/*====================================================================*/
/* MACROS                                                             */
/*====================================================================*/

#if defined(DEBUG) || defined(PCMCIA_DEBUG)

static int pc_debug = 0;
module_param(pc_debug, int, 0644);

#define DBG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG "sl811_cs: " args)

#else
#define DBG(n, args...) do{}while(0)
#endif	/* no debugging */

#define INFO(args...) printk(KERN_INFO "sl811_cs: " args)

#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)

#define CS_CHECK(fn, ret) \
	do { \
		last_fn = (fn); \
		if ((last_ret = (ret)) != 0) \
			goto cs_failed; \
	} while (0)

/*====================================================================*/
/* VARIABLES                                                          */
/*====================================================================*/

static const char driver_name[DEV_NAME_LEN]  = "sl811_cs";

typedef struct local_info_t {
	struct pcmcia_device	*p_dev;
	dev_node_t		node;
} local_info_t;

static void sl811_cs_release(struct pcmcia_device * link);

/*====================================================================*/

static void release_platform_dev(struct device * dev)
{
	DBG(0, "sl811_cs platform_dev release\n");
	dev->parent = NULL;
}

static struct sl811_platform_data platform_data = {
	.potpg		= 100,
	.power		= 50,		/* == 100mA */
	// .reset	= ... FIXME:  invoke CF reset on the card
};

static struct resource resources[] = {
	[0] = {
		.flags	= IORESOURCE_IRQ,
	},
	[1] = {
		// .name   = "address",
		.flags	= IORESOURCE_IO,
	},
	[2] = {
		// .name   = "data",
		.flags	= IORESOURCE_IO,
	},
};

extern struct platform_driver sl811h_driver;

static struct platform_device platform_dev = {
	.id			= -1,
	.dev = {
		.platform_data = &platform_data,
		.release       = release_platform_dev,
	},
	.resource		= resources,
	.num_resources		= ARRAY_SIZE(resources),
};

static int sl811_hc_init(struct device *parent, ioaddr_t base_addr, int irq)
{
	if (platform_dev.dev.parent)
		return -EBUSY;
	platform_dev.dev.parent = parent;

	/* finish seting up the platform device */
	resources[0].start = irq;

	resources[1].start = base_addr;
	resources[1].end = base_addr;

	resources[2].start = base_addr + 1;
	resources[2].end   = base_addr + 1;

	/* The driver core will probe for us.  We know sl811-hcd has been
	 * initialized already because of the link order dependency created
	 * by referencing "sl811h_driver".
	 */
	platform_dev.name = sl811h_driver.driver.name;
	return platform_device_register(&platform_dev);
}

/*====================================================================*/

static void sl811_cs_detach(struct pcmcia_device *link)
{
	DBG(0, "sl811_cs_detach(0x%p)\n", link);

	sl811_cs_release(link);

	/* This points to the parent local_info_t struct */
	kfree(link->priv);
}

static void sl811_cs_release(struct pcmcia_device * link)
{
	DBG(0, "sl811_cs_release(0x%p)\n", link);

	pcmcia_disable_device(link);
	platform_device_unregister(&platform_dev);
}

static int sl811_cs_config(struct pcmcia_device *link)
{
	struct device		*parent = &handle_to_dev(link);
	local_info_t		*dev = link->priv;
	tuple_t			tuple;
	cisparse_t		parse;
	int			last_fn, last_ret;
	u_char			buf[64];
	config_info_t		conf;
	cistpl_cftable_entry_t	dflt = { 0 };

	DBG(0, "sl811_cs_config(0x%p)\n", link);

	/* Look up the current Vcc */
	CS_CHECK(GetConfigurationInfo,
			pcmcia_get_configuration_info(link, &conf));

	tuple.Attributes = 0;
	tuple.TupleData = buf;
	tuple.TupleDataMax = sizeof(buf);
	tuple.TupleOffset = 0;
	tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
	while (1) {
		cistpl_cftable_entry_t	*cfg = &(parse.cftable_entry);

		if (pcmcia_get_tuple_data(link, &tuple) != 0
				|| pcmcia_parse_tuple(link, &tuple, &parse)
						!= 0)
			goto next_entry;

		if (cfg->flags & CISTPL_CFTABLE_DEFAULT) {
			dflt = *cfg;
		}

		if (cfg->index == 0)
			goto next_entry;

		link->conf.ConfigIndex = cfg->index;

		/* Use power settings for Vcc and Vpp if present */
		/*  Note that the CIS values need to be rescaled */
		if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
			if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000
					!= conf.Vcc)
				goto next_entry;
		} else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
			if (dflt.vcc.param[CISTPL_POWER_VNOM]/10000
					!= conf.Vcc)
				goto next_entry;
		}

		if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM))
			link->conf.Vpp =
				cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
		else if (dflt.vpp1.present & (1<<CISTPL_POWER_VNOM))
			link->conf.Vpp =
				dflt.vpp1.param[CISTPL_POWER_VNOM]/10000;

		/* we need an interrupt */
		if (cfg->irq.IRQInfo1 || dflt.irq.IRQInfo1)
			link->conf.Attributes |= CONF_ENABLE_IRQ;

		/* IO window settings */
		link->io.NumPorts1 = link->io.NumPorts2 = 0;
		if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
			cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;

			link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
			link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
			link->io.BasePort1 = io->win[0].base;
			link->io.NumPorts1 = io->win[0].len;

			if (pcmcia_request_io(link, &link->io) != 0)
				goto next_entry;
		}
		break;

next_entry:
		pcmcia_disable_device(link);
		last_ret = pcmcia_get_next_tuple(link, &tuple);
	}

	/* require an IRQ and two registers */
	if (!link->io.NumPorts1 || link->io.NumPorts1 < 2)
		goto cs_failed;
	if (link->conf.Attributes & CONF_ENABLE_IRQ)
		CS_CHECK(RequestIRQ,
			pcmcia_request_irq(link, &link->irq));
	else
		goto cs_failed;

	CS_CHECK(RequestConfiguration,
		pcmcia_request_configuration(link, &link->conf));

	sprintf(dev->node.dev_name, driver_name);
	dev->node.major = dev->node.minor = 0;
	link->dev_node = &dev->node;

	printk(KERN_INFO "%s: index 0x%02x: ",
	       dev->node.dev_name, link->conf.ConfigIndex);
	if (link->conf.Vpp)
		printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10);
	printk(", irq %d", link->irq.AssignedIRQ);
	printk(", io 0x%04x-0x%04x", link->io.BasePort1,
	       link->io.BasePort1+link->io.NumPorts1-1);
	printk("\n");

	if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
			< 0) {
cs_failed:
		printk("sl811_cs_config failed\n");
		cs_error(link, last_fn, last_ret);
		sl811_cs_release(link);
		return  -ENODEV;
	}
	return 0;
}

static int sl811_cs_probe(struct pcmcia_device *link)
{
	local_info_t *local;

	local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
	if (!local)
		return -ENOMEM;
	memset(local, 0, sizeof(local_info_t));
	local->p_dev = link;
	link->priv = local;

	/* Initialize */
	link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
	link->irq.IRQInfo1 = IRQ_INFO2_VALID|IRQ_LEVEL_ID;
	link->irq.Handler = NULL;

	link->conf.Attributes = 0;
	link->conf.IntType = INT_MEMORY_AND_IO;

	return sl811_cs_config(link);
}

static struct pcmcia_device_id sl811_ids[] = {
	PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */
	PCMCIA_DEVICE_NULL,
};
MODULE_DEVICE_TABLE(pcmcia, sl811_ids);

static struct pcmcia_driver sl811_cs_driver = {
	.owner		= THIS_MODULE,
	.drv		= {
		.name	= (char *)driver_name,
	},
	.probe		= sl811_cs_probe,
	.remove		= sl811_cs_detach,
	.id_table	= sl811_ids,
};

/*====================================================================*/

static int __init init_sl811_cs(void)
{
	return pcmcia_register_driver(&sl811_cs_driver);
}
module_init(init_sl811_cs);

static void __exit exit_sl811_cs(void)
{
	pcmcia_unregister_driver(&sl811_cs_driver);
}
module_exit(exit_sl811_cs);
Commit	Line	Data
c6de2b64 DB	1	/*
	2	* PCMCIA driver for SL811HS (as found in REX-CFU1U)
	3	* Filename: sl811_cs.c
	4	* Author: Yukio Yamamoto
	5	*
	6	* Port to sl811-hcd and 2.6.x by
	7	* Botond Botyanszki <boti@rocketmail.com>
	8	* Simon Pickering
	9	*
	10	* Last update: 2005-05-12
	11	*/
	12
	13	#include <linux/kernel.h>
	14	#include <linux/module.h>
	15	#include <linux/init.h>
c6de2b64 DB	16	#include <linux/ptrace.h>
	17	#include <linux/slab.h>
	18	#include <linux/string.h>
	19	#include <linux/timer.h>
	20	#include <linux/ioport.h>
d052d1be	21	#include <linux/platform_device.h>
c6de2b64	22
c6de2b64 DB	23	#include <pcmcia/cs_types.h>
	24	#include <pcmcia/cs.h>
	25	#include <pcmcia/cistpl.h>
	26	#include <pcmcia/cisreg.h>
	27	#include <pcmcia/ds.h>
	28
325a4af6	29	#include <linux/usb/sl811.h>
c6de2b64 DB	30
	31	MODULE_AUTHOR("Botond Botyanszki");
	32	MODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6");
	33	MODULE_LICENSE("GPL");
	34
	35
	36	/====================================================================/
	37	/* MACROS */
	38	/====================================================================/
	39
c9a50cc9	40	#if defined(DEBUG) \|\| defined(PCMCIA_DEBUG)
c6de2b64 DB	41
	42	static int pc_debug = 0;
	43	module_param(pc_debug, int, 0644);
	44
	45	#define DBG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG "sl811_cs: " args)
	46
	47	#else
	48	#define DBG(n, args...) do{}while(0)
	49	#endif /* no debugging */
	50
	51	#define INFO(args...) printk(KERN_INFO "sl811_cs: " args)
	52
	53	#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
	54
	55	#define CS_CHECK(fn, ret) \
	56	do { \
	57	last_fn = (fn); \
	58	if ((last_ret = (ret)) != 0) \
	59	goto cs_failed; \
	60	} while (0)
	61
	62	/====================================================================/
	63	/* VARIABLES */
	64	/====================================================================/
	65
	66	static const char driver_name[DEV_NAME_LEN] = "sl811_cs";
	67
c6de2b64	68	typedef struct local_info_t {
fd238232	69	struct pcmcia_device *p_dev;
c6de2b64 DB	70	dev_node_t node;
	71	} local_info_t;
	72
fba395ee	73	static void sl811_cs_release(struct pcmcia_device * link);
cc3b4866	74
c6de2b64 DB	75	/====================================================================/
	76
	77	static void release_platform_dev(struct device * dev)
	78	{
	79	DBG(0, "sl811_cs platform_dev release\n");
	80	dev->parent = NULL;
	81	}
	82
	83	static struct sl811_platform_data platform_data = {
	84	.potpg = 100,
	85	.power = 50, /* == 100mA */
	86	// .reset = ... FIXME: invoke CF reset on the card
	87	};
	88
	89	static struct resource resources[] = {
	90	[0] = {
	91	.flags = IORESOURCE_IRQ,
	92	},
	93	[1] = {
	94	// .name = "address",
	95	.flags = IORESOURCE_IO,
	96	},
	97	[2] = {
	98	// .name = "data",
	99	.flags = IORESOURCE_IO,
	100	},
	101	};
	102
a0c53f1d	103	extern struct platform_driver sl811h_driver;
c6de2b64 DB	104
	105	static struct platform_device platform_dev = {
	106	.id = -1,
	107	.dev = {
	108	.platform_data = &platform_data,
	109	.release = release_platform_dev,
	110	},
	111	.resource = resources,
	112	.num_resources = ARRAY_SIZE(resources),
	113	};
	114
	115	static int sl811_hc_init(struct device *parent, ioaddr_t base_addr, int irq)
	116	{
	117	if (platform_dev.dev.parent)
	118	return -EBUSY;
	119	platform_dev.dev.parent = parent;
	120
	121	/* finish seting up the platform device */
	122	resources[0].start = irq;
	123
	124	resources[1].start = base_addr;
	125	resources[1].end = base_addr;
	126
	127	resources[2].start = base_addr + 1;
	128	resources[2].end = base_addr + 1;
	129
	130	/* The driver core will probe for us. We know sl811-hcd has been
c9a50cc9 DB	131	* initialized already because of the link order dependency created
c9a50cc9 DB	132	* by referencing "sl811h_driver".
c6de2b64	133	*/
a0c53f1d	134	platform_dev.name = sl811h_driver.driver.name;
c6de2b64 DB	135	return platform_device_register(&platform_dev);
	136	}
	137
	138	/====================================================================/
	139
fba395ee	140	static void sl811_cs_detach(struct pcmcia_device *link)
c6de2b64	141	{
c6de2b64 DB	142	DBG(0, "sl811_cs_detach(0x%p)\n", link);
c6de2b64 DB	143
e2d40963	144	sl811_cs_release(link);
c6de2b64	145
c6de2b64 DB	146	/* This points to the parent local_info_t struct */
	147	kfree(link->priv);
	148	}
	149
fba395ee	150	static void sl811_cs_release(struct pcmcia_device * link)
c6de2b64	151	{
c6de2b64 DB	152	DBG(0, "sl811_cs_release(0x%p)\n", link);
c6de2b64 DB	153
fba395ee	154	pcmcia_disable_device(link);
c6de2b64	155	platform_device_unregister(&platform_dev);
c6de2b64 DB	156	}
c6de2b64 DB	157
15b99ac1	158	static int sl811_cs_config(struct pcmcia_device *link)
c6de2b64	159	{
fba395ee	160	struct device *parent = &handle_to_dev(link);
c6de2b64 DB	161	local_info_t *dev = link->priv;
	162	tuple_t tuple;
	163	cisparse_t parse;
	164	int last_fn, last_ret;
	165	u_char buf[64];
	166	config_info_t conf;
	167	cistpl_cftable_entry_t dflt = { 0 };
	168
	169	DBG(0, "sl811_cs_config(0x%p)\n", link);
	170
c6de2b64 DB	171	/* Look up the current Vcc */
c6de2b64 DB	172	CS_CHECK(GetConfigurationInfo,
fba395ee	173	pcmcia_get_configuration_info(link, &conf));
c6de2b64	174
af2b3b50 DB	175	tuple.Attributes = 0;
	176	tuple.TupleData = buf;
	177	tuple.TupleDataMax = sizeof(buf);
	178	tuple.TupleOffset = 0;
c6de2b64	179	tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
fba395ee	180	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
c6de2b64 DB	181	while (1) {
	182	cistpl_cftable_entry_t *cfg = &(parse.cftable_entry);
	183
fba395ee DB	184	if (pcmcia_get_tuple_data(link, &tuple) != 0
fba395ee DB	185	\|\| pcmcia_parse_tuple(link, &tuple, &parse)
c6de2b64 DB	186	!= 0)
	187	goto next_entry;
	188
	189	if (cfg->flags & CISTPL_CFTABLE_DEFAULT) {
	190	dflt = *cfg;
	191	}
	192
	193	if (cfg->index == 0)
	194	goto next_entry;
	195
	196	link->conf.ConfigIndex = cfg->index;
	197
	198	/* Use power settings for Vcc and Vpp if present */
	199	/* Note that the CIS values need to be rescaled */
	200	if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
	201	if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000
	202	!= conf.Vcc)
	203	goto next_entry;
	204	} else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
	205	if (dflt.vcc.param[CISTPL_POWER_VNOM]/10000
	206	!= conf.Vcc)
	207	goto next_entry;
	208	}
	209
	210	if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM))
70294b46	211	link->conf.Vpp =
c6de2b64 DB	212	cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
c6de2b64 DB	213	else if (dflt.vpp1.present & (1<<CISTPL_POWER_VNOM))
70294b46	214	link->conf.Vpp =
c6de2b64 DB	215	dflt.vpp1.param[CISTPL_POWER_VNOM]/10000;
	216
	217	/* we need an interrupt */
	218	if (cfg->irq.IRQInfo1 \|\| dflt.irq.IRQInfo1)
	219	link->conf.Attributes \|= CONF_ENABLE_IRQ;
	220
	221	/* IO window settings */
	222	link->io.NumPorts1 = link->io.NumPorts2 = 0;
	223	if ((cfg->io.nwin > 0) \|\| (dflt.io.nwin > 0)) {
	224	cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
	225
	226	link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
	227	link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
	228	link->io.BasePort1 = io->win[0].base;
	229	link->io.NumPorts1 = io->win[0].len;
	230
fba395ee	231	if (pcmcia_request_io(link, &link->io) != 0)
c6de2b64 DB	232	goto next_entry;
	233	}
	234	break;
	235
	236	next_entry:
fba395ee DB	237	pcmcia_disable_device(link);
fba395ee DB	238	last_ret = pcmcia_get_next_tuple(link, &tuple);
c6de2b64 DB	239	}
	240
	241	/* require an IRQ and two registers */
	242	if (!link->io.NumPorts1 \|\| link->io.NumPorts1 < 2)
	243	goto cs_failed;
	244	if (link->conf.Attributes & CONF_ENABLE_IRQ)
	245	CS_CHECK(RequestIRQ,
fba395ee	246	pcmcia_request_irq(link, &link->irq));
c6de2b64 DB	247	else
	248	goto cs_failed;
	249
	250	CS_CHECK(RequestConfiguration,
fba395ee	251	pcmcia_request_configuration(link, &link->conf));
c6de2b64 DB	252
	253	sprintf(dev->node.dev_name, driver_name);
	254	dev->node.major = dev->node.minor = 0;
fd238232	255	link->dev_node = &dev->node;
c6de2b64	256
70294b46 DB	257	printk(KERN_INFO "%s: index 0x%02x: ",
	258	dev->node.dev_name, link->conf.ConfigIndex);
	259	if (link->conf.Vpp)
	260	printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10);
c6de2b64 DB	261	printk(", irq %d", link->irq.AssignedIRQ);
	262	printk(", io 0x%04x-0x%04x", link->io.BasePort1,
	263	link->io.BasePort1+link->io.NumPorts1-1);
	264	printk("\n");
	265
c6de2b64 DB	266	if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
	267	< 0) {
	268	cs_failed:
	269	printk("sl811_cs_config failed\n");
fba395ee	270	cs_error(link, last_fn, last_ret);
c6de2b64	271	sl811_cs_release(link);
15b99ac1	272	return -ENODEV;
c6de2b64	273	}
15b99ac1	274	return 0;
c6de2b64 DB	275	}
c6de2b64 DB	276
15b99ac1	277	static int sl811_cs_probe(struct pcmcia_device *link)
c6de2b64 DB	278	{
c6de2b64 DB	279	local_info_t *local;
c6de2b64 DB	280
	281	local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
	282	if (!local)
f8cfa618	283	return -ENOMEM;
c6de2b64	284	memset(local, 0, sizeof(local_info_t));
fba395ee	285	local->p_dev = link;
c6de2b64 DB	286	link->priv = local;
	287
	288	/* Initialize */
	289	link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
	290	link->irq.IRQInfo1 = IRQ_INFO2_VALID\|IRQ_LEVEL_ID;
c6de2b64 DB	291	link->irq.Handler = NULL;
	292
	293	link->conf.Attributes = 0;
c6de2b64 DB	294	link->conf.IntType = INT_MEMORY_AND_IO;
c6de2b64 DB	295
15b99ac1	296	return sl811_cs_config(link);
c6de2b64 DB	297	}
c6de2b64 DB	298
22f3a8f5 DB	299	static struct pcmcia_device_id sl811_ids[] = {
	300	PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */
	301	PCMCIA_DEVICE_NULL,
	302	};
	303	MODULE_DEVICE_TABLE(pcmcia, sl811_ids);
	304
c6de2b64 DB	305	static struct pcmcia_driver sl811_cs_driver = {
	306	.owner = THIS_MODULE,
	307	.drv = {
	308	.name = (char *)driver_name,
	309	},
15b99ac1	310	.probe = sl811_cs_probe,
cc3b4866	311	.remove = sl811_cs_detach,
22f3a8f5	312	.id_table = sl811_ids,
c6de2b64 DB	313	};
	314
	315	/====================================================================/
	316
	317	static int __init init_sl811_cs(void)
	318	{
	319	return pcmcia_register_driver(&sl811_cs_driver);
	320	}
	321	module_init(init_sl811_cs);
	322
	323	static void __exit exit_sl811_cs(void)
	324	{
	325	pcmcia_unregister_driver(&sl811_cs_driver);
	326	}
	327	module_exit(exit_sl811_cs);