2005-04-17 06:20:36 +08:00
|
|
|
/* $Id: teles_cs.c,v 1.1.2.2 2004/01/25 15:07:06 keil Exp $ */
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
A teles S0 PCMCIA client driver
|
|
|
|
|
|
|
|
Based on skeleton by David Hinds, dhinds@allegro.stanford.edu
|
|
|
|
Written by Christof Petig, christof.petig@wtal.de
|
|
|
|
|
|
|
|
Also inspired by ELSA PCMCIA driver
|
|
|
|
by Klaus Lichtenwalder <Lichtenwalder@ACM.org>
|
|
|
|
|
|
|
|
Extentions to new hisax_pcmcia by Karsten Keil
|
|
|
|
|
|
|
|
minor changes to be compatible with kernel 2.4.x
|
|
|
|
by Jan.Schubert@GMX.li
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
|
|
|
#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 <asm/io.h>
|
|
|
|
#include <asm/system.h>
|
|
|
|
|
|
|
|
#include <pcmcia/cs.h>
|
|
|
|
#include <pcmcia/cistpl.h>
|
|
|
|
#include <pcmcia/cisreg.h>
|
|
|
|
#include <pcmcia/ds.h>
|
|
|
|
#include "hisax_cfg.h"
|
|
|
|
|
|
|
|
MODULE_DESCRIPTION("ISDN4Linux: PCMCIA client driver for Teles PCMCIA cards");
|
|
|
|
MODULE_AUTHOR("Christof Petig, christof.petig@wtal.de, Karsten Keil, kkeil@suse.de");
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
|
|
|
|
|
|
/*====================================================================*/
|
|
|
|
|
|
|
|
/* Parameters that can be set with 'insmod' */
|
|
|
|
|
|
|
|
static int protocol = 2; /* EURO-ISDN Default */
|
|
|
|
module_param(protocol, int, 0);
|
|
|
|
|
|
|
|
/*====================================================================*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
The event() function is this driver's Card Services event handler.
|
|
|
|
It will be called by Card Services when an appropriate card status
|
|
|
|
event is received. The config() and release() entry points are
|
|
|
|
used to configure or release a socket, in response to card insertion
|
|
|
|
and ejection events. They are invoked from the teles_cs event
|
|
|
|
handler.
|
|
|
|
*/
|
|
|
|
|
2010-03-25 20:05:30 +08:00
|
|
|
static int teles_cs_config(struct pcmcia_device *link) __devinit ;
|
2006-03-31 23:21:06 +08:00
|
|
|
static void teles_cs_release(struct pcmcia_device *link);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
The attach() and detach() entry points are used to create and destroy
|
|
|
|
"instances" of the driver, where each instance represents everything
|
|
|
|
needed to manage one actual PCMCIA card.
|
|
|
|
*/
|
|
|
|
|
2010-03-25 20:05:30 +08:00
|
|
|
static void teles_detach(struct pcmcia_device *p_dev) __devexit ;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
typedef struct local_info_t {
|
2006-03-05 17:45:09 +08:00
|
|
|
struct pcmcia_device *p_dev;
|
2005-04-17 06:20:36 +08:00
|
|
|
int busy;
|
|
|
|
int cardnr;
|
|
|
|
} local_info_t;
|
|
|
|
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
teles_attach() creates an "instance" of the driver, allocatingx
|
|
|
|
local data structures for one device. The device is registered
|
|
|
|
with Card Services.
|
|
|
|
|
|
|
|
The dev_link structure is initialized, but we don't actually
|
|
|
|
configure the card at this point -- we wait until we receive a
|
|
|
|
card insertion event.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
2010-03-25 20:05:30 +08:00
|
|
|
static int __devinit teles_probe(struct pcmcia_device *link)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
local_info_t *local;
|
|
|
|
|
2009-10-24 21:50:13 +08:00
|
|
|
dev_dbg(&link->dev, "teles_attach()\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/* Allocate space for private device-specific data */
|
2006-12-08 18:39:35 +08:00
|
|
|
local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
|
2005-11-15 04:25:51 +08:00
|
|
|
if (!local) return -ENOMEM;
|
2005-04-17 06:20:36 +08:00
|
|
|
local->cardnr = -1;
|
2006-03-05 17:45:09 +08:00
|
|
|
|
2006-03-31 23:21:06 +08:00
|
|
|
local->p_dev = link;
|
2006-03-05 17:45:09 +08:00
|
|
|
link->priv = local;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
General socket configuration defaults can go here. In this
|
|
|
|
client, we assume very little, and rely on the CIS for almost
|
|
|
|
everything. In most clients, many details (i.e., number, sizes,
|
|
|
|
and attributes of IO windows) are fixed by the nature of the
|
|
|
|
device, and can be hard-wired here.
|
|
|
|
*/
|
|
|
|
link->io.NumPorts1 = 96;
|
|
|
|
link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
|
|
|
|
link->io.IOAddrLines = 5;
|
|
|
|
|
|
|
|
link->conf.Attributes = CONF_ENABLE_IRQ;
|
|
|
|
link->conf.IntType = INT_MEMORY_AND_IO;
|
|
|
|
|
2006-03-31 23:26:06 +08:00
|
|
|
return teles_cs_config(link);
|
2005-04-17 06:20:36 +08:00
|
|
|
} /* teles_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.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
2010-03-25 20:05:30 +08:00
|
|
|
static void __devexit teles_detach(struct pcmcia_device *link)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2006-03-02 07:09:29 +08:00
|
|
|
local_info_t *info = link->priv;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2009-10-24 21:50:13 +08:00
|
|
|
dev_dbg(&link->dev, "teles_detach(0x%p)\n", link);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-03-02 07:09:29 +08:00
|
|
|
info->busy = 1;
|
|
|
|
teles_cs_release(link);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-03-02 07:09:29 +08:00
|
|
|
kfree(info);
|
2005-04-17 06:20:36 +08:00
|
|
|
} /* teles_detach */
|
|
|
|
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
teles_cs_config() is scheduled to run after a CARD_INSERTION event
|
|
|
|
is received, to configure the PCMCIA socket, and to make the
|
|
|
|
device available to the system.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
2008-07-29 14:38:55 +08:00
|
|
|
static int teles_cs_configcheck(struct pcmcia_device *p_dev,
|
|
|
|
cistpl_cftable_entry_t *cf,
|
2008-08-02 21:30:31 +08:00
|
|
|
cistpl_cftable_entry_t *dflt,
|
2008-08-02 22:12:00 +08:00
|
|
|
unsigned int vcc,
|
2008-07-29 14:38:55 +08:00
|
|
|
void *priv_data)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2008-07-29 14:38:55 +08:00
|
|
|
int j;
|
|
|
|
|
|
|
|
if ((cf->io.nwin > 0) && cf->io.win[0].base) {
|
|
|
|
printk(KERN_INFO "(teles_cs: looks like the 96 model)\n");
|
|
|
|
p_dev->io.BasePort1 = cf->io.win[0].base;
|
|
|
|
if (!pcmcia_request_io(p_dev, &p_dev->io))
|
|
|
|
return 0;
|
|
|
|
} else {
|
|
|
|
printk(KERN_INFO "(teles_cs: looks like the 97 model)\n");
|
|
|
|
for (j = 0x2f0; j > 0x100; j -= 0x10) {
|
|
|
|
p_dev->io.BasePort1 = j;
|
|
|
|
if (!pcmcia_request_io(p_dev, &p_dev->io))
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return -ENODEV;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2010-03-25 20:05:30 +08:00
|
|
|
static int __devinit teles_cs_config(struct pcmcia_device *link)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
local_info_t *dev;
|
2009-10-24 21:50:13 +08:00
|
|
|
int i;
|
2005-04-17 06:20:36 +08:00
|
|
|
IsdnCard_t icard;
|
|
|
|
|
2009-10-24 21:50:13 +08:00
|
|
|
dev_dbg(&link->dev, "teles_config(0x%p)\n", link);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev = link->priv;
|
|
|
|
|
2008-07-29 14:38:55 +08:00
|
|
|
i = pcmcia_loop_config(link, teles_cs_configcheck, NULL);
|
2009-10-24 21:50:13 +08:00
|
|
|
if (i != 0)
|
2005-04-17 06:20:36 +08:00
|
|
|
goto cs_failed;
|
|
|
|
|
2010-03-07 19:21:16 +08:00
|
|
|
if (!link->irq)
|
2005-04-17 06:20:36 +08:00
|
|
|
goto cs_failed;
|
|
|
|
|
2006-03-31 23:21:06 +08:00
|
|
|
i = pcmcia_request_configuration(link, &link->conf);
|
2009-10-24 21:50:13 +08:00
|
|
|
if (i != 0)
|
2005-04-17 06:20:36 +08:00
|
|
|
goto cs_failed;
|
|
|
|
|
|
|
|
/* Finally, report what we've done */
|
2010-03-21 02:35:12 +08:00
|
|
|
dev_info(&link->dev, "index 0x%02x:",
|
|
|
|
link->conf.ConfigIndex);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (link->conf.Attributes & CONF_ENABLE_IRQ)
|
2010-03-07 19:21:16 +08:00
|
|
|
printk(", irq %d", link->irq);
|
2010-07-24 21:58:54 +08:00
|
|
|
if (link->resource[0])
|
|
|
|
printk(" & %pR", link->resource[0]);
|
|
|
|
if (link->resource[1])
|
|
|
|
printk(" & %pR", link->resource[1]);
|
2005-04-17 06:20:36 +08:00
|
|
|
printk("\n");
|
|
|
|
|
2010-03-07 19:21:16 +08:00
|
|
|
icard.para[0] = link->irq;
|
2010-07-24 21:58:54 +08:00
|
|
|
icard.para[1] = link->resource[0]->start;
|
2005-04-17 06:20:36 +08:00
|
|
|
icard.protocol = protocol;
|
|
|
|
icard.typ = ISDN_CTYPE_TELESPCMCIA;
|
|
|
|
|
|
|
|
i = hisax_init_pcmcia(link, &(((local_info_t*)link->priv)->busy), &icard);
|
|
|
|
if (i < 0) {
|
|
|
|
printk(KERN_ERR "teles_cs: failed to initialize Teles PCMCIA %d at i/o %#x\n",
|
2010-07-24 21:58:54 +08:00
|
|
|
i, (unsigned int) link->resource[0]->start);
|
2005-04-17 06:20:36 +08:00
|
|
|
teles_cs_release(link);
|
2006-03-31 23:26:06 +08:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
((local_info_t*)link->priv)->cardnr = i;
|
|
|
|
return 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
cs_failed:
|
|
|
|
teles_cs_release(link);
|
2006-03-31 23:26:06 +08:00
|
|
|
return -ENODEV;
|
2005-04-17 06:20:36 +08:00
|
|
|
} /* teles_cs_config */
|
|
|
|
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
After a card is removed, teles_cs_release() will unregister the net
|
|
|
|
device, and release the PCMCIA configuration. If the device is
|
|
|
|
still open, this will be postponed until it is closed.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
2006-03-31 23:21:06 +08:00
|
|
|
static void teles_cs_release(struct pcmcia_device *link)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
local_info_t *local = link->priv;
|
|
|
|
|
2009-10-24 21:50:13 +08:00
|
|
|
dev_dbg(&link->dev, "teles_cs_release(0x%p)\n", link);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (local) {
|
|
|
|
if (local->cardnr >= 0) {
|
|
|
|
/* no unregister function with hisax */
|
|
|
|
HiSax_closecard(local->cardnr);
|
|
|
|
}
|
|
|
|
}
|
2006-01-15 16:32:39 +08:00
|
|
|
|
2006-03-31 23:21:06 +08:00
|
|
|
pcmcia_disable_device(link);
|
2005-04-17 06:20:36 +08:00
|
|
|
} /* teles_cs_release */
|
|
|
|
|
2006-03-31 23:21:06 +08:00
|
|
|
static int teles_suspend(struct pcmcia_device *link)
|
2005-11-15 04:21:18 +08:00
|
|
|
{
|
|
|
|
local_info_t *dev = link->priv;
|
|
|
|
|
|
|
|
dev->busy = 1;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2006-03-31 23:21:06 +08:00
|
|
|
static int teles_resume(struct pcmcia_device *link)
|
2005-11-15 04:21:18 +08:00
|
|
|
{
|
|
|
|
local_info_t *dev = link->priv;
|
|
|
|
|
|
|
|
dev->busy = 0;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2005-06-28 07:28:24 +08:00
|
|
|
static struct pcmcia_device_id teles_ids[] = {
|
|
|
|
PCMCIA_DEVICE_PROD_ID12("TELES", "S0/PC", 0x67b50eae, 0xe9e70119),
|
|
|
|
PCMCIA_DEVICE_NULL,
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(pcmcia, teles_ids);
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
static struct pcmcia_driver teles_cs_driver = {
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
.drv = {
|
|
|
|
.name = "teles_cs",
|
|
|
|
},
|
2006-03-31 23:26:06 +08:00
|
|
|
.probe = teles_probe,
|
2010-03-25 20:05:30 +08:00
|
|
|
.remove = __devexit_p(teles_detach),
|
2005-06-28 07:28:24 +08:00
|
|
|
.id_table = teles_ids,
|
2005-11-15 04:21:18 +08:00
|
|
|
.suspend = teles_suspend,
|
|
|
|
.resume = teles_resume,
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
static int __init init_teles_cs(void)
|
|
|
|
{
|
|
|
|
return pcmcia_register_driver(&teles_cs_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit exit_teles_cs(void)
|
|
|
|
{
|
|
|
|
pcmcia_unregister_driver(&teles_cs_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(init_teles_cs);
|
|
|
|
module_exit(exit_teles_cs);
|