[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / parport / parport_cs.c

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

    A driver for PCMCIA parallel port adapters

    (specifically, for the Quatech SPP-100 EPP card: other cards will
    probably require driver tweaks)
    
    parport_cs.c 1.29 2002/10/11 06:57:41

    The contents of this file are subject to the Mozilla Public
    License Version 1.1 (the "License"); you may not use this file
    except in compliance with the License. You may obtain a copy of
    the License at http://www.mozilla.org/MPL/

    Software distributed under the License is distributed on an "AS
    IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
    implied. See the License for the specific language governing
    rights and limitations under the License.

    The initial developer of the original code is David A. Hinds
    <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
    are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.

    Alternatively, the contents of this file may be used under the
    terms of the GNU General Public License version 2 (the "GPL"), in
    which case the provisions of the GPL are applicable instead of the
    above.  If you wish to allow the use of your version of this file
    only under the terms of the GPL and not to allow others to use
    your version of this file under the MPL, indicate your decision
    by deleting the provisions above and replace them with the notice
    and other provisions required by the GPL.  If you do not delete
    the provisions above, a recipient may use your version of this
    file under either the MPL or the GPL.
    
======================================================================*/

#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/major.h>

#include <linux/parport.h>
#include <linux/parport_pc.h>

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

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

/* Module parameters */

MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
MODULE_DESCRIPTION("PCMCIA parallel port card driver");
MODULE_LICENSE("Dual MPL/GPL");

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

INT_MODULE_PARM(epp_mode, 1);

#ifdef PCMCIA_DEBUG
INT_MODULE_PARM(pc_debug, PCMCIA_DEBUG);
#define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
static char *version =
"parport_cs.c 1.29 2002/10/11 06:57:41 (David Hinds)";
#else
#define DEBUG(n, args...)
#endif

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

#define FORCE_EPP_MODE	0x08

typedef struct parport_info_t {
	struct pcmcia_device	*p_dev;
    int			ndev;
    dev_node_t		node;
    struct parport	*port;
} parport_info_t;

static void parport_detach(struct pcmcia_device *p_dev);
static int parport_config(struct pcmcia_device *link);
static void parport_cs_release(struct pcmcia_device *);

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

    parport_attach() creates an "instance" of the driver, allocating
    local data structures for one device.  The device is registered
    with Card Services.

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

static int parport_probe(struct pcmcia_device *link)
{
    parport_info_t *info;

    DEBUG(0, "parport_attach()\n");

    /* Create new parport device */
    info = kmalloc(sizeof(*info), GFP_KERNEL);
    if (!info) return -ENOMEM;
    memset(info, 0, sizeof(*info));
    link->priv = info;
    info->p_dev = link;

    link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
    link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
    link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
    link->irq.IRQInfo1 = IRQ_LEVEL_ID;
    link->conf.Attributes = CONF_ENABLE_IRQ;
    link->conf.IntType = INT_MEMORY_AND_IO;

    return parport_config(link);
} /* parport_attach */

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

    This deletes a driver "instance".  The device is de-registered
    with Card Services.  If it has been released, all local data
    structures are freed.  Otherwise, the structures will be freed
    when the device is released.

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

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

    parport_cs_release(link);

    kfree(link->priv);
} /* parport_detach */

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

    parport_config() is scheduled to run after a CARD_INSERTION event
    is received, to configure the PCMCIA socket, and to make the
    parport device available to the system.

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

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

static int parport_config(struct pcmcia_device *link)
{
    parport_info_t *info = link->priv;
    tuple_t tuple;
    u_short buf[128];
    cisparse_t parse;
    cistpl_cftable_entry_t *cfg = &parse.cftable_entry;
    cistpl_cftable_entry_t dflt = { 0 };
    struct parport *p;
    int last_ret, last_fn;
    
    DEBUG(0, "parport_config(0x%p)\n", link);
    
    tuple.TupleData = (cisdata_t *)buf;
    tuple.TupleOffset = 0; tuple.TupleDataMax = 255;
    tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
    tuple.Attributes = 0;
    CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
    while (1) {
	if (pcmcia_get_tuple_data(link, &tuple) != 0 ||
		pcmcia_parse_tuple(link, &tuple, &parse) != 0)
	    goto next_entry;

	if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
	    cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
	    link->conf.ConfigIndex = cfg->index;
	    if (epp_mode)
		link->conf.ConfigIndex |= FORCE_EPP_MODE;
	    link->io.BasePort1 = io->win[0].base;
	    link->io.NumPorts1 = io->win[0].len;
	    link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
	    if (io->nwin == 2) {
		link->io.BasePort2 = io->win[1].base;
		link->io.NumPorts2 = io->win[1].len;
	    }
	    if (pcmcia_request_io(link, &link->io) != 0)
		goto next_entry;
	    /* If we've got this far, we're done */
	    break;
	}
	
    next_entry:
	if (cfg->flags & CISTPL_CFTABLE_DEFAULT) dflt = *cfg;
	CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
    }
    
    CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
    CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));

    p = parport_pc_probe_port(link->io.BasePort1, link->io.BasePort2,
			      link->irq.AssignedIRQ, PARPORT_DMA_NONE,
			      &link->dev);
    if (p == NULL) {
	printk(KERN_NOTICE "parport_cs: parport_pc_probe_port() at "
	       "0x%3x, irq %u failed\n", link->io.BasePort1,
	       link->irq.AssignedIRQ);
	goto failed;
    }

    p->modes |= PARPORT_MODE_PCSPP;
    if (epp_mode)
	p->modes |= PARPORT_MODE_TRISTATE | PARPORT_MODE_EPP;
    info->ndev = 1;
    info->node.major = LP_MAJOR;
    info->node.minor = p->number;
    info->port = p;
    strcpy(info->node.dev_name, p->name);
    link->dev_node = &info->node;

    return 0;

