Use the new module_pcmcia_driver() macro to remove the boilerplate module init/exit code in the pcmcia drivers. Signed-off-by: H Hartley Sweeten <hsweeten@visionengravers.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
		
			
				
	
	
		
			218 lines
		
	
	
	
		
			5.8 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			218 lines
		
	
	
	
		
			5.8 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
/*======================================================================
 | 
						|
 | 
						|
  An elsa_cs PCMCIA client driver
 | 
						|
 | 
						|
  This driver is for the Elsa PCM ISDN Cards, i.e. the MicroLink
 | 
						|
 | 
						|
 | 
						|
  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.
 | 
						|
 | 
						|
  Modifications from dummy_cs.c are Copyright (C) 1999-2001 Klaus
 | 
						|
  Lichtenwalder <Lichtenwalder@ACM.org>. 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/module.h>
 | 
						|
#include <linux/kernel.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 <asm/io.h>
 | 
						|
 | 
						|
#include <pcmcia/cistpl.h>
 | 
						|
#include <pcmcia/cisreg.h>
 | 
						|
#include <pcmcia/ds.h>
 | 
						|
#include "hisax_cfg.h"
 | 
						|
 | 
						|
MODULE_DESCRIPTION("ISDN4Linux: PCMCIA client driver for Elsa PCM cards");
 | 
						|
MODULE_AUTHOR("Klaus Lichtenwalder");
 | 
						|
MODULE_LICENSE("Dual MPL/GPL");
 | 
						|
 | 
						|
 | 
						|
/*====================================================================*/
 | 
						|
 | 
						|
/* Parameters that can be set with 'insmod' */
 | 
						|
 | 
						|
static int protocol = 2;        /* EURO-ISDN Default */
 | 
						|
module_param(protocol, int, 0);
 | 
						|
 | 
						|
static int elsa_cs_config(struct pcmcia_device *link);
 | 
						|
static void elsa_cs_release(struct pcmcia_device *link);
 | 
						|
static void elsa_cs_detach(struct pcmcia_device *p_dev);
 | 
						|
 | 
						|
typedef struct local_info_t {
 | 
						|
	struct pcmcia_device	*p_dev;
 | 
						|
	int                 busy;
 | 
						|
	int			cardnr;
 | 
						|
} local_info_t;
 | 
						|
 | 
						|
static int elsa_cs_probe(struct pcmcia_device *link)
 | 
						|
{
 | 
						|
	local_info_t *local;
 | 
						|
 | 
						|
	dev_dbg(&link->dev, "elsa_cs_attach()\n");
 | 
						|
 | 
						|
	/* Allocate space for private device-specific data */
 | 
						|
	local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
 | 
						|
	if (!local) return -ENOMEM;
 | 
						|
 | 
						|
	local->p_dev = link;
 | 
						|
	link->priv = local;
 | 
						|
 | 
						|
	local->cardnr = -1;
 | 
						|
 | 
						|
	return elsa_cs_config(link);
 | 
						|
} /* elsa_cs_attach */
 | 
						|
 | 
						|
static void elsa_cs_detach(struct pcmcia_device *link)
 | 
						|
{
 | 
						|
	local_info_t *info = link->priv;
 | 
						|
 | 
						|
	dev_dbg(&link->dev, "elsa_cs_detach(0x%p)\n", link);
 | 
						|
 | 
						|
	info->busy = 1;
 | 
						|
	elsa_cs_release(link);
 | 
						|
 | 
						|
	kfree(info);
 | 
						|
} /* elsa_cs_detach */
 | 
						|
 | 
						|
static int elsa_cs_configcheck(struct pcmcia_device *p_dev, void *priv_data)
 | 
						|
{
 | 
						|
	int j;
 | 
						|
 | 
						|
	p_dev->io_lines = 3;
 | 
						|
	p_dev->resource[0]->end = 8;
 | 
						|
	p_dev->resource[0]->flags &= IO_DATA_PATH_WIDTH;
 | 
						|
	p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_AUTO;
 | 
						|
 | 
						|
	if ((p_dev->resource[0]->end) && p_dev->resource[0]->start) {
 | 
						|
		printk(KERN_INFO "(elsa_cs: looks like the 96 model)\n");
 | 
						|
		if (!pcmcia_request_io(p_dev))
 | 
						|
			return 0;
 | 
						|
	} else {
 | 
						|
		printk(KERN_INFO "(elsa_cs: looks like the 97 model)\n");
 | 
						|
		for (j = 0x2f0; j > 0x100; j -= 0x10) {
 | 
						|
			p_dev->resource[0]->start = j;
 | 
						|
			if (!pcmcia_request_io(p_dev))
 | 
						|
				return 0;
 | 
						|
		}
 | 
						|
	}
 | 
						|
	return -ENODEV;
 | 
						|
}
 | 
						|
 | 
						|
