drivers/usb/host/sl811_cs.c - kernel/msm-4.9 - Gitiles

 /*
  * 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 = kzalloc(sizeof(local_info_t), GFP_KERNEL);
 	if (!local)
 		return -ENOMEM;
 	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);
	/*
	* 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 = kzalloc(sizeof(local_info_t), GFP_KERNEL);
	if (!local)
	return -ENOMEM;
	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);