cs_failed:
    cs_error(link, last_fn, last_ret);
failed:
    parport_cs_release(link);
    return -ENODEV;
} /* parport_config */

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

    After a card is removed, parport_cs_release() will unregister the
    device, and release the PCMCIA configuration.  If the device is
    still open, this will be postponed until it is closed.
    
======================================================================*/

void parport_cs_release(struct pcmcia_device *link)
{
	parport_info_t *info = link->priv;

	DEBUG(0, "parport_release(0x%p)\n", link);

	if (info->ndev) {
		struct parport *p = info->port;
		parport_pc_unregister_port(p);
	}
	info->ndev = 0;

	pcmcia_disable_device(link);
} /* parport_cs_release */


static struct pcmcia_device_id parport_ids[] = {
	PCMCIA_DEVICE_FUNC_ID(3),
	PCMCIA_MFC_DEVICE_PROD_ID12(1,"Elan","Serial+Parallel Port: SP230",0x3beb8cf2,0xdb9e58bc),
	PCMCIA_DEVICE_MANF_CARD(0x0137, 0x0003),
	PCMCIA_DEVICE_NULL
};
MODULE_DEVICE_TABLE(pcmcia, parport_ids);

static struct pcmcia_driver parport_cs_driver = {
	.owner		= THIS_MODULE,
	.drv		= {
		.name	= "parport_cs",
	},
	.probe		= parport_probe,
	.remove		= parport_detach,
	.id_table	= parport_ids,
};

static int __init init_parport_cs(void)
{
	return pcmcia_register_driver(&parport_cs_driver);
}

static void __exit exit_parport_cs(void)
{
	pcmcia_unregister_driver(&parport_cs_driver);
}

module_init(init_parport_cs);
module_exit(exit_parport_cs);
Commit	Line	Data
1da177e4 LT	1	/*======================================================================
	2
	3	A driver for PCMCIA parallel port adapters
	4
	5	(specifically, for the Quatech SPP-100 EPP card: other cards will
	6	probably require driver tweaks)
	7
	8	parport_cs.c 1.29 2002/10/11 06:57:41
	9
	10	The contents of this file are subject to the Mozilla Public
	11	License Version 1.1 (the "License"); you may not use this file
	12	except in compliance with the License. You may obtain a copy of
	13	the License at http://www.mozilla.org/MPL/
	14
	15	Software distributed under the License is distributed on an "AS
	16	IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
	17	implied. See the License for the specific language governing
	18	rights and limitations under the License.
	19
	20	The initial developer of the original code is David A. Hinds
	21	<dahinds@users.sourceforge.net>. Portions created by David A. Hinds
	22	are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
	23
	24	Alternatively, the contents of this file may be used under the
	25	terms of the GNU General Public License version 2 (the "GPL"), in
	26	which case the provisions of the GPL are applicable instead of the
	27	above. If you wish to allow the use of your version of this file
	28	only under the terms of the GPL and not to allow others to use
	29	your version of this file under the MPL, indicate your decision
	30	by deleting the provisions above and replace them with the notice
	31	and other provisions required by the GPL. If you do not delete
	32	the provisions above, a recipient may use your version of this
	33	file under either the MPL or the GPL.
	34
	35	======================================================================*/
	36
	37	#include <linux/kernel.h>
	38	#include <linux/module.h>
	39	#include <linux/init.h>
1da177e4 LT	40	#include <linux/ptrace.h>
	41	#include <linux/slab.h>
	42	#include <linux/string.h>
	43	#include <linux/timer.h>
	44	#include <linux/ioport.h>
	45	#include <linux/major.h>
	46
	47	#include <linux/parport.h>
	48	#include <linux/parport_pc.h>
	49