static int elsa_cs_config(struct pcmcia_device *link)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	IsdnCard_t icard;
 | 
						|
 | 
						|
	dev_dbg(&link->dev, "elsa_config(0x%p)\n", link);
 | 
						|
 | 
						|
	link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
 | 
						|
 | 
						|
	i = pcmcia_loop_config(link, elsa_cs_configcheck, NULL);
 | 
						|
	if (i != 0)
 | 
						|
		goto failed;
 | 
						|
 | 
						|
	if (!link->irq)
 | 
						|
		goto failed;
 | 
						|
 | 
						|
	i = pcmcia_enable_device(link);
 | 
						|
	if (i != 0)
 | 
						|
		goto failed;
 | 
						|
 | 
						|
	icard.para[0] = link->irq;
 | 
						|
	icard.para[1] = link->resource[0]->start;
 | 
						|
	icard.protocol = protocol;
 | 
						|
	icard.typ = ISDN_CTYPE_ELSA_PCMCIA;
 | 
						|
 | 
						|
	i = hisax_init_pcmcia(link, &(((local_info_t *)link->priv)->busy), &icard);
 | 
						|
	if (i < 0) {
 | 
						|
		printk(KERN_ERR "elsa_cs: failed to initialize Elsa "
 | 
						|
		       "PCMCIA %d with %pR\n", i, link->resource[0]);
 | 
						|
		elsa_cs_release(link);
 | 
						|
	} else
 | 
						|
		((local_info_t *)link->priv)->cardnr = i;
 | 
						|
 | 
						|
	return 0;
 | 
						|
failed:
 | 
						|
	elsa_cs_release(link);
 | 
						|
	return -ENODEV;
 | 
						|
} /* elsa_cs_config */
 | 
						|
 | 
						|
static void elsa_cs_release(struct pcmcia_device *link)
 | 
						|
{
 | 
						|
	local_info_t *local = link->priv;
 | 
						|
 | 
						|
	dev_dbg(&link->dev, "elsa_cs_release(0x%p)\n", link);
 | 
						|
 | 
						|
	if (local) {
 | 
						|
		if (local->cardnr >= 0) {
 | 
						|
			/* no unregister function with hisax */
 | 
						|
			HiSax_closecard(local->cardnr);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	pcmcia_disable_device(link);
 | 
						|
} /* elsa_cs_release */
 | 
						|
 | 
						|
static int elsa_suspend(struct pcmcia_device *link)
 | 
						|
{
 | 
						|
	local_info_t *dev = link->priv;
 | 
						|
 | 
						|
	dev->busy = 1;
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int elsa_resume(struct pcmcia_device *link)
 | 
						|
{
 | 
						|
	local_info_t *dev = link->priv;
 | 
						|
 | 
						|
	dev->busy = 0;
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static const struct pcmcia_device_id elsa_ids[] = {
 | 
						|
	PCMCIA_DEVICE_PROD_ID12("ELSA AG (Aachen, Germany)", "MicroLink ISDN/MC ", 0x983de2c4, 0x333ba257),
 | 
						|
	PCMCIA_DEVICE_PROD_ID12("ELSA GmbH, Aachen", "MicroLink ISDN/MC ", 0x639e5718, 0x333ba257),
 | 
						|
	PCMCIA_DEVICE_NULL
 | 
						|
};
 | 
						|
MODULE_DEVICE_TABLE(pcmcia, elsa_ids);
 | 
						|
 | 
						|
static struct pcmcia_driver elsa_cs_driver = {
 | 
						|
	.owner		= THIS_MODULE,
 | 
						|
	.name		= "elsa_cs",
 | 
						|
	.probe		= elsa_cs_probe,
 | 
						|
	.remove		= elsa_cs_detach,
 | 
						|
	.id_table	= elsa_ids,
 | 
						|
	.suspend	= elsa_suspend,
 | 
						|
	.resume		= elsa_resume,
 | 
						|
};
 | 
						|
module_pcmcia_driver(elsa_cs_driver);
 |