[PATCH] USB: add sl811_cs support (c6de2b64) · Commits · 戴 / test

drivers/usb/host/Kconfig

+11 −0

Original line number	Diff line number	Diff line
		@@ -124,3 +124,14 @@ config USB_SL811_HCD
		To compile this driver as a module, choose M here: the
		module will be called sl811-hcd.

		config USB_SL811_CS
		tristate "CF/PCMCIA support for SL811HS HCD"
		depends on USB_SL811_HCD && PCMCIA
		default N
		help
		Wraps a PCMCIA driver around the SL811HS HCD, supporting the RATOC
		REX-CFU1U CF card (often used with PDAs). If unsure, say N.

		To compile this driver as a module, choose M here: the
		module will be called "sl811_cs".

drivers/usb/host/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -7,4 +7,5 @@ obj-$(CONFIG_USB_EHCI_HCD) += ehci-hcd.o
		obj-$(CONFIG_USB_OHCI_HCD) += ohci-hcd.o
		obj-$(CONFIG_USB_UHCI_HCD) += uhci-hcd.o
		obj-$(CONFIG_USB_SL811_HCD) += sl811-hcd.o
		obj-$(CONFIG_USB_SL811_CS) += sl811_cs.o
		obj-$(CONFIG_ETRAX_ARCH_V10) += hc_crisv10.o

drivers/usb/host/sl811_cs.c

0 → 100644

+442 −0

Original line number	Diff line number	Diff line
		/*
		* 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 <pcmcia/version.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(CONFIG_USB_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;

		static int irq_list[4] = { -1 };
		static int irq_list_count;

		module_param_array(irq_list, int, &irq_list_count, 0444);

		INT_MODULE_PARM(irq_mask, 0xdeb8);

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

		/====================================================================/

		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.
		*/
		platform_dev.name = sl811h_driver.name;
		return platform_device_register(&platform_dev);
		}

		/====================================================================/

		static void sl811_cs_detach(dev_link_t *link)
		{
		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;

		/* Break the link with Card Services */
		if (link->handle)
		pcmcia_deregister_client(link->handle);

		/* 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);

		if (link->open) {
		DBG(1, "sl811_cs: release postponed, '%s' still open\n",
		link->dev->dev_name);
		link->state \|= DEV_STALE_CONFIG;
		return;
		}

		/* 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;

		if (link->state & DEV_STALE_LINK)
		sl811_cs_detach(link);
		}

		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_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_REMOVAL:
		link->state &= ~DEV_PRESENT;
		if (link->state & DEV_CONFIG)
		sl811_cs_release(link);
		break;

		case CS_EVENT_CARD_INSERTION:
		link->state \|= DEV_PRESENT \| DEV_CONFIG_PENDING;
		sl811_cs_config(link);
		break;

		case CS_EVENT_PM_SUSPEND:
		link->state \|= DEV_SUSPEND;
		/* Fall through... */
		case CS_EVENT_RESET_PHYSICAL:
		if (link->state & DEV_CONFIG)
		pcmcia_release_configuration(link->handle);
		break;

		case CS_EVENT_PM_RESUME:
		link->state &= ~DEV_SUSPEND;
		/* Fall through... */
		case CS_EVENT_CARD_RESET:
		if (link->state & DEV_CONFIG)
		pcmcia_request_configuration(link->handle, &link->conf);
		DBG(0, "reset sl811-hcd here?\n");
		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, i;

		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;
		if (irq_list[0] == -1)
		link->irq.IRQInfo2 = irq_mask;
		else
		for (i = 0; i < irq_list_count; i++)
		link->irq.IRQInfo2 \|= 1 << irq_list[i];
		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.EventMask =
		CS_EVENT_CARD_INSERTION \| CS_EVENT_CARD_REMOVAL \|
		CS_EVENT_RESET_PHYSICAL \| CS_EVENT_CARD_RESET \|
		CS_EVENT_PM_SUSPEND \| CS_EVENT_PM_RESUME;
		client_reg.event_handler = &sl811_cs_event;
		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);
		return NULL;
		}

		return link;
		}

		static struct pcmcia_driver sl811_cs_driver = {
		.owner = THIS_MODULE,
		.drv = {
		.name = (char *)driver_name,
		},
		.attach = sl811_cs_attach,
		.detach = sl811_cs_detach,
		};

		/====================================================================/

		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);

Admin message