[GitHub/mt8127/android_kernel_alcatel_ttab.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/sched.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";

static dev_link_t *dev_list = NULL;

typedef struct local_info_t {
	dev_link_t		link;
	dev_node_t		node;
} local_info_t;

static void sl811_cs_release(dev_link_t * 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 device_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.name;
	return platform_device_register(&platform_dev);
}

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

static void sl811_cs_detach(struct pcmcia_device *p_dev)
{
	dev_link_t *link = dev_to_instance(p_dev);
	dev_link_t **linkp;

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

	/* Locate device structure */
	for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next) {
		if (*linkp == link)
			break;
	}
	if (*linkp == NULL)
		return;

	link->state &= ~DEV_PRESENT;
	if (link->state & DEV_CONFIG)
		sl811_cs_release(link);

	/* Unlink device structure, and free it */
	*linkp = link->next;
	/* This points to the parent local_info_t struct */
	kfree(link->priv);
}

static void sl811_cs_release(dev_link_t * link)
{

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

	/* Unlink the device chain */
	link->dev = NULL;

	platform_device_unregister(&platform_dev);
	pcmcia_release_configuration(link->handle);
	if (link->io.NumPorts1)
		pcmcia_release_io(link->handle, &link->io);
	if (link->irq.AssignedIRQ)
		pcmcia_release_irq(link->handle, &link->irq);
	link->state &= ~DEV_CONFIG;
}

static void sl811_cs_config(dev_link_t *link)
{
	client_handle_t		handle = link->handle;
	struct device		*parent = &handle_to_dev(handle);
	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);

	tuple.DesiredTuple = CISTPL_CONFIG;
	tuple.Attributes = 0;
	tuple.TupleData = buf;
	tuple.TupleDataMax = sizeof(buf);
	tuple.TupleOffset = 0;
	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
	CS_CHECK(GetTupleData, pcmcia_get_tuple_data(handle, &tuple));
	CS_CHECK(ParseTuple, pcmcia_parse_tuple(handle, &tuple, &parse));
	link->conf.ConfigBase = parse.config.base;
	link->conf.Present = parse.config.rmask[0];

	/* Configure card */
	link->state |= DEV_CONFIG;

	/* Look up the current Vcc */
	CS_CHECK(GetConfigurationInfo,
			pcmcia_get_configuration_info(handle, &conf));
	link->conf.Vcc = conf.Vcc;

	tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
	while (1) {
		cistpl_cftable_entry_t	*cfg = &(parse.cftable_entry);

		if (pcmcia_get_tuple_data(handle, &tuple) != 0
				|| pcmcia_parse_tuple(handle, &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.Vpp1 = link->conf.Vpp2 =
				cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
		else if (dflt.vpp1.present & (1<<CISTPL_POWER_VNOM))
			link->conf.Vpp1 = link->conf.Vpp2 =
				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->handle, &link->io) != 0)
				goto next_entry;
		}
		break;

next_entry:
		if (link->io.NumPorts1)
			pcmcia_release_io(link->handle, &link->io);
		last_ret = pcmcia_get_next_tuple(handle, &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->handle, &link->irq));
	else
		goto cs_failed;

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

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

	printk(KERN_INFO "%s: index 0x%02x: Vcc %d.%d",
	       dev->node.dev_name, link->conf.ConfigIndex,
	       link->conf.Vcc/10, link->conf.Vcc%10);
	if (link->conf.Vpp1)
		printk(", Vpp %d.%d", link->conf.Vpp1/10, link->conf.Vpp1%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");

	link->state &= ~DEV_CONFIG_PENDING;

	if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
			< 0) {
cs_failed:
		printk("sl811_cs_config failed\n");
		cs_error(link->handle, last_fn, last_ret);
		sl811_cs_release(link);
		link->state &= ~DEV_CONFIG_PENDING;
	}
}

static int sl811_suspend(struct pcmcia_device *dev)
{
	dev_link_t *link = dev_to_instance(dev);

	link->state |= DEV_SUSPEND;
	if (link->state & DEV_CONFIG)
		pcmcia_release_configuration(link->handle);

	return 0;
}

static int sl811_resume(struct pcmcia_device *dev)
{
	dev_link_t *link = dev_to_instance(dev);

	link->state &= ~DEV_SUSPEND;
	if (link->state & DEV_CONFIG)
		pcmcia_request_configuration(link->handle, &link->conf);

	return 0;
}

