2 * PCMCIA 16-bit resource management functions
4 * The initial developer of the original code is David A. Hinds
5 * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
6 * are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
8 * Copyright (C) 1999 David A. Hinds
9 * Copyright (C) 2004-2005 Dominik Brodowski
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
17 #include <linux/module.h>
18 #include <linux/kernel.h>
19 #include <linux/interrupt.h>
20 #include <linux/delay.h>
21 #include <linux/pci.h>
22 #include <linux/device.h>
23 #include <linux/netdevice.h>
24 #include <linux/slab.h>
28 #include <pcmcia/ss.h>
29 #include <pcmcia/cs.h>
30 #include <pcmcia/cistpl.h>
31 #include <pcmcia/cisreg.h>
32 #include <pcmcia/ds.h>
34 #include "cs_internal.h"
37 /* Access speed for IO windows */
39 module_param(io_speed
, int, 0444);
42 int pcmcia_validate_mem(struct pcmcia_socket
*s
)
44 if (s
->resource_ops
->validate_mem
)
45 return s
->resource_ops
->validate_mem(s
);
46 /* if there is no callback, we can assume that everything is OK */
50 struct resource
*pcmcia_find_mem_region(u_long base
, u_long num
, u_long align
,
51 int low
, struct pcmcia_socket
*s
)
53 if (s
->resource_ops
->find_mem
)
54 return s
->resource_ops
->find_mem(base
, num
, align
, low
, s
);
59 static void release_io_space(struct pcmcia_socket
*s
, struct resource
*res
)
61 resource_size_t num
= resource_size(res
);
64 dev_dbg(&s
->dev
, "release_io_space for %pR\n", res
);
66 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
69 if ((s
->io
[i
].res
->start
<= res
->start
) &&
70 (s
->io
[i
].res
->end
>= res
->end
)) {
71 s
->io
[i
].InUse
-= num
;
73 release_resource(res
);
74 res
->start
= res
->end
= 0;
75 res
->flags
= IORESOURCE_IO
;
76 /* Free the window if no one else is using it */
77 if (s
->io
[i
].InUse
== 0) {
78 release_resource(s
->io
[i
].res
);
84 } /* release_io_space */
88 * Special stuff for managing IO windows, because they are scarce
90 static int alloc_io_space(struct pcmcia_socket
*s
, struct resource
*res
,
94 unsigned int base
= res
->start
;
95 unsigned int num
= res
->end
;
98 res
->flags
|= IORESOURCE_IO
;
100 dev_dbg(&s
->dev
, "alloc_io_space request for %pR, %d lines\n",
103 align
= base
? (lines
? 1<<lines
: 0) : 1;
104 if (align
&& (align
< num
)) {
106 dev_dbg(&s
->dev
, "odd IO request\n");
109 while (align
&& (align
< num
))
112 if (base
& ~(align
-1)) {
113 dev_dbg(&s
->dev
, "odd IO request\n");
117 ret
= s
->resource_ops
->find_io(s
, res
->flags
, &base
, num
, align
,
120 dev_dbg(&s
->dev
, "alloc_io_space request failed (%d)\n", ret
);
125 res
->end
= res
->start
+ num
- 1;
128 ret
= request_resource(res
->parent
, res
);
131 "request_resource %pR failed: %d\n", res
, ret
);
133 release_io_space(s
, res
);
136 dev_dbg(&s
->dev
, "alloc_io_space request result %d: %pR\n", ret
, res
);
138 } /* alloc_io_space */
142 * pcmcia_access_config() - read or write card configuration registers
144 * pcmcia_access_config() reads and writes configuration registers in
145 * attribute memory. Memory window 0 is reserved for this and the tuple
146 * reading services. Drivers must use pcmcia_read_config_byte() or
147 * pcmcia_write_config_byte().
149 static int pcmcia_access_config(struct pcmcia_device
*p_dev
,
150 off_t where
, u8
*val
,
151 int (*accessf
) (struct pcmcia_socket
*s
,
152 int attr
, unsigned int addr
,
153 unsigned int len
, void *ptr
))
155 struct pcmcia_socket
*s
;
162 mutex_lock(&s
->ops_mutex
);
163 c
= p_dev
->function_config
;
165 if (!(c
->state
& CONFIG_LOCKED
)) {
166 dev_dbg(&p_dev
->dev
, "Configuration isnt't locked\n");
167 mutex_unlock(&s
->ops_mutex
);
171 addr
= (c
->ConfigBase
+ where
) >> 1;
173 ret
= accessf(s
, 1, addr
, 1, val
);
175 mutex_unlock(&s
->ops_mutex
);
178 } /* pcmcia_access_config */
182 * pcmcia_read_config_byte() - read a byte from a card configuration register
184 * pcmcia_read_config_byte() reads a byte from a configuration register in
187 int pcmcia_read_config_byte(struct pcmcia_device
*p_dev
, off_t where
, u8
*val
)
189 return pcmcia_access_config(p_dev
, where
, val
, pcmcia_read_cis_mem
);
191 EXPORT_SYMBOL(pcmcia_read_config_byte
);
195 * pcmcia_write_config_byte() - write a byte to a card configuration register
197 * pcmcia_write_config_byte() writes a byte to a configuration register in
200 int pcmcia_write_config_byte(struct pcmcia_device
*p_dev
, off_t where
, u8 val
)
202 return pcmcia_access_config(p_dev
, where
, &val
, pcmcia_write_cis_mem
);
204 EXPORT_SYMBOL(pcmcia_write_config_byte
);
207 int pcmcia_map_mem_page(struct pcmcia_device
*p_dev
, window_handle_t wh
,
210 struct pcmcia_socket
*s
= p_dev
->socket
;
211 struct resource
*res
= wh
;
215 w
= ((res
->flags
& IORESOURCE_BITS
& WIN_FLAGS_REQ
) >> 2) - 1;
219 mutex_lock(&s
->ops_mutex
);
220 s
->win
[w
].card_start
= offset
;
221 ret
= s
->ops
->set_mem_map(s
, &s
->win
[w
]);
223 dev_warn(&p_dev
->dev
, "failed to set_mem_map\n");
224 mutex_unlock(&s
->ops_mutex
);
226 } /* pcmcia_map_mem_page */
227 EXPORT_SYMBOL(pcmcia_map_mem_page
);
230 /** pcmcia_modify_configuration
232 * Modify a locked socket configuration
234 int pcmcia_modify_configuration(struct pcmcia_device
*p_dev
,
237 struct pcmcia_socket
*s
;
243 mutex_lock(&s
->ops_mutex
);
244 c
= p_dev
->function_config
;
246 if (!(s
->state
& SOCKET_PRESENT
)) {
247 dev_dbg(&p_dev
->dev
, "No card present\n");
251 if (!(c
->state
& CONFIG_LOCKED
)) {
252 dev_dbg(&p_dev
->dev
, "Configuration isnt't locked\n");
257 if (mod
->Attributes
& (CONF_IRQ_CHANGE_VALID
| CONF_VCC_CHANGE_VALID
)) {
259 "changing Vcc or IRQ is not allowed at this time\n");
264 /* We only allow changing Vpp1 and Vpp2 to the same value */
265 if ((mod
->Attributes
& CONF_VPP1_CHANGE_VALID
) &&
266 (mod
->Attributes
& CONF_VPP2_CHANGE_VALID
)) {
267 if (mod
->Vpp1
!= mod
->Vpp2
) {
269 "Vpp1 and Vpp2 must be the same\n");
273 s
->socket
.Vpp
= mod
->Vpp1
;
274 if (s
->ops
->set_socket(s
, &s
->socket
)) {
275 dev_printk(KERN_WARNING
, &p_dev
->dev
,
276 "Unable to set VPP\n");
280 } else if ((mod
->Attributes
& CONF_VPP1_CHANGE_VALID
) ||
281 (mod
->Attributes
& CONF_VPP2_CHANGE_VALID
)) {
283 "changing Vcc is not allowed at this time\n");
288 if (mod
->Attributes
& CONF_IO_CHANGE_WIDTH
) {
289 pccard_io_map io_off
= { 0, 0, 0, 0, 1 };
293 io_on
.speed
= io_speed
;
294 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
300 io_on
.flags
= MAP_ACTIVE
| IO_DATA_PATH_WIDTH_8
;
301 io_on
.start
= s
->io
[i
].res
->start
;
302 io_on
.stop
= s
->io
[i
].res
->end
;
304 s
->ops
->set_io_map(s
, &io_off
);
306 s
->ops
->set_io_map(s
, &io_on
);
311 mutex_unlock(&s
->ops_mutex
);
314 } /* modify_configuration */
315 EXPORT_SYMBOL(pcmcia_modify_configuration
);
318 int pcmcia_release_configuration(struct pcmcia_device
*p_dev
)
320 pccard_io_map io
= { 0, 0, 0, 0, 1 };
321 struct pcmcia_socket
*s
= p_dev
->socket
;
325 mutex_lock(&s
->ops_mutex
);
326 c
= p_dev
->function_config
;
327 if (p_dev
->_locked
) {
329 if (--(s
->lock_count
) == 0) {
330 s
->socket
.flags
= SS_OUTPUT_ENA
; /* Is this correct? */
332 s
->socket
.io_irq
= 0;
333 s
->ops
->set_socket(s
, &s
->socket
);
336 if (c
->state
& CONFIG_LOCKED
) {
337 c
->state
&= ~CONFIG_LOCKED
;
338 if (c
->state
& CONFIG_IO_REQ
)
339 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
343 if (s
->io
[i
].Config
!= 0)
346 s
->ops
->set_io_map(s
, &io
);
349 mutex_unlock(&s
->ops_mutex
);
352 } /* pcmcia_release_configuration */
355 /** pcmcia_release_io
357 * Release_io() releases the I/O ranges allocated by a client. This
358 * may be invoked some time after a card ejection has already dumped
359 * the actual socket configuration, so if the client is "stale", we
360 * don't bother checking the port ranges against the current socket
363 static int pcmcia_release_io(struct pcmcia_device
*p_dev
)
365 struct pcmcia_socket
*s
= p_dev
->socket
;
369 mutex_lock(&s
->ops_mutex
);
373 c
= p_dev
->function_config
;
375 release_io_space(s
, &c
->io
[0]);
378 release_io_space(s
, &c
->io
[1]);
381 c
->state
&= ~CONFIG_IO_REQ
;
384 mutex_unlock(&s
->ops_mutex
);
387 } /* pcmcia_release_io */
390 int pcmcia_release_window(struct pcmcia_device
*p_dev
, struct resource
*res
)
392 struct pcmcia_socket
*s
= p_dev
->socket
;
396 dev_dbg(&p_dev
->dev
, "releasing window %pR\n", res
);
398 w
= ((res
->flags
& IORESOURCE_BITS
& WIN_FLAGS_REQ
) >> 2) - 1;
402 mutex_lock(&s
->ops_mutex
);
405 if (!(p_dev
->_win
& CLIENT_WIN_REQ(w
))) {
406 dev_dbg(&p_dev
->dev
, "not releasing unknown window\n");
407 mutex_unlock(&s
->ops_mutex
);
411 /* Shut down memory window */
412 win
->flags
&= ~MAP_ACTIVE
;
413 s
->ops
->set_mem_map(s
, win
);
414 s
->state
&= ~SOCKET_WIN_REQ(w
);
416 /* Release system memory */
418 release_resource(res
);
419 release_resource(win
->res
);
423 p_dev
->_win
&= ~CLIENT_WIN_REQ(w
);
424 mutex_unlock(&s
->ops_mutex
);
427 } /* pcmcia_release_window */
428 EXPORT_SYMBOL(pcmcia_release_window
);
431 int pcmcia_request_configuration(struct pcmcia_device
*p_dev
,
436 struct pcmcia_socket
*s
= p_dev
->socket
;
440 if (!(s
->state
& SOCKET_PRESENT
))
443 if (req
->IntType
& INT_CARDBUS
) {
444 dev_dbg(&p_dev
->dev
, "IntType may not be INT_CARDBUS\n");
448 mutex_lock(&s
->ops_mutex
);
449 c
= p_dev
->function_config
;
450 if (c
->state
& CONFIG_LOCKED
) {
451 mutex_unlock(&s
->ops_mutex
);
452 dev_dbg(&p_dev
->dev
, "Configuration is locked\n");
456 /* Do power control. We don't allow changes in Vcc. */
457 s
->socket
.Vpp
= req
->Vpp
;
458 if (s
->ops
->set_socket(s
, &s
->socket
)) {
459 mutex_unlock(&s
->ops_mutex
);
460 dev_printk(KERN_WARNING
, &p_dev
->dev
,
461 "Unable to set socket state\n");
465 /* Pick memory or I/O card, DMA mode, interrupt */
466 c
->IntType
= req
->IntType
;
467 c
->Attributes
= req
->Attributes
;
468 if (req
->IntType
& INT_MEMORY_AND_IO
)
469 s
->socket
.flags
|= SS_IOCARD
;
470 if (req
->IntType
& INT_ZOOMED_VIDEO
)
471 s
->socket
.flags
|= SS_ZVCARD
| SS_IOCARD
;
472 if (req
->Attributes
& CONF_ENABLE_DMA
)
473 s
->socket
.flags
|= SS_DMA_MODE
;
474 if (req
->Attributes
& CONF_ENABLE_SPKR
)
475 s
->socket
.flags
|= SS_SPKR_ENA
;
476 if (req
->Attributes
& CONF_ENABLE_IRQ
)
477 s
->socket
.io_irq
= s
->pcmcia_irq
;
479 s
->socket
.io_irq
= 0;
480 s
->ops
->set_socket(s
, &s
->socket
);
483 /* Set up CIS configuration registers */
484 base
= c
->ConfigBase
= req
->ConfigBase
;
485 c
->CardValues
= req
->Present
;
486 if (req
->Present
& PRESENT_COPY
) {
488 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_SCR
)>>1, 1, &c
->Copy
);
490 if (req
->Present
& PRESENT_OPTION
) {
491 if (s
->functions
== 1) {
492 c
->Option
= req
->ConfigIndex
& COR_CONFIG_MASK
;
494 c
->Option
= req
->ConfigIndex
& COR_MFC_CONFIG_MASK
;
495 c
->Option
|= COR_FUNC_ENA
|COR_IREQ_ENA
;
496 if (req
->Present
& PRESENT_IOBASE_0
)
497 c
->Option
|= COR_ADDR_DECODE
;
499 if ((req
->Attributes
& CONF_ENABLE_IRQ
) &&
500 !(req
->Attributes
& CONF_ENABLE_PULSE_IRQ
))
501 c
->Option
|= COR_LEVEL_REQ
;
502 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_COR
)>>1, 1, &c
->Option
);
505 if (req
->Present
& PRESENT_STATUS
) {
506 c
->Status
= req
->Status
;
507 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_CCSR
)>>1, 1, &c
->Status
);
509 if (req
->Present
& PRESENT_PIN_REPLACE
) {
511 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_PRR
)>>1, 1, &c
->Pin
);
513 if (req
->Present
& PRESENT_EXT_STATUS
) {
514 c
->ExtStatus
= req
->ExtStatus
;
515 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_ESR
)>>1, 1, &c
->ExtStatus
);
517 if (req
->Present
& PRESENT_IOBASE_0
) {
518 u8 b
= c
->io
[0].start
& 0xff;
519 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOBASE_0
)>>1, 1, &b
);
520 b
= (c
->io
[0].start
>> 8) & 0xff;
521 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOBASE_1
)>>1, 1, &b
);
523 if (req
->Present
& PRESENT_IOSIZE
) {
524 u8 b
= resource_size(&c
->io
[0]) + resource_size(&c
->io
[1]) - 1;
525 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOSIZE
)>>1, 1, &b
);
528 /* Configure I/O windows */
529 if (c
->state
& CONFIG_IO_REQ
) {
530 iomap
.speed
= io_speed
;
531 for (i
= 0; i
< MAX_IO_WIN
; i
++)
534 iomap
.flags
= MAP_ACTIVE
;
535 switch (s
->io
[i
].res
->flags
& IO_DATA_PATH_WIDTH
) {
536 case IO_DATA_PATH_WIDTH_16
:
537 iomap
.flags
|= MAP_16BIT
; break;
538 case IO_DATA_PATH_WIDTH_AUTO
:
539 iomap
.flags
|= MAP_AUTOSZ
; break;
543 iomap
.start
= s
->io
[i
].res
->start
;
544 iomap
.stop
= s
->io
[i
].res
->end
;
545 s
->ops
->set_io_map(s
, &iomap
);
550 c
->state
|= CONFIG_LOCKED
;
552 mutex_unlock(&s
->ops_mutex
);
554 } /* pcmcia_request_configuration */
555 EXPORT_SYMBOL(pcmcia_request_configuration
);
559 * pcmcia_request_io() - attempt to reserve port ranges for PCMCIA devices
561 * pcmcia_request_io() attepts to reserve the IO port ranges specified in
562 * &struct pcmcia_device @p_dev->resource[0] and @p_dev->resource[1]. The
563 * "start" value is the requested start of the IO port resource; "end"
564 * reflects the number of ports requested. The number of IO lines requested
565 * is specified in &struct pcmcia_device @p_dev->io_lines.
567 int pcmcia_request_io(struct pcmcia_device
*p_dev
)
569 struct pcmcia_socket
*s
= p_dev
->socket
;
570 config_t
*c
= p_dev
->function_config
;
573 mutex_lock(&s
->ops_mutex
);
574 dev_dbg(&p_dev
->dev
, "pcmcia_request_io: %pR , %pR",
575 &c
->io
[0], &c
->io
[1]);
577 if (!(s
->state
& SOCKET_PRESENT
)) {
578 dev_dbg(&p_dev
->dev
, "pcmcia_request_io: No card present\n");
582 if (c
->state
& CONFIG_LOCKED
) {
583 dev_dbg(&p_dev
->dev
, "Configuration is locked\n");
586 if (c
->state
& CONFIG_IO_REQ
) {
587 dev_dbg(&p_dev
->dev
, "IO already configured\n");
591 ret
= alloc_io_space(s
, &c
->io
[0], p_dev
->io_lines
);
596 ret
= alloc_io_space(s
, &c
->io
[1], p_dev
->io_lines
);
598 struct resource tmp
= c
->io
[0];
599 /* release the previously allocated resource */
600 release_io_space(s
, &c
->io
[0]);
601 /* but preserve the settings, for they worked... */
602 c
->io
[0].end
= resource_size(&tmp
);
603 c
->io
[0].start
= tmp
.start
;
604 c
->io
[0].flags
= tmp
.flags
;
610 c
->state
|= CONFIG_IO_REQ
;
613 dev_dbg(&p_dev
->dev
, "pcmcia_request_io succeeded: %pR , %pR",
614 &c
->io
[0], &c
->io
[1]);
616 mutex_unlock(&s
->ops_mutex
);
619 } /* pcmcia_request_io */
620 EXPORT_SYMBOL(pcmcia_request_io
);
624 * pcmcia_request_irq() - attempt to request a IRQ for a PCMCIA device
626 * pcmcia_request_irq() is a wrapper around request_irq which will allow
627 * the PCMCIA core to clean up the registration in pcmcia_disable_device().
628 * Drivers are free to use request_irq() directly, but then they need to
629 * call free_irq themselfves, too. Also, only IRQF_SHARED capable IRQ
630 * handlers are allowed.
632 int __must_check
pcmcia_request_irq(struct pcmcia_device
*p_dev
,
633 irq_handler_t handler
)
640 ret
= request_irq(p_dev
->irq
, handler
, IRQF_SHARED
,
641 p_dev
->devname
, p_dev
->priv
);
647 EXPORT_SYMBOL(pcmcia_request_irq
);
651 * pcmcia_request_exclusive_irq() - attempt to request an exclusive IRQ first
653 * pcmcia_request_exclusive_irq() is a wrapper around request_irq which
654 * attempts first to request an exclusive IRQ. If it fails, it also accepts
655 * a shared IRQ, but prints out a warning. PCMCIA drivers should allow for
656 * IRQ sharing and either use request_irq directly (then they need to call
657 * free_irq themselves, too), or the pcmcia_request_irq() function.
660 __pcmcia_request_exclusive_irq(struct pcmcia_device
*p_dev
,
661 irq_handler_t handler
)
668 ret
= request_irq(p_dev
->irq
, handler
, 0, p_dev
->devname
, p_dev
->priv
);
670 ret
= pcmcia_request_irq(p_dev
, handler
);
671 dev_printk(KERN_WARNING
, &p_dev
->dev
, "pcmcia: "
672 "request for exclusive IRQ could not be fulfilled.\n");
673 dev_printk(KERN_WARNING
, &p_dev
->dev
, "pcmcia: the driver "
674 "needs updating to supported shared IRQ lines.\n");
677 dev_printk(KERN_INFO
, &p_dev
->dev
, "request_irq() failed\n");
682 } /* pcmcia_request_exclusive_irq */
683 EXPORT_SYMBOL(__pcmcia_request_exclusive_irq
);
686 #ifdef CONFIG_PCMCIA_PROBE
688 /* mask of IRQs already reserved by other cards, we should avoid using them */
689 static u8 pcmcia_used_irq
[32];
691 static irqreturn_t
test_action(int cpl
, void *dev_id
)
697 * pcmcia_setup_isa_irq() - determine whether an ISA IRQ can be used
698 * @p_dev - the associated PCMCIA device
700 * locking note: must be called with ops_mutex locked.
702 static int pcmcia_setup_isa_irq(struct pcmcia_device
*p_dev
, int type
)
704 struct pcmcia_socket
*s
= p_dev
->socket
;
705 unsigned int try, irq
;
706 u32 mask
= s
->irq_mask
;
709 for (try = 0; try < 64; try++) {
715 /* marked as available by driver, not blocked by userspace? */
716 if (!((mask
>> irq
) & 1))
719 /* avoid an IRQ which is already used by another PCMCIA card */
720 if ((try < 32) && pcmcia_used_irq
[irq
])
723 /* register the correct driver, if possible, to check whether
724 * registering a dummy handle works, i.e. if the IRQ isn't
725 * marked as used by the kernel resource management core */
726 ret
= request_irq(irq
, test_action
, type
, p_dev
->devname
,
729 free_irq(irq
, p_dev
);
730 p_dev
->irq
= s
->pcmcia_irq
= irq
;
731 pcmcia_used_irq
[irq
]++;
739 void pcmcia_cleanup_irq(struct pcmcia_socket
*s
)
741 pcmcia_used_irq
[s
->pcmcia_irq
]--;
745 #else /* CONFIG_PCMCIA_PROBE */
747 static int pcmcia_setup_isa_irq(struct pcmcia_device
*p_dev
, int type
)
752 void pcmcia_cleanup_irq(struct pcmcia_socket
*s
)
758 #endif /* CONFIG_PCMCIA_PROBE */
762 * pcmcia_setup_irq() - determine IRQ to be used for device
763 * @p_dev - the associated PCMCIA device
765 * locking note: must be called with ops_mutex locked.
767 int pcmcia_setup_irq(struct pcmcia_device
*p_dev
)
769 struct pcmcia_socket
*s
= p_dev
->socket
;
774 /* already assigned? */
776 p_dev
->irq
= s
->pcmcia_irq
;
780 /* prefer an exclusive ISA irq */
781 if (!pcmcia_setup_isa_irq(p_dev
, 0))
784 /* but accept a shared ISA irq */
785 if (!pcmcia_setup_isa_irq(p_dev
, IRQF_SHARED
))
788 /* but use the PCI irq otherwise */
790 p_dev
->irq
= s
->pcmcia_irq
= s
->pci_irq
;
798 /** pcmcia_request_window
800 * Request_window() establishes a mapping between card memory space
801 * and system memory space.
803 int pcmcia_request_window(struct pcmcia_device
*p_dev
, win_req_t
*req
, window_handle_t
*wh
)
805 struct pcmcia_socket
*s
= p_dev
->socket
;
808 struct resource
*res
;
811 if (!(s
->state
& SOCKET_PRESENT
)) {
812 dev_dbg(&p_dev
->dev
, "No card present\n");
816 /* Window size defaults to smallest available */
818 req
->Size
= s
->map_size
;
819 align
= (s
->features
& SS_CAP_MEM_ALIGN
) ? req
->Size
: s
->map_size
;
820 if (req
->Size
& (s
->map_size
-1)) {
821 dev_dbg(&p_dev
->dev
, "invalid map size\n");
824 if ((req
->Base
&& (s
->features
& SS_CAP_STATIC_MAP
)) ||
825 (req
->Base
& (align
-1))) {
826 dev_dbg(&p_dev
->dev
, "invalid base address\n");
832 /* Allocate system memory window */
833 mutex_lock(&s
->ops_mutex
);
834 for (w
= 0; w
< MAX_WIN
; w
++)
835 if (!(s
->state
& SOCKET_WIN_REQ(w
)))
838 dev_dbg(&p_dev
->dev
, "all windows are used already\n");
839 mutex_unlock(&s
->ops_mutex
);
845 if (!(s
->features
& SS_CAP_STATIC_MAP
)) {
846 win
->res
= pcmcia_find_mem_region(req
->Base
, req
->Size
, align
,
849 dev_dbg(&p_dev
->dev
, "allocating mem region failed\n");
850 mutex_unlock(&s
->ops_mutex
);
854 p_dev
->_win
|= CLIENT_WIN_REQ(w
);
856 /* Configure the socket controller */
858 win
->flags
= req
->Attributes
;
859 win
->speed
= req
->AccessSpeed
;
862 if (s
->ops
->set_mem_map(s
, win
) != 0) {
863 dev_dbg(&p_dev
->dev
, "failed to set memory mapping\n");
864 mutex_unlock(&s
->ops_mutex
);
867 s
->state
|= SOCKET_WIN_REQ(w
);
869 /* Return window handle */
870 if (s
->features
& SS_CAP_STATIC_MAP
)
871 req
->Base
= win
->static_start
;
873 req
->Base
= win
->res
->start
;
875 /* convert to new-style resources */
876 res
= p_dev
->resource
[w
+ MAX_IO_WIN
];
877 res
->start
= req
->Base
;
878 res
->end
= req
->Base
+ req
->Size
- 1;
879 res
->flags
&= ~IORESOURCE_BITS
;
880 res
->flags
|= (req
->Attributes
& WIN_FLAGS_MAP
) | (win
->map
<< 2);
881 res
->flags
|= IORESOURCE_MEM
;
882 res
->parent
= win
->res
;
884 request_resource(&iomem_resource
, res
);
886 dev_dbg(&p_dev
->dev
, "request_window results in %pR\n", res
);
888 mutex_unlock(&s
->ops_mutex
);
892 } /* pcmcia_request_window */
893 EXPORT_SYMBOL(pcmcia_request_window
);
895 void pcmcia_disable_device(struct pcmcia_device
*p_dev
)
898 for (i
= 0; i
< MAX_WIN
; i
++) {
899 struct resource
*res
= p_dev
->resource
[MAX_IO_WIN
+ i
];
900 if (res
->flags
& WIN_FLAGS_REQ
)
901 pcmcia_release_window(p_dev
, res
);
904 pcmcia_release_configuration(p_dev
);
905 pcmcia_release_io(p_dev
);
907 free_irq(p_dev
->irq
, p_dev
->priv
);
911 EXPORT_SYMBOL(pcmcia_disable_device
);