1da177e4 LT	50	#include <pcmcia/cs_types.h>
	51	#include <pcmcia/cs.h>
	52	#include <pcmcia/cistpl.h>
	53	#include <pcmcia/ds.h>
	54	#include <pcmcia/cisreg.h>
	55	#include <pcmcia/ciscode.h>
	56
	57	/====================================================================/
	58
	59	/* Module parameters */
	60
	61	MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
	62	MODULE_DESCRIPTION("PCMCIA parallel port card driver");
	63	MODULE_LICENSE("Dual MPL/GPL");
	64
	65	#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
	66
	67	INT_MODULE_PARM(epp_mode, 1);
	68
	69	#ifdef PCMCIA_DEBUG
	70	INT_MODULE_PARM(pc_debug, PCMCIA_DEBUG);
	71	#define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
	72	static char *version =
	73	"parport_cs.c 1.29 2002/10/11 06:57:41 (David Hinds)";
	74	#else
	75	#define DEBUG(n, args...)
	76	#endif
	77
	78	/====================================================================/
	79
	80	#define FORCE_EPP_MODE 0x08
	81
	82	typedef struct parport_info_t {
fd238232	83	struct pcmcia_device *p_dev;
1da177e4 LT	84	int ndev;
	85	dev_node_t node;
	86	struct parport *port;
	87	} parport_info_t;
	88
cc3b4866	89	static void parport_detach(struct pcmcia_device *p_dev);
15b99ac1	90	static int parport_config(struct pcmcia_device *link);
fba395ee	91	static void parport_cs_release(struct pcmcia_device *);
1da177e4 LT	92
	93	/*======================================================================
	94
	95	parport_attach() creates an "instance" of the driver, allocating
	96	local data structures for one device. The device is registered
	97	with Card Services.
	98
	99	======================================================================*/
	100
15b99ac1	101	static int parport_probe(struct pcmcia_device *link)
1da177e4 LT	102	{
1da177e4 LT	103	parport_info_t *info;
f8cfa618	104
1da177e4 LT	105	DEBUG(0, "parport_attach()\n");
	106
	107	/* Create new parport device */
	108	info = kmalloc(sizeof(*info), GFP_KERNEL);
f8cfa618	109	if (!info) return -ENOMEM;
1da177e4	110	memset(info, 0, sizeof(*info));
fd238232	111	link->priv = info;
fba395ee	112	info->p_dev = link;
1da177e4 LT	113
	114	link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
	115	link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
	116	link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
	117	link->irq.IRQInfo1 = IRQ_LEVEL_ID;
	118	link->conf.Attributes = CONF_ENABLE_IRQ;
1da177e4	119	link->conf.IntType = INT_MEMORY_AND_IO;
f8cfa618	120
15b99ac1	121	return parport_config(link);
1da177e4 LT	122	} /* parport_attach */
	123
	124	/*======================================================================
	125
	126	This deletes a driver "instance". The device is de-registered
	127	with Card Services. If it has been released, all local data
	128	structures are freed. Otherwise, the structures will be freed
	129	when the device is released.
	130
	131	======================================================================*/
	132
fba395ee	133	static void parport_detach(struct pcmcia_device *link)
1da177e4	134	{
1da177e4	135	DEBUG(0, "parport_detach(0x%p)\n", link);
cc3b4866	136
e2d40963	137	parport_cs_release(link);
cc3b4866	138
1da177e4	139	kfree(link->priv);
1da177e4 LT	140	} /* parport_detach */
	141
	142	/*======================================================================
	143
	144	parport_config() is scheduled to run after a CARD_INSERTION event
	145	is received, to configure the PCMCIA socket, and to make the
	146	parport device available to the system.
	147
	148	======================================================================*/
	149
	150	#define CS_CHECK(fn, ret) \
	151	do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
	152