static int
sl811_cs_event(event_t event, int priority, event_callback_args_t *args)
{
	dev_link_t *link = args->client_data;

	DBG(1, "sl811_cs_event(0x%06x)\n", event);

	switch (event) {
	case CS_EVENT_CARD_INSERTION:
		link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
		sl811_cs_config(link);
		break;
	}
	return 0;
}

static dev_link_t *sl811_cs_attach(void)
{
	local_info_t *local;
	dev_link_t *link;
	client_reg_t client_reg;
	int ret;

	local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
	if (!local)
		return NULL;
	memset(local, 0, sizeof(local_info_t));
	link = &local->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.Vcc = 33;
	link->conf.IntType = INT_MEMORY_AND_IO;

	/* Register with Card Services */
	link->next = dev_list;
	dev_list = link;
	client_reg.dev_info = (dev_info_t *) &driver_name;
	client_reg.Attributes = INFO_IO_CLIENT | INFO_CARD_SHARE;
	client_reg.Version = 0x0210;
	client_reg.event_callback_args.client_data = link;
	ret = pcmcia_register_client(&link->handle, &client_reg);
	if (ret != CS_SUCCESS) {
		cs_error(link->handle, RegisterClient, ret);
		sl811_cs_detach(link->handle);
		return NULL;
	}

	return 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,
	},
	.attach		= sl811_cs_attach,
	.event		= sl811_cs_event,
	.remove		= sl811_cs_detach,
	.id_table	= sl811_ids,
	.suspend	= sl811_suspend,
	.resume		= sl811_resume,
};

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

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>
	16	#include <linux/sched.h>
	17	#include <linux/ptrace.h>
	18	#include <linux/slab.h>
	19	#include <linux/string.h>
	20	#include <linux/timer.h>
	21	#include <linux/ioport.h>
d052d1be	22	#include <linux/platform_device.h>
c6de2b64	23
c6de2b64 DB	24	#include <pcmcia/cs_types.h>
	25	#include <pcmcia/cs.h>
	26	#include <pcmcia/cistpl.h>
	27	#include <pcmcia/cisreg.h>
	28	#include <pcmcia/ds.h>
	29
	30	#include <linux/usb_sl811.h>
	31
	32	MODULE_AUTHOR("Botond Botyanszki");
	33	MODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6");
	34	MODULE_LICENSE("GPL");
	35
	36
	37	/====================================================================/
	38	/* MACROS */
	39	/====================================================================/
	40
c9a50cc9	41	#if defined(DEBUG) \|\| defined(PCMCIA_DEBUG)
c6de2b64 DB	42
	43	static int pc_debug = 0;
	44	module_param(pc_debug, int, 0644);
	45
	46	#define DBG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG "sl811_cs: " args)
	47
	48	#else
	49	#define DBG(n, args...) do{}while(0)
	50	#endif /* no debugging */
	51
	52	#define INFO(args...) printk(KERN_INFO "sl811_cs: " args)
	53
	54	#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
	55
	56	#define CS_CHECK(fn, ret) \
	57	do { \
	58	last_fn = (fn); \
	59	if ((last_ret = (ret)) != 0) \
	60	goto cs_failed; \
	61	} while (0)
	62
	63	/====================================================================/
	64	/* VARIABLES */
	65	/====================================================================/
	66
	67	static const char driver_name[DEV_NAME_LEN] = "sl811_cs";
	68
	69	static dev_link_t *dev_list = NULL;
	70
c6de2b64 DB	71	typedef struct local_info_t {
	72	dev_link_t link;
	73	dev_node_t node;
	74	} local_info_t;
	75
