|
@@ -217,101 +217,68 @@ static void sedlbauer_detach(struct pcmcia_device *link)
|
|
|
#define CS_CHECK(fn, ret) \
|
|
|
do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
|
|
|
|
|
|
-static int sedlbauer_config(struct pcmcia_device *link)
|
|
|
-{
|
|
|
- local_info_t *dev = link->priv;
|
|
|
- tuple_t tuple;
|
|
|
- cisparse_t parse;
|
|
|
- int last_fn, last_ret;
|
|
|
- u8 buf[64];
|
|
|
- config_info_t conf;
|
|
|
- win_req_t req;
|
|
|
- memreq_t map;
|
|
|
- IsdnCard_t icard;
|
|
|
-
|
|
|
- DEBUG(0, "sedlbauer_config(0x%p)\n", link);
|
|
|
-
|
|
|
- tuple.Attributes = 0;
|
|
|
- tuple.TupleData = buf;
|
|
|
- tuple.TupleDataMax = sizeof(buf);
|
|
|
- tuple.TupleOffset = 0;
|
|
|
+struct sedlbauer_config_data {
|
|
|
+ cistpl_cftable_entry_t dflt;
|
|
|
+ config_info_t conf;
|
|
|
+ win_req_t req;
|
|
|
+};
|
|
|
|
|
|
- CS_CHECK(GetConfigurationInfo, pcmcia_get_configuration_info(link, &conf));
|
|
|
+static int sedlbauer_config_check(struct pcmcia_device *p_dev,
|
|
|
+ cistpl_cftable_entry_t *cfg,
|
|
|
+ void *priv_data)
|
|
|
+{
|
|
|
+ struct sedlbauer_config_data *cfg_mem = priv_data;
|
|
|
|
|
|
- /*
|
|
|
- In this loop, we scan the CIS for configuration table entries,
|
|
|
- each of which describes a valid card configuration, including
|
|
|
- voltage, IO window, memory window, and interrupt settings.
|
|
|
+ if (cfg->flags & CISTPL_CFTABLE_DEFAULT)
|
|
|
+ cfg_mem->dflt = *cfg;
|
|
|
+ if (cfg->index == 0)
|
|
|
+ return -ENODEV;
|
|
|
+ p_dev->conf.ConfigIndex = cfg->index;
|
|
|
|
|
|
- We make no assumptions about the card to be configured: we use
|
|
|
- just the information available in the CIS. In an ideal world,
|
|
|
- this would work for any PCMCIA card, but it requires a complete
|
|
|
- and accurate CIS. In practice, a driver usually "knows" most of
|
|
|
- these things without consulting the CIS, and most client drivers
|
|
|
- will only use the CIS to fill in implementation-defined details.
|
|
|
- */
|
|
|
- tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
|
|
|
- CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
|
|
|
- while (1) {
|
|
|
- cistpl_cftable_entry_t dflt = { 0 };
|
|
|
- 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;
|
|
|
-
|
|
|
/* Does this card need audio output? */
|
|
|
if (cfg->flags & CISTPL_CFTABLE_AUDIO) {
|
|
|
- link->conf.Attributes |= CONF_ENABLE_SPKR;
|
|
|
- link->conf.Status = CCSR_AUDIO_ENA;
|
|
|
+ p_dev->conf.Attributes |= CONF_ENABLE_SPKR;
|
|
|
+ p_dev->conf.Status = CCSR_AUDIO_ENA;
|
|
|
}
|
|
|
-
|
|
|
+
|
|
|
/* 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 (conf.Vcc != cfg->vcc.param[CISTPL_POWER_VNOM]/10000)
|
|
|
- goto next_entry;
|
|
|
- } else if (dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
|
|
|
- if (conf.Vcc != dflt.vcc.param[CISTPL_POWER_VNOM]/10000)
|
|
|
- goto next_entry;
|
|
|
+ if (cfg_mem->conf.Vcc != cfg->vcc.param[CISTPL_POWER_VNOM]/10000)
|
|
|
+ return -ENODEV;
|
|
|
+ } else if (cfg_mem->dflt.vcc.present & (1<<CISTPL_POWER_VNOM)) {
|
|
|
+ if (cfg_mem->conf.Vcc != cfg_mem->dflt.vcc.param[CISTPL_POWER_VNOM]/10000)
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
-
|
|
|
+
|
|
|
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;
|
|
|
-
|
|
|
+ p_dev->conf.Vpp = cfg->vpp1.param[CISTPL_POWER_VNOM]/10000;
|
|
|
+ else if (cfg_mem->dflt.vpp1.present & (1<<CISTPL_POWER_VNOM))
|
|
|
+ p_dev->conf.Vpp = cfg_mem->dflt.vpp1.param[CISTPL_POWER_VNOM]/10000;
|
|
|
+
|
|
|
/* Do we need to allocate an interrupt? */
|
|
|
- if (cfg->irq.IRQInfo1 || dflt.irq.IRQInfo1)
|
|
|
- link->conf.Attributes |= CONF_ENABLE_IRQ;
|
|
|
-
|
|
|
+ if (cfg->irq.IRQInfo1 || cfg_mem->dflt.irq.IRQInfo1)
|
|
|
+ p_dev->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_AUTO;
|
|
|
- if (!(io->flags & CISTPL_IO_8BIT))
|
|
|
- link->io.Attributes1 = IO_DATA_PATH_WIDTH_16;
|
|
|
- if (!(io->flags & CISTPL_IO_16BIT))
|
|
|
- link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
|
|
|
-/* new in dummy.cs 2001/01/28 MN
|
|
|
- link->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
|
|
|
-*/
|
|
|
- link->io.BasePort1 = io->win[0].base;
|
|
|
- link->io.NumPorts1 = io->win[0].len;
|
|
|
- if (io->nwin > 1) {
|
|
|
- link->io.Attributes2 = link->io.Attributes1;
|
|
|
- link->io.BasePort2 = io->win[1].base;
|
|
|
- link->io.NumPorts2 = io->win[1].len;
|
|
|
- }
|
|
|
- /* This reserves IO space but doesn't actually enable it */
|
|
|
- if (pcmcia_request_io(link, &link->io) != 0)
|
|
|
- goto next_entry;
|
|
|
+ p_dev->io.NumPorts1 = p_dev->io.NumPorts2 = 0;
|
|
|
+ if ((cfg->io.nwin > 0) || (cfg_mem->dflt.io.nwin > 0)) {
|
|
|
+ cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &cfg_mem->dflt.io;
|
|
|
+ p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
|
|
|
+ if (!(io->flags & CISTPL_IO_8BIT))
|
|
|
+ p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_16;
|
|
|
+ if (!(io->flags & CISTPL_IO_16BIT))
|
|
|
+ p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
|
|
|
+ p_dev->io.BasePort1 = io->win[0].base;
|
|
|
+ p_dev->io.NumPorts1 = io->win[0].len;
|
|
|
+ if (io->nwin > 1) {
|
|
|
+ p_dev->io.Attributes2 = p_dev->io.Attributes1;
|
|
|
+ p_dev->io.BasePort2 = io->win[1].base;
|
|
|
+ p_dev->io.NumPorts2 = io->win[1].len;
|
|
|
+ }
|
|
|
+ /* This reserves IO space but doesn't actually enable it */
|
|
|
+ if (pcmcia_request_io(p_dev, &p_dev->io) != 0)
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
|
|
|
/*
|
|
@@ -325,30 +292,58 @@ static int sedlbauer_config(struct pcmcia_device *link)
|
|
|
needs to be mapped to virtual space with ioremap() before it
|
|
|
is used.
|
|
|
*/
|
|
|
- if ((cfg->mem.nwin > 0) || (dflt.mem.nwin > 0)) {
|
|
|
- cistpl_mem_t *mem =
|
|
|
- (cfg->mem.nwin) ? &cfg->mem : &dflt.mem;
|
|
|
- req.Attributes = WIN_DATA_WIDTH_16|WIN_MEMORY_TYPE_CM;
|
|
|
- req.Attributes |= WIN_ENABLE;
|
|
|
- req.Base = mem->win[0].host_addr;
|
|
|
- req.Size = mem->win[0].len;
|
|
|
-/* new in dummy.cs 2001/01/28 MN
|
|
|
- if (req.Size < 0x1000)
|
|
|
- req.Size = 0x1000;
|
|
|
-*/
|
|
|
- req.AccessSpeed = 0;
|
|
|
- if (pcmcia_request_window(&link, &req, &link->win) != 0)
|
|
|
- goto next_entry;
|
|
|
- map.Page = 0; map.CardOffset = mem->win[0].card_addr;
|
|
|
- if (pcmcia_map_mem_page(link->win, &map) != 0)
|
|
|
- goto next_entry;
|
|
|
+ if ((cfg->mem.nwin > 0) || (cfg_mem->dflt.mem.nwin > 0)) {
|
|
|
+ cistpl_mem_t *mem = (cfg->mem.nwin) ? &cfg->mem : &cfg_mem->dflt.mem;
|
|
|
+ memreq_t map;
|
|
|
+ cfg_mem->req.Attributes = WIN_DATA_WIDTH_16|WIN_MEMORY_TYPE_CM;
|
|
|
+ cfg_mem->req.Attributes |= WIN_ENABLE;
|
|
|
+ cfg_mem->req.Base = mem->win[0].host_addr;
|
|
|
+ cfg_mem->req.Size = mem->win[0].len;
|
|
|
+ cfg_mem->req.AccessSpeed = 0;
|
|
|
+ if (pcmcia_request_window(&p_dev, &cfg_mem->req, &p_dev->win) != 0)
|
|
|
+ return -ENODEV;
|
|
|
+ map.Page = 0;
|
|
|
+ map.CardOffset = mem->win[0].card_addr;
|
|
|
+ if (pcmcia_map_mem_page(p_dev->win, &map) != 0)
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
- /* If we got this far, we're cool! */
|
|
|
- break;
|
|
|
+ return 0;
|
|
|
+}
|
|
|
|
|
|
- next_entry:
|
|
|
- CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
|
|
|
- }
|
|
|
+
|
|
|
+
|
|
|
+static int sedlbauer_config(struct pcmcia_device *link)
|
|
|
+{
|
|
|
+ local_info_t *dev = link->priv;
|
|
|
+ struct sedlbauer_config_data *cfg_mem;
|
|
|
+ int last_fn, last_ret;
|
|
|
+ IsdnCard_t icard;
|
|
|
+
|
|
|
+ DEBUG(0, "sedlbauer_config(0x%p)\n", link);
|
|
|
+
|
|
|
+ cfg_mem = kzalloc(sizeof(struct sedlbauer_config_data), GFP_KERNEL);
|
|
|
+ if (!cfg_mem)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ /* Look up the current Vcc */
|
|
|
+ CS_CHECK(GetConfigurationInfo,
|
|
|
+ pcmcia_get_configuration_info(link, &cfg_mem->conf));
|
|
|
+
|
|
|
+ /*
|
|
|
+ In this loop, we scan the CIS for configuration table entries,
|
|
|
+ each of which describes a valid card configuration, including
|
|
|
+ voltage, IO window, memory window, and interrupt settings.
|
|
|
+
|
|
|
+ We make no assumptions about the card to be configured: we use
|
|
|
+ just the information available in the CIS. In an ideal world,
|
|
|
+ this would work for any PCMCIA card, but it requires a complete
|
|
|
+ and accurate CIS. In practice, a driver usually "knows" most of
|
|
|
+ these things without consulting the CIS, and most client drivers
|
|
|
+ will only use the CIS to fill in implementation-defined details.
|
|
|
+ */
|
|
|
+ last_ret = pcmcia_loop_config(link, sedlbauer_config_check, cfg_mem);
|
|
|
+ if (last_ret)
|
|
|
+ goto failed;
|
|
|
|
|
|
/*
|
|
|
Allocate an interrupt line. Note that this does not assign a
|
|
@@ -387,8 +382,8 @@ static int sedlbauer_config(struct pcmcia_device *link)
|
|
|
printk(" & 0x%04x-0x%04x", link->io.BasePort2,
|
|
|
link->io.BasePort2+link->io.NumPorts2-1);
|
|
|
if (link->win)
|
|
|
- printk(", mem 0x%06lx-0x%06lx", req.Base,
|
|
|
- req.Base+req.Size-1);
|
|
|
+ printk(", mem 0x%06lx-0x%06lx", cfg_mem->req.Base,
|
|
|
+ cfg_mem->req.Base+cfg_mem->req.Size-1);
|
|
|
printk("\n");
|
|
|
|
|
|
icard.para[0] = link->irq.AssignedIRQ;
|
|
@@ -409,6 +404,7 @@ static int sedlbauer_config(struct pcmcia_device *link)
|
|
|
|
|
|
cs_failed:
|
|
|
cs_error(link, last_fn, last_ret);
|
|
|
+failed:
|
|
|
sedlbauer_release(link);
|
|
|
return -ENODEV;
|
|
|
|