sl811_cs.c revision d39bd56452b509f8d6054883b8a0129950ba50cc
1c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*
2c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * PCMCIA driver for SL811HS (as found in REX-CFU1U)
3c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Filename: sl811_cs.c
4c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell * Author:   Yukio Yamamoto
5c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell *
6c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell *  Port to sl811-hcd and 2.6.x by
7c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell *    Botond Botyanszki <boti@rocketmail.com>
8c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell *    Simon Pickering
9c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell *
10c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell *  Last update: 2005-05-12
11c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell */
12c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
13c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/kernel.h>
14c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/module.h>
15c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/init.h>
16c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/ptrace.h>
17c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/slab.h>
18c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/string.h>
19c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/timer.h>
20c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <linux/ioport.h>
21d052d1beff706920e82c5d55006b08e256b5df09Russell King#include <linux/platform_device.h>
22c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
23c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cs_types.h>
24c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cs.h>
25c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cistpl.h>
26c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/cisreg.h>
27c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#include <pcmcia/ds.h>
28c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
29325a4af60dc945bf2da9cbcdbabb276e312b297cDavid Brownell#include <linux/usb/sl811.h>
30c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
31c6de2b64eb575a3f9326969ec5fcdc6032b38e42David BrownellMODULE_AUTHOR("Botond Botyanszki");
32c6de2b64eb575a3f9326969ec5fcdc6032b38e42David BrownellMODULE_DESCRIPTION("REX-CFU1U PCMCIA driver for 2.6");
33c6de2b64eb575a3f9326969ec5fcdc6032b38e42David BrownellMODULE_LICENSE("GPL");
34c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
35c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
36c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/
37c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/* MACROS                                                             */
38c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/
39c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
40c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell#if defined(DEBUG) || defined(PCMCIA_DEBUG)
41c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
42c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic int pc_debug = 0;
43c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_param(pc_debug, int, 0644);
44c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
45c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define DBG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG "sl811_cs: " args)
46c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
47c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#else
48c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define DBG(n, args...) do{}while(0)
49c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#endif	/* no debugging */
50c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
51c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define INFO(args...) printk(KERN_INFO "sl811_cs: " args)
52c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
53c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0444)
54c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
55c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell#define CS_CHECK(fn, ret) \
56c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	do { \
57c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		last_fn = (fn); \
58c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		if ((last_ret = (ret)) != 0) \
59c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell			goto cs_failed; \
60c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	} while (0)
61c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
62c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/
63c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/* VARIABLES                                                          */
64c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/
65c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
66c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic const char driver_name[DEV_NAME_LEN]  = "sl811_cs";
67c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
68c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownelltypedef struct local_info_t {
69fd238232cd0ff4840ae6946bb338502154096d88Dominik Brodowski	struct pcmcia_device	*p_dev;
70c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	dev_node_t		node;
71c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell} local_info_t;
72c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
73fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_release(struct pcmcia_device * link);
74cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski
75c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/
76c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
77c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic void release_platform_dev(struct device * dev)
78c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
79c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	DBG(0, "sl811_cs platform_dev release\n");
80c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	dev->parent = NULL;
81c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
82c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
83c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct sl811_platform_data platform_data = {
84c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.potpg		= 100,
85c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.power		= 50,		/* == 100mA */
86c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	// .reset	= ... FIXME:  invoke CF reset on the card
87c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell};
88c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
89c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct resource resources[] = {
90c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	[0] = {
91c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		.flags	= IORESOURCE_IRQ,
92c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	},
93c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	[1] = {
94c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		// .name   = "address",
95c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		.flags	= IORESOURCE_IO,
96c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	},
97c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	[2] = {
98c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		// .name   = "data",
99c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		.flags	= IORESOURCE_IO,
100c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	},
101c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell};
102c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
103a0c53f1dca10acc93462339cbd0bf24b10d60a13David Brownellextern struct platform_driver sl811h_driver;
104c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
105c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct platform_device platform_dev = {
106c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.id			= -1,
107c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.dev = {
108c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		.platform_data = &platform_data,
109c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		.release       = release_platform_dev,
110c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	},
111c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.resource		= resources,
112c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.num_resources		= ARRAY_SIZE(resources),
113c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell};
114c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
115d39bd56452b509f8d6054883b8a0129950ba50ccDominik Brodowskistatic int sl811_hc_init(struct device *parent, resource_size_t base_addr,
116d39bd56452b509f8d6054883b8a0129950ba50ccDominik Brodowski			 int irq)
117c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
118c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	if (platform_dev.dev.parent)
119c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		return -EBUSY;
120c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	platform_dev.dev.parent = parent;
121c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
122c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	/* finish seting up the platform device */
123c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	resources[0].start = irq;
124c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
125c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	resources[1].start = base_addr;
126c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	resources[1].end = base_addr;
127c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
128c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	resources[2].start = base_addr + 1;
129c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	resources[2].end   = base_addr + 1;
130c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
131c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	/* The driver core will probe for us.  We know sl811-hcd has been
132c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell	 * initialized already because of the link order dependency created
133c9a50cc9318772e62d56f2a9172bdfda72bdacbeDavid Brownell	 * by referencing "sl811h_driver".
134c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	 */
135a0c53f1dca10acc93462339cbd0bf24b10d60a13David Brownell	platform_dev.name = sl811h_driver.driver.name;
136c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	return platform_device_register(&platform_dev);
137c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
138c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
139c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/
140c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
141fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_detach(struct pcmcia_device *link)
142c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
143c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	DBG(0, "sl811_cs_detach(0x%p)\n", link);
144c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
145e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski	sl811_cs_release(link);
146c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
147c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	/* This points to the parent local_info_t struct */
148c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	kfree(link->priv);
149c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
150c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
151fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void sl811_cs_release(struct pcmcia_device * link)
152c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
153c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	DBG(0, "sl811_cs_release(0x%p)\n", link);
154c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
155fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski	pcmcia_disable_device(link);
156c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	platform_device_unregister(&platform_dev);
157c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
158c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
15984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowskistatic int sl811_cs_config_check(struct pcmcia_device *p_dev,
16084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski				 cistpl_cftable_entry_t *cfg,
1618e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski				 cistpl_cftable_entry_t *dflt,
162ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski				 unsigned int vcc,
16384e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski				 void *priv_data)
16484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski{
16584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	if (cfg->index == 0)
16684e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		return -ENODEV;
16784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
16884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	/* Use power settings for Vcc and Vpp if present */
16984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	/*  Note that the CIS values need to be rescaled */
17084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	if (cfg->vcc.present & (1<<CISTPL_POWER_VNOM)) {
171ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski		if (cfg->vcc.param[CISTPL_POWER_VNOM]/10000 != vcc)
17284e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski			return -ENODEV;
1738e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski	} else if (dflt->vcc.present & (1<<CISTPL_POWER_VNOM)) {
174ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski		if (dflt->vcc.param[CISTPL_POWER_VNOM]/10000 != vcc)
17584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski			return -ENODEV;
17684e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		}
17784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
17884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	if (cfg->vpp1.present & (1<<CISTPL_POWER_VNOM))
17984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		p_dev->conf.Vpp =
18084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski			cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
1818e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski	else if (dflt->vpp1.present & (1<<CISTPL_POWER_VNOM))
18284e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		p_dev->conf.Vpp =
1838e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski			dflt->vpp1.param[CISTPL_POWER_VNOM]/10000;
18484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
18584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	/* we need an interrupt */
1868e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski	if (cfg->irq.IRQInfo1 || dflt->irq.IRQInfo1)
18784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		p_dev->conf.Attributes |= CONF_ENABLE_IRQ;
18884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
18984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	/* IO window settings */
19084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	p_dev->io.NumPorts1 = p_dev->io.NumPorts2 = 0;
1918e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski	if ((cfg->io.nwin > 0) || (dflt->io.nwin > 0)) {
1928e2fc39ddea7fe8c6798837da282db88a09af793Dominik Brodowski		cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt->io;
19384e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
19484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
19584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		p_dev->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
19684e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		p_dev->io.BasePort1 = io->win[0].base;
19784e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		p_dev->io.NumPorts1 = io->win[0].len;
19884e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
19984e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski		return pcmcia_request_io(p_dev, &p_dev->io);
20084e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	}
20184e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	pcmcia_disable_device(p_dev);
20284e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski	return -ENODEV;
20384e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski}
20484e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
20584e2d34004dcd0c90d1af43a143511b334f11a4dDominik Brodowski
20615b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int sl811_cs_config(struct pcmcia_device *link)
207c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
208fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski	struct device		*parent = &handle_to_dev(link);
209c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	local_info_t		*dev = link->priv;
210c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	int			last_fn, last_ret;
211c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
212c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	DBG(0, "sl811_cs_config(0x%p)\n", link);
213c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
214ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski	if (pcmcia_loop_config(link, sl811_cs_config_check, NULL))
215ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski		goto failed;
216c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
217c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	/* require an IRQ and two registers */
218c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	if (!link->io.NumPorts1 || link->io.NumPorts1 < 2)
219ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski		goto failed;
220c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	if (link->conf.Attributes & CONF_ENABLE_IRQ)
221c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		CS_CHECK(RequestIRQ,
222fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski			pcmcia_request_irq(link, &link->irq));
223c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	else
224ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski		goto failed;
225c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
226c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	CS_CHECK(RequestConfiguration,
227fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski		pcmcia_request_configuration(link, &link->conf));
228c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
229c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	sprintf(dev->node.dev_name, driver_name);
230c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	dev->node.major = dev->node.minor = 0;
231fd238232cd0ff4840ae6946bb338502154096d88Dominik Brodowski	link->dev_node = &dev->node;
232c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
23370294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski	printk(KERN_INFO "%s: index 0x%02x: ",
23470294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski	       dev->node.dev_name, link->conf.ConfigIndex);
23570294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski	if (link->conf.Vpp)
23670294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski		printk(", Vpp %d.%d", link->conf.Vpp/10, link->conf.Vpp%10);
237c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	printk(", irq %d", link->irq.AssignedIRQ);
238c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	printk(", io 0x%04x-0x%04x", link->io.BasePort1,
239c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	       link->io.BasePort1+link->io.NumPorts1-1);
240c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	printk("\n");
241c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
242c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	if (sl811_hc_init(parent, link->io.BasePort1, link->irq.AssignedIRQ)
243c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell			< 0) {
244c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellcs_failed:
245fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski		cs_error(link, last_fn, last_ret);
246ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowskifailed:
247ad913c11928f51abb6174f165db8d8d205b22e21Dominik Brodowski		printk(KERN_WARNING "sl811_cs_config failed\n");
248c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		sl811_cs_release(link);
24915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski		return  -ENODEV;
250c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	}
25115b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski	return 0;
252c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
253c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
25415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int sl811_cs_probe(struct pcmcia_device *link)
255c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
256c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	local_info_t *local;
257c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
258dd00cc486ab1c17049a535413d1751ef3482141cYoann Padioleau	local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
259c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	if (!local)
260f8cfa618dccbdc6dab5297f75779566a388a98fdDominik Brodowski		return -ENOMEM;
261fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski	local->p_dev = link;
262c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	link->priv = local;
263c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
264c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	/* Initialize */
265c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
266c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	link->irq.IRQInfo1 = IRQ_INFO2_VALID|IRQ_LEVEL_ID;
267c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	link->irq.Handler = NULL;
268c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
269c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	link->conf.Attributes = 0;
270c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	link->conf.IntType = INT_MEMORY_AND_IO;
271c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
27215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski	return sl811_cs_config(link);
273c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
274c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
27522f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownellstatic struct pcmcia_device_id sl811_ids[] = {
27622f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell	PCMCIA_DEVICE_MANF_CARD(0xc015, 0x0001), /* RATOC USB HOST CF+ Card */
27722f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell	PCMCIA_DEVICE_NULL,
27822f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell};
27922f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid BrownellMODULE_DEVICE_TABLE(pcmcia, sl811_ids);
28022f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell
281c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic struct pcmcia_driver sl811_cs_driver = {
282c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.owner		= THIS_MODULE,
283c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	.drv		= {
284c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell		.name	= (char *)driver_name,
285c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	},
28615b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski	.probe		= sl811_cs_probe,
287cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski	.remove		= sl811_cs_detach,
28822f3a8f5fc94be4dd31c4c5ec1d1dc2b9c83a8acDavid Brownell	.id_table	= sl811_ids,
289c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell};
290c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
291c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell/*====================================================================*/
292c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
293c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic int __init init_sl811_cs(void)
294c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
295c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	return pcmcia_register_driver(&sl811_cs_driver);
296c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
297c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_init(init_sl811_cs);
298c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell
299c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellstatic void __exit exit_sl811_cs(void)
300c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell{
301c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell	pcmcia_unregister_driver(&sl811_cs_driver);
302c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownell}
303c6de2b64eb575a3f9326969ec5fcdc6032b38e42David Brownellmodule_exit(exit_sl811_cs);
304