cc3b4866 DB	76	static void sl811_cs_release(dev_link_t * link);
cc3b4866 DB	77
c6de2b64 DB	78	/====================================================================/
	79
	80	static void release_platform_dev(struct device * dev)
	81	{
	82	DBG(0, "sl811_cs platform_dev release\n");
	83	dev->parent = NULL;
	84	}
	85
	86	static struct sl811_platform_data platform_data = {
	87	.potpg = 100,
	88	.power = 50, /* == 100mA */
	89	// .reset = ... FIXME: invoke CF reset on the card
	90	};
	91
	92	static struct resource resources[] = {
	93	[0] = {
	94	.flags = IORESOURCE_IRQ,
	95	},
	96	[1] = {
	97	// .name = "address",
	98	.flags = IORESOURCE_IO,
	99	},
	100	[2] = {
	101	// .name = "data",
	102	.flags = IORESOURCE_IO,
	103	},
	104	};
	105
	106	extern struct device_driver sl811h_driver;
	107
	108	static struct platform_device platform_dev = {
	109	.id = -1,
	110	.dev = {
	111	.platform_data = &platform_data,
	112	.release = release_platform_dev,
	113	},
	114	.resource = resources,
	115	.num_resources = ARRAY_SIZE(resources),
	116	};
	117
	118	static int sl811_hc_init(struct device *parent, ioaddr_t base_addr, int irq)
	119	{
	120	if (platform_dev.dev.parent)
	121	return -EBUSY;
	122	platform_dev.dev.parent = parent;
	123
	124	/* finish seting up the platform device */
	125	resources[0].start = irq;
	126
	127	resources[1].start = base_addr;
	128	resources[1].end = base_addr;
	129
	130	resources[2].start = base_addr + 1;
	131	resources[2].end = base_addr + 1;
	132
	133	/* The driver core will probe for us. We know sl811-hcd has been
c9a50cc9 DB	134	* initialized already because of the link order dependency created
c9a50cc9 DB	135	* by referencing "sl811h_driver".
c6de2b64 DB	136	*/
	137	platform_dev.name = sl811h_driver.name;
	138	return platform_device_register(&platform_dev);
	139	}
	140
	141	/====================================================================/
	142
cc3b4866	143	static void sl811_cs_detach(struct pcmcia_device *p_dev)
c6de2b64	144	{
cc3b4866	145	dev_link_t *link = dev_to_instance(p_dev);
c6de2b64 DB	146	dev_link_t **linkp;
	147
	148	DBG(0, "sl811_cs_detach(0x%p)\n", link);
	149
	150	/* Locate device structure */
	151	for (linkp = &dev_list; linkp; linkp = &(linkp)->next) {
	152	if (*linkp == link)
	153	break;
	154	}
	155	if (*linkp == NULL)
	156	return;
	157
cc3b4866 DB	158	link->state &= ~DEV_PRESENT;
	159	if (link->state & DEV_CONFIG)
	160	sl811_cs_release(link);
c6de2b64 DB	161
	162	/* Unlink device structure, and free it */
	163	*linkp = link->next;
	164	/* This points to the parent local_info_t struct */
	165	kfree(link->priv);
	166	}
	167
	168	static void sl811_cs_release(dev_link_t * link)
	169	{
	170
	171	DBG(0, "sl811_cs_release(0x%p)\n", link);
	172
c6de2b64 DB	173	/* Unlink the device chain */
	174	link->dev = NULL;
	175
	176	platform_device_unregister(&platform_dev);
	177	pcmcia_release_configuration(link->handle);
	178	if (link->io.NumPorts1)
	179	pcmcia_release_io(link->handle, &link->io);
	180	if (link->irq.AssignedIRQ)
	181	pcmcia_release_irq(link->handle, &link->irq);
	182	link->state &= ~DEV_CONFIG;
c6de2b64 DB	183	}
	184
	185	static void sl811_cs_config(dev_link_t *link)
	186	{
	187	client_handle_t handle = link->handle;
	188	struct device *parent = &handle_to_dev(handle);
	189	local_info_t *dev = link->priv;
	190	tuple_t tuple;
	191	cisparse_t parse;
	192	int last_fn, last_ret;
	193	u_char buf[64];
	194	config_info_t conf;
	195	cistpl_cftable_entry_t dflt = { 0 };
	196
	197	DBG(0, "sl811_cs_config(0x%p)\n", link);
	198
	199	tuple.DesiredTuple = CISTPL_CONFIG;
	200	tuple.Attributes = 0;
	201	tuple.TupleData = buf;
	202	tuple.TupleDataMax = sizeof(buf);
	203	tuple.TupleOffset = 0;
	204	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
	205	CS_CHECK(GetTupleData, pcmcia_get_tuple_data(handle, &tuple));
	206	CS_CHECK(ParseTuple, pcmcia_parse_tuple(handle, &tuple, &parse));
	207	link->conf.ConfigBase = parse.config.base;
	208	link->conf.Present = parse.config.rmask[0];
	209
	210	/* Configure card */
	211	link->state \|= DEV_CONFIG;
	212
	213	/* Look up the current Vcc */
	214	CS_CHECK(GetConfigurationInfo,
	215	pcmcia_get_configuration_info(handle, &conf));
	216	link->conf.Vcc = conf.Vcc;
	217
	218	tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
	219	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(handle, &tuple));
	220	while (1) {
	221	cistpl_cftable_entry_t *cfg = &(parse.cftable_entry);
	222
	223	if (pcmcia_get_tuple_data(handle, &tuple) != 0
	224	\|\| pcmcia_parse_tuple(handle, &tuple, &parse)
	225	!= 0)
	226	goto next_entry;
	227
	228	if (cfg->flags & CISTPL_CFTABLE_DEFAULT) {
	229	dflt = *cfg;
	230	}
	231
	232	if (cfg->index == 0)
	233	goto next_entry;
	234
	235	link->conf.ConfigIndex = cfg->index;
	236
	237	/* Use power settings for Vcc and Vpp if present */
	238	/* Note that the CIS values need to be rescaled */
	239	if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
	240	if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000
	241	!= conf.Vcc)
	242	goto next_entry;
	243	} else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
	244	if (dflt.vcc.param[CISTPL_POWER_VNOM]/10000
	245	!= conf.Vcc)
	246	goto next_entry;