15b99ac1	153	static int parport_config(struct pcmcia_device *link)
1da177e4	154	{
1da177e4 LT	155	parport_info_t *info = link->priv;
	156	tuple_t tuple;
	157	u_short buf[128];
	158	cisparse_t parse;
1da177e4 LT	159	cistpl_cftable_entry_t *cfg = &parse.cftable_entry;
	160	cistpl_cftable_entry_t dflt = { 0 };
	161	struct parport *p;
	162	int last_ret, last_fn;
	163
	164	DEBUG(0, "parport_config(0x%p)\n", link);
	165
	166	tuple.TupleData = (cisdata_t *)buf;
	167	tuple.TupleOffset = 0; tuple.TupleDataMax = 255;
1da177e4 LT	168	tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
1da177e4 LT	169	tuple.Attributes = 0;
fba395ee	170	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
1da177e4	171	while (1) {
fba395ee DB	172	if (pcmcia_get_tuple_data(link, &tuple) != 0 \|\|
fba395ee DB	173	pcmcia_parse_tuple(link, &tuple, &parse) != 0)
1da177e4 LT	174	goto next_entry;
	175
	176	if ((cfg->io.nwin > 0) \|\| (dflt.io.nwin > 0)) {
	177	cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
	178	link->conf.ConfigIndex = cfg->index;
	179	if (epp_mode)
	180	link->conf.ConfigIndex \|= FORCE_EPP_MODE;
	181	link->io.BasePort1 = io->win[0].base;
	182	link->io.NumPorts1 = io->win[0].len;
	183	link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
	184	if (io->nwin == 2) {
	185	link->io.BasePort2 = io->win[1].base;
	186	link->io.NumPorts2 = io->win[1].len;
	187	}
fba395ee	188	if (pcmcia_request_io(link, &link->io) != 0)
1da177e4 LT	189	goto next_entry;
	190	/* If we've got this far, we're done */
	191	break;
	192	}
	193
	194	next_entry:
	195	if (cfg->flags & CISTPL_CFTABLE_DEFAULT) dflt = *cfg;
fba395ee	196	CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
1da177e4 LT	197	}
1da177e4 LT	198
fba395ee DB	199	CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
fba395ee DB	200	CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
1da177e4	201
1da177e4 LT	202	p = parport_pc_probe_port(link->io.BasePort1, link->io.BasePort2,
1da177e4 LT	203	link->irq.AssignedIRQ, PARPORT_DMA_NONE,
c15a3837	204	&link->dev);
1da177e4 LT	205	if (p == NULL) {
	206	printk(KERN_NOTICE "parport_cs: parport_pc_probe_port() at "
	207	"0x%3x, irq %u failed\n", link->io.BasePort1,
	208	link->irq.AssignedIRQ);
	209	goto failed;
	210	}
	211
	212	p->modes \|= PARPORT_MODE_PCSPP;
	213	if (epp_mode)
	214	p->modes \|= PARPORT_MODE_TRISTATE \| PARPORT_MODE_EPP;
	215	info->ndev = 1;
	216	info->node.major = LP_MAJOR;
	217	info->node.minor = p->number;
	218	info->port = p;
	219	strcpy(info->node.dev_name, p->name);
fd238232	220	link->dev_node = &info->node;
1da177e4	221
15b99ac1 DB	222	return 0;
15b99ac1 DB	223
1da177e4	224	cs_failed:
fba395ee	225	cs_error(link, last_fn, last_ret);
1da177e4 LT	226	failed:
1da177e4 LT	227	parport_cs_release(link);
15b99ac1	228	return -ENODEV;
1da177e4 LT	229	} /* parport_config */
	230
	231	/*======================================================================
	232
	233	After a card is removed, parport_cs_release() will unregister the
	234	device, and release the PCMCIA configuration. If the device is
	235	still open, this will be postponed until it is closed.
	236
	237	======================================================================*/
	238
fba395ee	239	void parport_cs_release(struct pcmcia_device *link)
1da177e4	240	{
5f2a71fc	241	parport_info_t *info = link->priv;
1da177e4	242
5f2a71fc DB	243	DEBUG(0, "parport_release(0x%p)\n", link);
	244
	245	if (info->ndev) {
	246	struct parport *p = info->port;
	247	parport_pc_unregister_port(p);
	248	}
	249	info->ndev = 0;
1da177e4	250
fba395ee	251	pcmcia_disable_device(link);
1da177e4 LT	252	} /* parport_cs_release */
1da177e4 LT	253
98e4c28b	254
476835af DB	255	static struct pcmcia_device_id parport_ids[] = {
476835af DB	256	PCMCIA_DEVICE_FUNC_ID(3),
44e5e33e	257	PCMCIA_MFC_DEVICE_PROD_ID12(1,"Elan","Serial+Parallel Port: SP230",0x3beb8cf2,0xdb9e58bc),
476835af DB	258	PCMCIA_DEVICE_MANF_CARD(0x0137, 0x0003),
	259	PCMCIA_DEVICE_NULL
	260	};
	261	MODULE_DEVICE_TABLE(pcmcia, parport_ids);
	262
1da177e4 LT	263	static struct pcmcia_driver parport_cs_driver = {
	264	.owner = THIS_MODULE,
	265	.drv = {
	266	.name = "parport_cs",
	267	},
15b99ac1	268	.probe = parport_probe,
cc3b4866	269	.remove = parport_detach,
476835af	270	.id_table = parport_ids,
1da177e4 LT	271	};
	272
	273	static int __init init_parport_cs(void)
	274	{
	275	return pcmcia_register_driver(&parport_cs_driver);
	276	}
	277
	278	static void __exit exit_parport_cs(void)
	279	{
	280	pcmcia_unregister_driver(&parport_cs_driver);
1da177e4 LT	281	}
	282
	283	module_init(init_parport_cs);
	284	module_exit(exit_parport_cs);