f1fc3990e2
serial_cs's vendor/device identification got broken by Yum Rayan's change '[PATCH] serial_cs: Reduce stack usage in serial_event()' - it changed buf type from u_short* to char*, breaking device manufacturer & card number retrieval. Due to this my modem stopped from being recognized as special case. Code will work much better if we'll rely on first_tuple's parser instead of doing parse ourselves. Code also looks simpler after change. Signed-off-by: Petr Vandrovec <vandrove@vc.cvut.cz> Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
799 lines
22 KiB
C
799 lines
22 KiB
C
/*======================================================================
|
|
|
|
A driver for PCMCIA serial devices
|
|
|
|
serial_cs.c 1.134 2002/05/04 05:48:53
|
|
|
|
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/module.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <linux/kernel.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/serial_core.h>
|
|
#include <linux/major.h>
|
|
#include <asm/io.h>
|
|
#include <asm/system.h>
|
|
|
|
#include <pcmcia/version.h>
|
|
#include <pcmcia/cs_types.h>
|
|
#include <pcmcia/cs.h>
|
|
#include <pcmcia/cistpl.h>
|
|
#include <pcmcia/ciscode.h>
|
|
#include <pcmcia/ds.h>
|
|
#include <pcmcia/cisreg.h>
|
|
|
|
#include "8250.h"
|
|
|
|
#ifdef PCMCIA_DEBUG
|
|
static int pc_debug = PCMCIA_DEBUG;
|
|
module_param(pc_debug, int, 0644);
|
|
#define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
|
|
static char *version = "serial_cs.c 1.134 2002/05/04 05:48:53 (David Hinds)";
|
|
#else
|
|
#define DEBUG(n, args...)
|
|
#endif
|
|
|
|
/*====================================================================*/
|
|
|
|
/* Parameters that can be set with 'insmod' */
|
|
|
|
/* Enable the speaker? */
|
|
static int do_sound = 1;
|
|
/* Skip strict UART tests? */
|
|
static int buggy_uart;
|
|
|
|
module_param(do_sound, int, 0444);
|
|
module_param(buggy_uart, int, 0444);
|
|
|
|
/*====================================================================*/
|
|
|
|
/* Table of multi-port card ID's */
|
|
|
|
struct multi_id {
|
|
u_short manfid;
|
|
u_short prodid;
|
|
int multi; /* 1 = multifunction, > 1 = # ports */
|
|
};
|
|
|
|
static struct multi_id multi_id[] = {
|
|
{ MANFID_OMEGA, PRODID_OMEGA_QSP_100, 4 },
|
|
{ MANFID_QUATECH, PRODID_QUATECH_DUAL_RS232, 2 },
|
|
{ MANFID_QUATECH, PRODID_QUATECH_DUAL_RS232_D1, 2 },
|
|
{ MANFID_QUATECH, PRODID_QUATECH_QUAD_RS232, 4 },
|
|
{ MANFID_SOCKET, PRODID_SOCKET_DUAL_RS232, 2 },
|
|
{ MANFID_INTEL, PRODID_INTEL_DUAL_RS232, 2 },
|
|
{ MANFID_NATINST, PRODID_NATINST_QUAD_RS232, 4 }
|
|
};
|
|
#define MULTI_COUNT (sizeof(multi_id)/sizeof(struct multi_id))
|
|
|
|
struct serial_info {
|
|
dev_link_t link;
|
|
int ndev;
|
|
int multi;
|
|
int slave;
|
|
int manfid;
|
|
dev_node_t node[4];
|
|
int line[4];
|
|
};
|
|
|
|
struct serial_cfg_mem {
|
|
tuple_t tuple;
|
|
cisparse_t parse;
|
|
u_char buf[256];
|
|
};
|
|
|
|
|
|
static void serial_config(dev_link_t * link);
|
|
static int serial_event(event_t event, int priority,
|
|
event_callback_args_t * args);
|
|
|
|
static dev_info_t dev_info = "serial_cs";
|
|
|
|
static dev_link_t *serial_attach(void);
|
|
static void serial_detach(dev_link_t *);
|
|
|
|
static dev_link_t *dev_list = NULL;
|
|
|
|
/*======================================================================
|
|
|
|
After a card is removed, serial_remove() will unregister
|
|
the serial device(s), and release the PCMCIA configuration.
|
|
|
|
======================================================================*/
|
|
|
|
static void serial_remove(dev_link_t *link)
|
|
{
|
|
struct serial_info *info = link->priv;
|
|
int i;
|
|
|
|
link->state &= ~DEV_PRESENT;
|
|
|
|
DEBUG(0, "serial_release(0x%p)\n", link);
|
|
|
|
/*
|
|
* Recheck to see if the device is still configured.
|
|
*/
|
|
if (info->link.state & DEV_CONFIG) {
|
|
for (i = 0; i < info->ndev; i++)
|
|
serial8250_unregister_port(info->line[i]);
|
|
|
|
info->link.dev = NULL;
|
|
|
|
if (!info->slave) {
|
|
pcmcia_release_configuration(info->link.handle);
|
|
pcmcia_release_io(info->link.handle, &info->link.io);
|
|
pcmcia_release_irq(info->link.handle, &info->link.irq);
|
|
}
|
|
|
|
info->link.state &= ~DEV_CONFIG;
|
|
}
|
|
}
|
|
|
|
static void serial_suspend(dev_link_t *link)
|
|
{
|
|
link->state |= DEV_SUSPEND;
|
|
|
|
if (link->state & DEV_CONFIG) {
|
|
struct serial_info *info = link->priv;
|
|
int i;
|
|
|
|
for (i = 0; i < info->ndev; i++)
|
|
serial8250_suspend_port(info->line[i]);
|
|
|
|
if (!info->slave)
|
|
pcmcia_release_configuration(link->handle);
|
|
}
|
|
}
|
|
|
|
static void serial_resume(dev_link_t *link)
|
|
{
|
|
link->state &= ~DEV_SUSPEND;
|
|
|
|
if (DEV_OK(link)) {
|
|
struct serial_info *info = link->priv;
|
|
int i;
|
|
|
|
if (!info->slave)
|
|
pcmcia_request_configuration(link->handle, &link->conf);
|
|
|
|
for (i = 0; i < info->ndev; i++)
|
|
serial8250_resume_port(info->line[i]);
|
|
}
|
|
}
|
|
|
|
/*======================================================================
|
|
|
|
serial_attach() creates an "instance" of the driver, allocating
|
|
local data structures for one device. The device is registered
|
|
with Card Services.
|
|
|
|
======================================================================*/
|
|
|
|
static dev_link_t *serial_attach(void)
|
|
{
|
|
struct serial_info *info;
|
|
client_reg_t client_reg;
|
|
dev_link_t *link;
|
|
int ret;
|
|
|
|
DEBUG(0, "serial_attach()\n");
|
|
|
|
/* Create new serial device */
|
|
info = kmalloc(sizeof (*info), GFP_KERNEL);
|
|
if (!info)
|
|
return NULL;
|
|
memset(info, 0, sizeof (*info));
|
|
link = &info->link;
|
|
link->priv = info;
|
|
|
|
link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
|
|
link->io.NumPorts1 = 8;
|
|
link->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
|
|
link->irq.IRQInfo1 = IRQ_LEVEL_ID;
|
|
link->conf.Attributes = CONF_ENABLE_IRQ;
|
|
if (do_sound) {
|
|
link->conf.Attributes |= CONF_ENABLE_SPKR;
|
|
link->conf.Status = CCSR_AUDIO_ENA;
|
|
}
|
|
link->conf.IntType = INT_MEMORY_AND_IO;
|
|
|
|
/* Register with Card Services */
|
|
link->next = dev_list;
|
|
dev_list = link;
|
|
client_reg.dev_info = &dev_info;
|
|
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 = &serial_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);
|
|
serial_detach(link);
|
|
return NULL;
|
|
}
|
|
|
|
return link;
|
|
}
|
|
|
|
/*======================================================================
|
|
|
|
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 serial_detach(dev_link_t * link)
|
|
{
|
|
struct serial_info *info = link->priv;
|
|
dev_link_t **linkp;
|
|
int ret;
|
|
|
|
DEBUG(0, "serial_detach(0x%p)\n", link);
|
|
|
|
/* Locate device structure */
|
|
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
|
if (*linkp == link)
|
|
break;
|
|
if (*linkp == NULL)
|
|
return;
|
|
|
|
/*
|
|
* Ensure any outstanding scheduled tasks are completed.
|
|
*/
|
|
flush_scheduled_work();
|
|
|
|
/*
|
|
* Ensure that the ports have been released.
|
|
*/
|
|
serial_remove(link);
|
|
|
|
if (link->handle) {
|
|
ret = pcmcia_deregister_client(link->handle);
|
|
if (ret != CS_SUCCESS)
|
|
cs_error(link->handle, DeregisterClient, ret);
|
|
}
|
|
|
|
/* Unlink device structure, free bits */
|
|
*linkp = link->next;
|
|
kfree(info);
|
|
}
|
|
|
|
/*====================================================================*/
|
|
|
|
static int setup_serial(client_handle_t handle, struct serial_info * info,
|
|
kio_addr_t iobase, int irq)
|
|
{
|
|
struct uart_port port;
|
|
int line;
|
|
|
|
memset(&port, 0, sizeof (struct uart_port));
|
|
port.iobase = iobase;
|
|
port.irq = irq;
|
|
port.flags = UPF_BOOT_AUTOCONF | UPF_SKIP_TEST | UPF_SHARE_IRQ;
|
|
port.uartclk = 1843200;
|
|
port.dev = &handle_to_dev(handle);
|
|
if (buggy_uart)
|
|
port.flags |= UPF_BUGGY_UART;
|
|
line = serial8250_register_port(&port);
|
|
if (line < 0) {
|
|
printk(KERN_NOTICE "serial_cs: serial8250_register_port() at "
|
|
"0x%04lx, irq %d failed\n", (u_long)iobase, irq);
|
|
return -EINVAL;
|
|
}
|
|
|
|
info->line[info->ndev] = line;
|
|
sprintf(info->node[info->ndev].dev_name, "ttyS%d", line);
|
|
info->node[info->ndev].major = TTY_MAJOR;
|
|
info->node[info->ndev].minor = 0x40 + line;
|
|
if (info->ndev > 0)
|
|
info->node[info->ndev - 1].next = &info->node[info->ndev];
|
|
info->ndev++;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*====================================================================*/
|
|
|
|
static int
|
|
first_tuple(client_handle_t handle, tuple_t * tuple, cisparse_t * parse)
|
|
{
|
|
int i;
|
|
i = pcmcia_get_first_tuple(handle, tuple);
|
|
if (i != CS_SUCCESS)
|
|
return CS_NO_MORE_ITEMS;
|
|
i = pcmcia_get_tuple_data(handle, tuple);
|
|
if (i != CS_SUCCESS)
|
|
return i;
|
|
return pcmcia_parse_tuple(handle, tuple, parse);
|
|
}
|
|
|
|
static int
|
|
next_tuple(client_handle_t handle, tuple_t * tuple, cisparse_t * parse)
|
|
{
|
|
int i;
|
|
i = pcmcia_get_next_tuple(handle, tuple);
|
|
if (i != CS_SUCCESS)
|
|
return CS_NO_MORE_ITEMS;
|
|
i = pcmcia_get_tuple_data(handle, tuple);
|
|
if (i != CS_SUCCESS)
|
|
return i;
|
|
return pcmcia_parse_tuple(handle, tuple, parse);
|
|
}
|
|
|
|
/*====================================================================*/
|
|
|
|
static int simple_config(dev_link_t *link)
|
|
{
|
|
static kio_addr_t base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
|
|
static int size_table[2] = { 8, 16 };
|
|
client_handle_t handle = link->handle;
|
|
struct serial_info *info = link->priv;
|
|
struct serial_cfg_mem *cfg_mem;
|
|
tuple_t *tuple;
|
|
u_char *buf;
|
|
cisparse_t *parse;
|
|
cistpl_cftable_entry_t *cf;
|
|
config_info_t config;
|
|
int i, j, try;
|
|
int s;
|
|
|
|
cfg_mem = kmalloc(sizeof(struct serial_cfg_mem), GFP_KERNEL);
|
|
if (!cfg_mem)
|
|
return -1;
|
|
|
|
tuple = &cfg_mem->tuple;
|
|
parse = &cfg_mem->parse;
|
|
cf = &parse->cftable_entry;
|
|
buf = cfg_mem->buf;
|
|
|
|
/* If the card is already configured, look up the port and irq */
|
|
i = pcmcia_get_configuration_info(handle, &config);
|
|
if ((i == CS_SUCCESS) && (config.Attributes & CONF_VALID_CLIENT)) {
|
|
kio_addr_t port = 0;
|
|
if ((config.BasePort2 != 0) && (config.NumPorts2 == 8)) {
|
|
port = config.BasePort2;
|
|
info->slave = 1;
|
|
} else if ((info->manfid == MANFID_OSITECH) &&
|
|
(config.NumPorts1 == 0x40)) {
|
|
port = config.BasePort1 + 0x28;
|
|
info->slave = 1;
|
|
}
|
|
if (info->slave) {
|
|
kfree(cfg_mem);
|
|
return setup_serial(handle, info, port, config.AssignedIRQ);
|
|
}
|
|
}
|
|
link->conf.Vcc = config.Vcc;
|
|
|
|
/* First pass: look for a config entry that looks normal. */
|
|
tuple->TupleData = (cisdata_t *) buf;
|
|
tuple->TupleOffset = 0;
|
|
tuple->TupleDataMax = 255;
|
|
tuple->Attributes = 0;
|
|
tuple->DesiredTuple = CISTPL_CFTABLE_ENTRY;
|
|
/* Two tries: without IO aliases, then with aliases */
|
|
for (s = 0; s < 2; s++) {
|
|
for (try = 0; try < 2; try++) {
|
|
i = first_tuple(handle, tuple, parse);
|
|
while (i != CS_NO_MORE_ITEMS) {
|
|
if (i != CS_SUCCESS)
|
|
goto next_entry;
|
|
if (cf->vpp1.present & (1 << CISTPL_POWER_VNOM))
|
|
link->conf.Vpp1 = link->conf.Vpp2 =
|
|
cf->vpp1.param[CISTPL_POWER_VNOM] / 10000;
|
|
if ((cf->io.nwin > 0) && (cf->io.win[0].len == size_table[s]) &&
|
|
(cf->io.win[0].base != 0)) {
|
|
link->conf.ConfigIndex = cf->index;
|
|
link->io.BasePort1 = cf->io.win[0].base;
|
|
link->io.IOAddrLines = (try == 0) ?
|
|
16 : cf->io.flags & CISTPL_IO_LINES_MASK;
|
|
i = pcmcia_request_io(link->handle, &link->io);
|
|
if (i == CS_SUCCESS)
|
|
goto found_port;
|
|
}
|
|
next_entry:
|
|
i = next_tuple(handle, tuple, parse);
|
|
}
|
|
}
|
|
}
|
|
/* Second pass: try to find an entry that isn't picky about
|
|
its base address, then try to grab any standard serial port
|
|
address, and finally try to get any free port. */
|
|
i = first_tuple(handle, tuple, parse);
|
|
while (i != CS_NO_MORE_ITEMS) {
|
|
if ((i == CS_SUCCESS) && (cf->io.nwin > 0) &&
|
|
((cf->io.flags & CISTPL_IO_LINES_MASK) <= 3)) {
|
|
link->conf.ConfigIndex = cf->index;
|
|
for (j = 0; j < 5; j++) {
|
|
link->io.BasePort1 = base[j];
|
|
link->io.IOAddrLines = base[j] ? 16 : 3;
|
|
i = pcmcia_request_io(link->handle, &link->io);
|
|
if (i == CS_SUCCESS)
|
|
goto found_port;
|
|
}
|
|
}
|
|
i = next_tuple(handle, tuple, parse);
|
|
}
|
|
|
|
found_port:
|
|
if (i != CS_SUCCESS) {
|
|
printk(KERN_NOTICE
|
|
"serial_cs: no usable port range found, giving up\n");
|
|
cs_error(link->handle, RequestIO, i);
|
|
kfree(cfg_mem);
|
|
return -1;
|
|
}
|
|
|
|
i = pcmcia_request_irq(link->handle, &link->irq);
|
|
if (i != CS_SUCCESS) {
|
|
cs_error(link->handle, RequestIRQ, i);
|
|
link->irq.AssignedIRQ = 0;
|
|
}
|
|
if (info->multi && (info->manfid == MANFID_3COM))
|
|
link->conf.ConfigIndex &= ~(0x08);
|
|
i = pcmcia_request_configuration(link->handle, &link->conf);
|
|
if (i != CS_SUCCESS) {
|
|
cs_error(link->handle, RequestConfiguration, i);
|
|
kfree(cfg_mem);
|
|
return -1;
|
|
}
|
|
kfree(cfg_mem);
|
|
return setup_serial(handle, info, link->io.BasePort1, link->irq.AssignedIRQ);
|
|
}
|
|
|
|
static int multi_config(dev_link_t * link)
|
|
{
|
|
client_handle_t handle = link->handle;
|
|
struct serial_info *info = link->priv;
|
|
struct serial_cfg_mem *cfg_mem;
|
|
tuple_t *tuple;
|
|
u_char *buf;
|
|
cisparse_t *parse;
|
|
cistpl_cftable_entry_t *cf;
|
|
config_info_t config;
|
|
int i, rc, base2 = 0;
|
|
|
|
cfg_mem = kmalloc(sizeof(struct serial_cfg_mem), GFP_KERNEL);
|
|
if (!cfg_mem)
|
|
return -1;
|
|
tuple = &cfg_mem->tuple;
|
|
parse = &cfg_mem->parse;
|
|
cf = &parse->cftable_entry;
|
|
buf = cfg_mem->buf;
|
|
|
|
i = pcmcia_get_configuration_info(handle, &config);
|
|
if (i != CS_SUCCESS) {
|
|
cs_error(handle, GetConfigurationInfo, i);
|
|
rc = -1;
|
|
goto free_cfg_mem;
|
|
}
|
|
link->conf.Vcc = config.Vcc;
|
|
|
|
tuple->TupleData = (cisdata_t *) buf;
|
|
tuple->TupleOffset = 0;
|
|
tuple->TupleDataMax = 255;
|
|
tuple->Attributes = 0;
|
|
tuple->DesiredTuple = CISTPL_CFTABLE_ENTRY;
|
|
|
|
/* First, look for a generic full-sized window */
|
|
link->io.NumPorts1 = info->multi * 8;
|
|
i = first_tuple(handle, tuple, parse);
|
|
while (i != CS_NO_MORE_ITEMS) {
|
|
/* The quad port cards have bad CIS's, so just look for a
|
|
window larger than 8 ports and assume it will be right */
|
|
if ((i == CS_SUCCESS) && (cf->io.nwin == 1) &&
|
|
(cf->io.win[0].len > 8)) {
|
|
link->conf.ConfigIndex = cf->index;
|
|
link->io.BasePort1 = cf->io.win[0].base;
|
|
link->io.IOAddrLines =
|
|
cf->io.flags & CISTPL_IO_LINES_MASK;
|
|
i = pcmcia_request_io(link->handle, &link->io);
|
|
base2 = link->io.BasePort1 + 8;
|
|
if (i == CS_SUCCESS)
|
|
break;
|
|
}
|
|
i = next_tuple(handle, tuple, parse);
|
|
}
|
|
|
|
/* If that didn't work, look for two windows */
|
|
if (i != CS_SUCCESS) {
|
|
link->io.NumPorts1 = link->io.NumPorts2 = 8;
|
|
info->multi = 2;
|
|
i = first_tuple(handle, tuple, parse);
|
|
while (i != CS_NO_MORE_ITEMS) {
|
|
if ((i == CS_SUCCESS) && (cf->io.nwin == 2)) {
|
|
link->conf.ConfigIndex = cf->index;
|
|
link->io.BasePort1 = cf->io.win[0].base;
|
|
link->io.BasePort2 = cf->io.win[1].base;
|
|
link->io.IOAddrLines =
|
|
cf->io.flags & CISTPL_IO_LINES_MASK;
|
|
i = pcmcia_request_io(link->handle, &link->io);
|
|
base2 = link->io.BasePort2;
|
|
if (i == CS_SUCCESS)
|
|
break;
|
|
}
|
|
i = next_tuple(handle, tuple, parse);
|
|
}
|
|
}
|
|
|
|
if (i != CS_SUCCESS) {
|
|
cs_error(link->handle, RequestIO, i);
|
|
rc = -1;
|
|
goto free_cfg_mem;
|
|
}
|
|
|
|
i = pcmcia_request_irq(link->handle, &link->irq);
|
|
if (i != CS_SUCCESS) {
|
|
printk(KERN_NOTICE
|
|
"serial_cs: no usable port range found, giving up\n");
|
|
cs_error(link->handle, RequestIRQ, i);
|
|
link->irq.AssignedIRQ = 0;
|
|
}
|
|
/* Socket Dual IO: this enables irq's for second port */
|
|
if (info->multi && (info->manfid == MANFID_SOCKET)) {
|
|
link->conf.Present |= PRESENT_EXT_STATUS;
|
|
link->conf.ExtStatus = ESR_REQ_ATTN_ENA;
|
|
}
|
|
i = pcmcia_request_configuration(link->handle, &link->conf);
|
|
if (i != CS_SUCCESS) {
|
|
cs_error(link->handle, RequestConfiguration, i);
|
|
rc = -1;
|
|
goto free_cfg_mem;
|
|
}
|
|
|
|
/* The Oxford Semiconductor OXCF950 cards are in fact single-port:
|
|
8 registers are for the UART, the others are extra registers */
|
|
if (info->manfid == MANFID_OXSEMI) {
|
|
if (cf->index == 1 || cf->index == 3) {
|
|
setup_serial(handle, info, base2, link->irq.AssignedIRQ);
|
|
outb(12, link->io.BasePort1 + 1);
|
|
} else {
|
|
setup_serial(handle, info, link->io.BasePort1, link->irq.AssignedIRQ);
|
|
outb(12, base2 + 1);
|
|
}
|
|
rc = 0;
|
|
goto free_cfg_mem;
|
|
}
|
|
|
|
setup_serial(handle, info, link->io.BasePort1, link->irq.AssignedIRQ);
|
|
/* The Nokia cards are not really multiport cards */
|
|
if (info->manfid == MANFID_NOKIA) {
|
|
rc = 0;
|
|
goto free_cfg_mem;
|
|
}
|
|
for (i = 0; i < info->multi - 1; i++)
|
|
setup_serial(handle, info, base2 + (8 * i),
|
|
link->irq.AssignedIRQ);
|
|
rc = 0;
|
|
free_cfg_mem:
|
|
kfree(cfg_mem);
|
|
return rc;
|
|
}
|
|
|
|
/*======================================================================
|
|
|
|
serial_config() is scheduled to run after a CARD_INSERTION event
|
|
is received, to configure the PCMCIA socket, and to make the
|
|
serial device available to the system.
|
|
|
|
======================================================================*/
|
|
|
|
void serial_config(dev_link_t * link)
|
|
{
|
|
client_handle_t handle = link->handle;
|
|
struct serial_info *info = link->priv;
|
|
struct serial_cfg_mem *cfg_mem;
|
|
tuple_t *tuple;
|
|
u_char *buf;
|
|
cisparse_t *parse;
|
|
cistpl_cftable_entry_t *cf;
|
|
int i, last_ret, last_fn;
|
|
|
|
DEBUG(0, "serial_config(0x%p)\n", link);
|
|
|
|
cfg_mem = kmalloc(sizeof(struct serial_cfg_mem), GFP_KERNEL);
|
|
if (!cfg_mem)
|
|
goto failed;
|
|
|
|
tuple = &cfg_mem->tuple;
|
|
parse = &cfg_mem->parse;
|
|
cf = &parse->cftable_entry;
|
|
buf = cfg_mem->buf;
|
|
|
|
tuple->TupleData = (cisdata_t *) buf;
|
|
tuple->TupleOffset = 0;
|
|
tuple->TupleDataMax = 255;
|
|
tuple->Attributes = 0;
|
|
/* Get configuration register information */
|
|
tuple->DesiredTuple = CISTPL_CONFIG;
|
|
last_ret = first_tuple(handle, tuple, parse);
|
|
if (last_ret != CS_SUCCESS) {
|
|
last_fn = ParseTuple;
|
|
goto cs_failed;
|
|
}
|
|
link->conf.ConfigBase = parse->config.base;
|
|
link->conf.Present = parse->config.rmask[0];
|
|
|
|
/* Configure card */
|
|
link->state |= DEV_CONFIG;
|
|
|
|
/* Is this a compliant multifunction card? */
|
|
tuple->DesiredTuple = CISTPL_LONGLINK_MFC;
|
|
tuple->Attributes = TUPLE_RETURN_COMMON | TUPLE_RETURN_LINK;
|
|
info->multi = (first_tuple(handle, tuple, parse) == CS_SUCCESS);
|
|
|
|
/* Is this a multiport card? */
|
|
tuple->DesiredTuple = CISTPL_MANFID;
|
|
if (first_tuple(handle, tuple, parse) == CS_SUCCESS) {
|
|
info->manfid = parse->manfid.manf;
|
|
for (i = 0; i < MULTI_COUNT; i++)
|
|
if ((info->manfid == multi_id[i].manfid) &&
|
|
(parse->manfid.card == multi_id[i].prodid))
|
|
break;
|
|
if (i < MULTI_COUNT)
|
|
info->multi = multi_id[i].multi;
|
|
}
|
|
|
|
/* Another check for dual-serial cards: look for either serial or
|
|
multifunction cards that ask for appropriate IO port ranges */
|
|
tuple->DesiredTuple = CISTPL_FUNCID;
|
|
if ((info->multi == 0) &&
|
|
((first_tuple(handle, tuple, parse) != CS_SUCCESS) ||
|
|
(parse->funcid.func == CISTPL_FUNCID_MULTI) ||
|
|
(parse->funcid.func == CISTPL_FUNCID_SERIAL))) {
|
|
tuple->DesiredTuple = CISTPL_CFTABLE_ENTRY;
|
|
if (first_tuple(handle, tuple, parse) == CS_SUCCESS) {
|
|
if ((cf->io.nwin == 1) && (cf->io.win[0].len % 8 == 0))
|
|
info->multi = cf->io.win[0].len >> 3;
|
|
if ((cf->io.nwin == 2) && (cf->io.win[0].len == 8) &&
|
|
(cf->io.win[1].len == 8))
|
|
info->multi = 2;
|
|
}
|
|
}
|
|
|
|
if (info->multi > 1)
|
|
multi_config(link);
|
|
else
|
|
simple_config(link);
|
|
|
|
if (info->ndev == 0)
|
|
goto failed;
|
|
|
|
if (info->manfid == MANFID_IBM) {
|
|
conf_reg_t reg = { 0, CS_READ, 0x800, 0 };
|
|
last_ret = pcmcia_access_configuration_register(link->handle, ®);
|
|
if (last_ret) {
|
|
last_fn = AccessConfigurationRegister;
|
|
goto cs_failed;
|
|
}
|
|
reg.Action = CS_WRITE;
|
|
reg.Value = reg.Value | 1;
|
|
last_ret = pcmcia_access_configuration_register(link->handle, ®);
|
|
if (last_ret) {
|
|
last_fn = AccessConfigurationRegister;
|
|
goto cs_failed;
|
|
}
|
|
}
|
|
|
|
link->dev = &info->node[0];
|
|
link->state &= ~DEV_CONFIG_PENDING;
|
|
kfree(cfg_mem);
|
|
return;
|
|
|
|
cs_failed:
|
|
cs_error(link->handle, last_fn, last_ret);
|
|
failed:
|
|
serial_remove(link);
|
|
link->state &= ~DEV_CONFIG_PENDING;
|
|
kfree(cfg_mem);
|
|
}
|
|
|
|
/*======================================================================
|
|
|
|
The card status event handler. Mostly, this schedules other
|
|
stuff to run after an event is received. A CARD_REMOVAL event
|
|
also sets some flags to discourage the serial drivers from
|
|
talking to the ports.
|
|
|
|
======================================================================*/
|
|
|
|
static int
|
|
serial_event(event_t event, int priority, event_callback_args_t * args)
|
|
{
|
|
dev_link_t *link = args->client_data;
|
|
struct serial_info *info = link->priv;
|
|
|
|
DEBUG(1, "serial_event(0x%06x)\n", event);
|
|
|
|
switch (event) {
|
|
case CS_EVENT_CARD_REMOVAL:
|
|
serial_remove(link);
|
|
break;
|
|
|
|
case CS_EVENT_CARD_INSERTION:
|
|
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
|
serial_config(link);
|
|
break;
|
|
|
|
case CS_EVENT_PM_SUSPEND:
|
|
serial_suspend(link);
|
|
break;
|
|
|
|
case CS_EVENT_RESET_PHYSICAL:
|
|
if ((link->state & DEV_CONFIG) && !info->slave)
|
|
pcmcia_release_configuration(link->handle);
|
|
break;
|
|
|
|
case CS_EVENT_PM_RESUME:
|
|
serial_resume(link);
|
|
break;
|
|
|
|
case CS_EVENT_CARD_RESET:
|
|
if (DEV_OK(link) && !info->slave)
|
|
pcmcia_request_configuration(link->handle, &link->conf);
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static struct pcmcia_driver serial_cs_driver = {
|
|
.owner = THIS_MODULE,
|
|
.drv = {
|
|
.name = "serial_cs",
|
|
},
|
|
.attach = serial_attach,
|
|
.detach = serial_detach,
|
|
};
|
|
|
|
static int __init init_serial_cs(void)
|
|
{
|
|
return pcmcia_register_driver(&serial_cs_driver);
|
|
}
|
|
|
|
static void __exit exit_serial_cs(void)
|
|
{
|
|
pcmcia_unregister_driver(&serial_cs_driver);
|
|
BUG_ON(dev_list != NULL);
|
|
}
|
|
|
|
module_init(init_serial_cs);
|
|
module_exit(exit_serial_cs);
|
|
|
|
MODULE_LICENSE("GPL");
|