247	}
248
249	if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM))
250	link->conf.Vpp1 = link->conf.Vpp2 =
251	cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
252	else if (dflt.vpp1.present & (1<<CISTPL_POWER_VNOM))
253	link->conf.Vpp1 = link->conf.Vpp2 =
254	dflt.vpp1.param[CISTPL_POWER_VNOM]/10000;
255
256	/* we need an interrupt */
257	if (cfg->irq.IRQInfo1 \|\| dflt.irq.IRQInfo1)
258	link->conf.Attributes \|= CONF_ENABLE_IRQ;
259
260	/* IO window settings */
261	link->io.NumPorts1 = link->io.NumPorts2 = 0;
262	if ((cfg->io.nwin > 0) \|\| (dflt.io.nwin > 0)) {
263	cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
264
265	link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
266	link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
267	link->io.BasePort1 = io->win[0].base;
268	link->io.NumPorts1 = io->win[0].len;
269
270	if (pcmcia_request_io(link->handle, &link->io) != 0)
271	goto next_entry;
272	}
273	break;
274
275	next_entry:
276	if (link->io.NumPorts1)
277	pcmcia_release_io(link->handle, &link->io);
278	last_ret = pcmcia_get_next_tuple(handle, &tuple);
279	}
280
281	/* require an IRQ and two registers */
282	if (!link->io.NumPorts1 \|\| link->io.NumPorts1 < 2)
283	goto cs_failed;
284	if (link->conf.Attributes & CONF_ENABLE_IRQ)
285	CS_CHECK(RequestIRQ,
286	pcmcia_request_irq(link->handle, &link->irq));
287	else
288	goto cs_failed;
289
290	CS_CHECK(RequestConfiguration,
291	pcmcia_request_configuration(link->handle, &link->conf));
292
293	sprintf(dev->node.dev_name, driver_name);
294	dev->node.major = dev->node.minor = 0;
295	link->dev = &dev->node;
296
297	printk(KERN_INFO "%s: index 0x%02x: Vcc %d.%d",
298	dev->node.dev_name, link->conf.ConfigIndex,
299	link->conf.Vcc/10, link->conf.Vcc%10);
300	if (link->conf.Vpp1)
301	printk(", Vpp %d.%d", link->conf.Vpp1/10, link->conf.Vpp1%10);
302	printk(", irq %d", link->irq.AssignedIRQ);
303	printk(", io 0x%04x-0x%04x", link->io.BasePort1,
304	link->io.BasePort1+link->io.NumPorts1-1);
305	printk("\n");
306
307	link->state &= ~DEV_CONFIG_PENDING;
308
309	if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
310	< 0) {
311	cs_failed:
312	printk("sl811_cs_config failed\n");
313	cs_error(link->handle, last_fn, last_ret);
314	sl811_cs_release(link);
315	link->state &= ~DEV_CONFIG_PENDING;
316	}
317	}
318
98e4c28b DB	319	static int sl811_suspend(struct pcmcia_device *dev)
	320	{
	321	dev_link_t *link = dev_to_instance(dev);
	322
	323	link->state \|= DEV_SUSPEND;
	324	if (link->state & DEV_CONFIG)
	325	pcmcia_release_configuration(link->handle);
	326
	327	return 0;
	328	}
	329
	330	static int sl811_resume(struct pcmcia_device *dev)
	331	{
	332	dev_link_t *link = dev_to_instance(dev);
	333
	334	link->state &= ~DEV_SUSPEND;
	335	if (link->state & DEV_CONFIG)
	336	pcmcia_request_configuration(link->handle, &link->conf);
	337
	338	return 0;
	339	}
	340
c6de2b64 DB	341	static int
	342	sl811_cs_event(event_t event, int priority, event_callback_args_t *args)
	343	{
	344	dev_link_t *link = args->client_data;
	345
	346	DBG(1, "sl811_cs_event(0x%06x)\n", event);
	347
	348	switch (event) {
c6de2b64 DB	349	case CS_EVENT_CARD_INSERTION:
	350	link->state \|= DEV_PRESENT \| DEV_CONFIG_PENDING;
	351	sl811_cs_config(link);
	352	break;
c6de2b64 DB	353	}
	354	return 0;
	355	}
	356
	357	static dev_link_t *sl811_cs_attach(void)
	358	{
	359	local_info_t *local;
	360	dev_link_t *link;
	361	client_reg_t client_reg;
22f3a8f5	362	int ret;
c6de2b64 DB	363
	364	local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
	365	if (!local)
	366	return NULL;
	367	memset(local, 0, sizeof(local_info_t));
	368	link = &local->link;
	369	link->priv = local;
	370
	371	/* Initialize */
	372	link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
	373	link->irq.IRQInfo1 = IRQ_INFO2_VALID\|IRQ_LEVEL_ID;
c6de2b64 DB	374	link->irq.Handler = NULL;
	375
	376	link->conf.Attributes = 0;
	377	link->conf.Vcc = 33;
	378	link->conf.IntType = INT_MEMORY_AND_IO;
	379
	380	/* Register with Card Services */
	381	link->next = dev_list;
	382	dev_list = link;
	383	client_reg.dev_info = (dev_info_t *) &driver_name;
	384	client_reg.Attributes = INFO_IO_CLIENT \| INFO_CARD_SHARE;
c6de2b64 DB	385	client_reg.Version = 0x0210;
	386	client_reg.event_callback_args.client_data = link;
	387	ret = pcmcia_register_client(&link->handle, &client_reg);
	388	if (ret != CS_SUCCESS) {
	389	cs_error(link->handle, RegisterClient, ret);
cc3b4866	390	sl811_cs_detach(link->handle);
c6de2b64 DB	391	return NULL;
	392	}
	393
	394	return link;
	395	}
	396
22f3a8f5 DB	397	static struct pcmcia_device_id sl811_ids[] = {
	398	PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */
	399	PCMCIA_DEVICE_NULL,
	400	};
	401	MODULE_DEVICE_TABLE(pcmcia, sl811_ids);
	402
c6de2b64 DB	403	static struct pcmcia_driver sl811_cs_driver = {
	404	.owner = THIS_MODULE,
	405	.drv = {
	406	.name = (char *)driver_name,
	407	},
	408	.attach = sl811_cs_attach,
1e212f36	409	.event = sl811_cs_event,
cc3b4866	410	.remove = sl811_cs_detach,
22f3a8f5	411	.id_table = sl811_ids,
98e4c28b DB	412	.suspend = sl811_suspend,
98e4c28b DB	413	.resume = sl811_resume,
c6de2b64 DB	414	};
	415
	416	/====================================================================/
	417
	418	static int __init init_sl811_cs(void)
	419	{
	420	return pcmcia_register_driver(&sl811_cs_driver);
	421	}
	422	module_init(init_sl811_cs);
	423
	424	static void __exit exit_sl811_cs(void)
	425	{
	426	pcmcia_unregister_driver(&sl811_cs_driver);
	427	}
	428	module_exit(exit_sl811_cs);