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>
25 #include <pcmcia/cs_types.h>
26 #include <pcmcia/ss.h>
27 #include <pcmcia/cs.h>
28 #include <pcmcia/cistpl.h>
29 #include <pcmcia/cisreg.h>
30 #include <pcmcia/ds.h>
32 #include "cs_internal.h"
35 /* Access speed for IO windows */
37 module_param(io_speed
, int, 0444);
40 #ifdef CONFIG_PCMCIA_PROBE
42 /* mask of IRQs already reserved by other cards, we should avoid using them */
43 static u8 pcmcia_used_irq
[NR_IRQS
];
46 static int pcmcia_adjust_io_region(struct resource
*res
, unsigned long start
,
47 unsigned long end
, struct pcmcia_socket
*s
)
49 if (s
->resource_ops
->adjust_io_region
)
50 return s
->resource_ops
->adjust_io_region(res
, start
, end
, s
);
54 static struct resource
*pcmcia_find_io_region(unsigned long base
, int num
,
56 struct pcmcia_socket
*s
)
58 if (s
->resource_ops
->find_io
)
59 return s
->resource_ops
->find_io(base
, num
, align
, s
);
63 int pcmcia_validate_mem(struct pcmcia_socket
*s
)
65 if (s
->resource_ops
->validate_mem
)
66 return s
->resource_ops
->validate_mem(s
);
67 /* if there is no callback, we can assume that everything is OK */
71 struct resource
*pcmcia_find_mem_region(u_long base
, u_long num
, u_long align
,
72 int low
, struct pcmcia_socket
*s
)
74 if (s
->resource_ops
->find_mem
)
75 return s
->resource_ops
->find_mem(base
, num
, align
, low
, s
);
82 * Special stuff for managing IO windows, because they are scarce
85 static int alloc_io_space(struct pcmcia_socket
*s
, u_int attr
,
86 unsigned int *base
, unsigned int num
, u_int lines
)
89 unsigned int try, align
;
91 align
= (*base
) ? (lines
? 1<<lines
: 0) : 1;
92 if (align
&& (align
< num
)) {
94 dev_dbg(&s
->dev
, "odd IO request: num %#x align %#x\n",
98 while (align
&& (align
< num
))
101 if (*base
& ~(align
-1)) {
102 dev_dbg(&s
->dev
, "odd IO request: base %#x align %#x\n",
106 if ((s
->features
& SS_CAP_STATIC_MAP
) && s
->io_offset
) {
107 *base
= s
->io_offset
| (*base
& 0x0fff);
110 /* Check for an already-allocated window that must conflict with
111 * what was asked for. It is a hack because it does not catch all
112 * potential conflicts, just the most obvious ones.
114 for (i
= 0; i
< MAX_IO_WIN
; i
++)
115 if ((s
->io
[i
].res
) && *base
&&
116 ((s
->io
[i
].res
->start
& (align
-1)) == *base
))
118 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
120 s
->io
[i
].res
= pcmcia_find_io_region(*base
, num
, align
, s
);
122 *base
= s
->io
[i
].res
->start
;
123 s
->io
[i
].res
->flags
= (s
->io
[i
].res
->flags
& ~IORESOURCE_BITS
) | (attr
& IORESOURCE_BITS
);
124 s
->io
[i
].InUse
= num
;
128 } else if ((s
->io
[i
].res
->flags
& IORESOURCE_BITS
) != (attr
& IORESOURCE_BITS
))
130 /* Try to extend top of window */
131 try = s
->io
[i
].res
->end
+ 1;
132 if ((*base
== 0) || (*base
== try))
133 if (pcmcia_adjust_io_region(s
->io
[i
].res
, s
->io
[i
].res
->start
,
134 s
->io
[i
].res
->end
+ num
, s
) == 0) {
136 s
->io
[i
].InUse
+= num
;
139 /* Try to extend bottom of window */
140 try = s
->io
[i
].res
->start
- num
;
141 if ((*base
== 0) || (*base
== try))
142 if (pcmcia_adjust_io_region(s
->io
[i
].res
, s
->io
[i
].res
->start
- num
,
143 s
->io
[i
].res
->end
, s
) == 0) {
145 s
->io
[i
].InUse
+= num
;
149 return (i
== MAX_IO_WIN
);
150 } /* alloc_io_space */
153 static void release_io_space(struct pcmcia_socket
*s
, unsigned int base
,
158 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
161 if ((s
->io
[i
].res
->start
<= base
) &&
162 (s
->io
[i
].res
->end
>= base
+num
-1)) {
163 s
->io
[i
].InUse
-= num
;
164 /* Free the window if no one else is using it */
165 if (s
->io
[i
].InUse
== 0) {
166 release_resource(s
->io
[i
].res
);
172 } /* release_io_space */
175 /** pccard_access_configuration_register
177 * Access_configuration_register() reads and writes configuration
178 * registers in attribute memory. Memory window 0 is reserved for
179 * this and the tuple reading services.
182 int pcmcia_access_configuration_register(struct pcmcia_device
*p_dev
,
185 struct pcmcia_socket
*s
;
190 if (!p_dev
|| !p_dev
->function_config
)
195 mutex_lock(&s
->ops_mutex
);
196 c
= p_dev
->function_config
;
198 if (!(c
->state
& CONFIG_LOCKED
)) {
199 dev_dbg(&s
->dev
, "Configuration isnt't locked\n");
200 mutex_unlock(&s
->ops_mutex
);
204 addr
= (c
->ConfigBase
+ reg
->Offset
) >> 1;
205 mutex_unlock(&s
->ops_mutex
);
207 switch (reg
->Action
) {
209 pcmcia_read_cis_mem(s
, 1, addr
, 1, &val
);
214 pcmcia_write_cis_mem(s
, 1, addr
, 1, &val
);
217 dev_dbg(&s
->dev
, "Invalid conf register request\n");
222 } /* pcmcia_access_configuration_register */
223 EXPORT_SYMBOL(pcmcia_access_configuration_register
);
226 int pcmcia_map_mem_page(struct pcmcia_device
*p_dev
, window_handle_t wh
,
229 struct pcmcia_socket
*s
= p_dev
->socket
;
235 if (req
->Page
!= 0) {
236 dev_dbg(&s
->dev
, "failure: requested page is zero\n");
239 mutex_lock(&s
->ops_mutex
);
240 s
->win
[wh
].card_start
= req
->CardOffset
;
241 ret
= s
->ops
->set_mem_map(s
, &s
->win
[wh
]);
243 dev_warn(&s
->dev
, "failed to set_mem_map\n");
244 mutex_unlock(&s
->ops_mutex
);
246 } /* pcmcia_map_mem_page */
247 EXPORT_SYMBOL(pcmcia_map_mem_page
);
250 /** pcmcia_modify_configuration
252 * Modify a locked socket configuration
254 int pcmcia_modify_configuration(struct pcmcia_device
*p_dev
,
257 struct pcmcia_socket
*s
;
263 mutex_lock(&s
->ops_mutex
);
264 c
= p_dev
->function_config
;
266 if (!(s
->state
& SOCKET_PRESENT
)) {
267 dev_dbg(&s
->dev
, "No card present\n");
271 if (!(c
->state
& CONFIG_LOCKED
)) {
272 dev_dbg(&s
->dev
, "Configuration isnt't locked\n");
277 if (mod
->Attributes
& CONF_IRQ_CHANGE_VALID
) {
278 if (mod
->Attributes
& CONF_ENABLE_IRQ
) {
279 c
->Attributes
|= CONF_ENABLE_IRQ
;
280 s
->socket
.io_irq
= s
->irq
.AssignedIRQ
;
282 c
->Attributes
&= ~CONF_ENABLE_IRQ
;
283 s
->socket
.io_irq
= 0;
285 s
->ops
->set_socket(s
, &s
->socket
);
288 if (mod
->Attributes
& CONF_VCC_CHANGE_VALID
) {
289 dev_dbg(&s
->dev
, "changing Vcc is not allowed at this time\n");
294 /* We only allow changing Vpp1 and Vpp2 to the same value */
295 if ((mod
->Attributes
& CONF_VPP1_CHANGE_VALID
) &&
296 (mod
->Attributes
& CONF_VPP2_CHANGE_VALID
)) {
297 if (mod
->Vpp1
!= mod
->Vpp2
) {
298 dev_dbg(&s
->dev
, "Vpp1 and Vpp2 must be the same\n");
302 s
->socket
.Vpp
= mod
->Vpp1
;
303 if (s
->ops
->set_socket(s
, &s
->socket
)) {
304 dev_printk(KERN_WARNING
, &s
->dev
,
305 "Unable to set VPP\n");
309 } else if ((mod
->Attributes
& CONF_VPP1_CHANGE_VALID
) ||
310 (mod
->Attributes
& CONF_VPP2_CHANGE_VALID
)) {
311 dev_dbg(&s
->dev
, "changing Vcc is not allowed at this time\n");
316 if (mod
->Attributes
& CONF_IO_CHANGE_WIDTH
) {
317 pccard_io_map io_off
= { 0, 0, 0, 0, 1 };
321 io_on
.speed
= io_speed
;
322 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
328 io_on
.flags
= MAP_ACTIVE
| IO_DATA_PATH_WIDTH_8
;
329 io_on
.start
= s
->io
[i
].res
->start
;
330 io_on
.stop
= s
->io
[i
].res
->end
;
332 s
->ops
->set_io_map(s
, &io_off
);
334 s
->ops
->set_io_map(s
, &io_on
);
339 mutex_unlock(&s
->ops_mutex
);
342 } /* modify_configuration */
343 EXPORT_SYMBOL(pcmcia_modify_configuration
);
346 int pcmcia_release_configuration(struct pcmcia_device
*p_dev
)
348 pccard_io_map io
= { 0, 0, 0, 0, 1 };
349 struct pcmcia_socket
*s
= p_dev
->socket
;
353 mutex_lock(&s
->ops_mutex
);
354 c
= p_dev
->function_config
;
355 if (p_dev
->_locked
) {
357 if (--(s
->lock_count
) == 0) {
358 s
->socket
.flags
= SS_OUTPUT_ENA
; /* Is this correct? */
360 s
->socket
.io_irq
= 0;
361 s
->ops
->set_socket(s
, &s
->socket
);
364 if (c
->state
& CONFIG_LOCKED
) {
365 c
->state
&= ~CONFIG_LOCKED
;
366 if (c
->state
& CONFIG_IO_REQ
)
367 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
371 if (s
->io
[i
].Config
!= 0)
374 s
->ops
->set_io_map(s
, &io
);
377 mutex_unlock(&s
->ops_mutex
);
380 } /* pcmcia_release_configuration */
383 /** pcmcia_release_io
385 * Release_io() releases the I/O ranges allocated by a client. This
386 * may be invoked some time after a card ejection has already dumped
387 * the actual socket configuration, so if the client is "stale", we
388 * don't bother checking the port ranges against the current socket
391 static int pcmcia_release_io(struct pcmcia_device
*p_dev
, io_req_t
*req
)
393 struct pcmcia_socket
*s
= p_dev
->socket
;
397 mutex_lock(&s
->ops_mutex
);
398 c
= p_dev
->function_config
;
405 if ((c
->io
.BasePort1
!= req
->BasePort1
) ||
406 (c
->io
.NumPorts1
!= req
->NumPorts1
) ||
407 (c
->io
.BasePort2
!= req
->BasePort2
) ||
408 (c
->io
.NumPorts2
!= req
->NumPorts2
))
411 c
->state
&= ~CONFIG_IO_REQ
;
413 release_io_space(s
, req
->BasePort1
, req
->NumPorts1
);
415 release_io_space(s
, req
->BasePort2
, req
->NumPorts2
);
418 mutex_unlock(&s
->ops_mutex
);
421 } /* pcmcia_release_io */
424 static int pcmcia_release_irq(struct pcmcia_device
*p_dev
, irq_req_t
*req
)
426 struct pcmcia_socket
*s
= p_dev
->socket
;
430 mutex_lock(&s
->ops_mutex
);
432 c
= p_dev
->function_config
;
439 if (c
->state
& CONFIG_LOCKED
)
442 if (c
->irq
.Attributes
!= req
->Attributes
) {
443 dev_dbg(&s
->dev
, "IRQ attributes must match assigned ones\n");
446 if (s
->irq
.AssignedIRQ
!= req
->AssignedIRQ
) {
447 dev_dbg(&s
->dev
, "IRQ must match assigned one\n");
450 if (--s
->irq
.Config
== 0) {
451 c
->state
&= ~CONFIG_IRQ_REQ
;
452 s
->irq
.AssignedIRQ
= 0;
456 free_irq(req
->AssignedIRQ
, p_dev
->priv
);
458 #ifdef CONFIG_PCMCIA_PROBE
459 pcmcia_used_irq
[req
->AssignedIRQ
]--;
464 mutex_unlock(&s
->ops_mutex
);
467 } /* pcmcia_release_irq */
470 int pcmcia_release_window(struct pcmcia_device
*p_dev
, window_handle_t wh
)
472 struct pcmcia_socket
*s
= p_dev
->socket
;
479 mutex_lock(&s
->ops_mutex
);
482 if (!(p_dev
->_win
& CLIENT_WIN_REQ(wh
))) {
483 dev_dbg(&s
->dev
, "not releasing unknown window\n");
484 mutex_unlock(&s
->ops_mutex
);
488 /* Shut down memory window */
489 win
->flags
&= ~MAP_ACTIVE
;
490 s
->ops
->set_mem_map(s
, win
);
491 s
->state
&= ~SOCKET_WIN_REQ(wh
);
493 /* Release system memory */
495 release_resource(win
->res
);
499 p_dev
->_win
&= ~CLIENT_WIN_REQ(wh
);
500 mutex_unlock(&s
->ops_mutex
);
503 } /* pcmcia_release_window */
504 EXPORT_SYMBOL(pcmcia_release_window
);
507 int pcmcia_request_configuration(struct pcmcia_device
*p_dev
,
512 struct pcmcia_socket
*s
= p_dev
->socket
;
516 if (!(s
->state
& SOCKET_PRESENT
))
519 if (req
->IntType
& INT_CARDBUS
) {
520 dev_dbg(&s
->dev
, "IntType may not be INT_CARDBUS\n");
524 mutex_lock(&s
->ops_mutex
);
525 c
= p_dev
->function_config
;
526 if (c
->state
& CONFIG_LOCKED
) {
527 mutex_unlock(&s
->ops_mutex
);
528 dev_dbg(&s
->dev
, "Configuration is locked\n");
532 /* Do power control. We don't allow changes in Vcc. */
533 s
->socket
.Vpp
= req
->Vpp
;
534 if (s
->ops
->set_socket(s
, &s
->socket
)) {
535 mutex_unlock(&s
->ops_mutex
);
536 dev_printk(KERN_WARNING
, &s
->dev
,
537 "Unable to set socket state\n");
541 /* Pick memory or I/O card, DMA mode, interrupt */
542 c
->IntType
= req
->IntType
;
543 c
->Attributes
= req
->Attributes
;
544 if (req
->IntType
& INT_MEMORY_AND_IO
)
545 s
->socket
.flags
|= SS_IOCARD
;
546 if (req
->IntType
& INT_ZOOMED_VIDEO
)
547 s
->socket
.flags
|= SS_ZVCARD
| SS_IOCARD
;
548 if (req
->Attributes
& CONF_ENABLE_DMA
)
549 s
->socket
.flags
|= SS_DMA_MODE
;
550 if (req
->Attributes
& CONF_ENABLE_SPKR
)
551 s
->socket
.flags
|= SS_SPKR_ENA
;
552 if (req
->Attributes
& CONF_ENABLE_IRQ
)
553 s
->socket
.io_irq
= s
->irq
.AssignedIRQ
;
555 s
->socket
.io_irq
= 0;
556 s
->ops
->set_socket(s
, &s
->socket
);
558 mutex_unlock(&s
->ops_mutex
);
560 /* Set up CIS configuration registers */
561 base
= c
->ConfigBase
= req
->ConfigBase
;
562 c
->CardValues
= req
->Present
;
563 if (req
->Present
& PRESENT_COPY
) {
565 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_SCR
)>>1, 1, &c
->Copy
);
567 if (req
->Present
& PRESENT_OPTION
) {
568 if (s
->functions
== 1) {
569 c
->Option
= req
->ConfigIndex
& COR_CONFIG_MASK
;
571 c
->Option
= req
->ConfigIndex
& COR_MFC_CONFIG_MASK
;
572 c
->Option
|= COR_FUNC_ENA
|COR_IREQ_ENA
;
573 if (req
->Present
& PRESENT_IOBASE_0
)
574 c
->Option
|= COR_ADDR_DECODE
;
576 if (c
->state
& CONFIG_IRQ_REQ
)
577 if (!(c
->irq
.Attributes
& IRQ_FORCED_PULSE
))
578 c
->Option
|= COR_LEVEL_REQ
;
579 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_COR
)>>1, 1, &c
->Option
);
582 if (req
->Present
& PRESENT_STATUS
) {
583 c
->Status
= req
->Status
;
584 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_CCSR
)>>1, 1, &c
->Status
);
586 if (req
->Present
& PRESENT_PIN_REPLACE
) {
588 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_PRR
)>>1, 1, &c
->Pin
);
590 if (req
->Present
& PRESENT_EXT_STATUS
) {
591 c
->ExtStatus
= req
->ExtStatus
;
592 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_ESR
)>>1, 1, &c
->ExtStatus
);
594 if (req
->Present
& PRESENT_IOBASE_0
) {
595 u_char b
= c
->io
.BasePort1
& 0xff;
596 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOBASE_0
)>>1, 1, &b
);
597 b
= (c
->io
.BasePort1
>> 8) & 0xff;
598 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOBASE_1
)>>1, 1, &b
);
600 if (req
->Present
& PRESENT_IOSIZE
) {
601 u_char b
= c
->io
.NumPorts1
+ c
->io
.NumPorts2
- 1;
602 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOSIZE
)>>1, 1, &b
);
605 /* Configure I/O windows */
606 if (c
->state
& CONFIG_IO_REQ
) {
607 mutex_lock(&s
->ops_mutex
);
608 iomap
.speed
= io_speed
;
609 for (i
= 0; i
< MAX_IO_WIN
; i
++)
612 iomap
.flags
= MAP_ACTIVE
;
613 switch (s
->io
[i
].res
->flags
& IO_DATA_PATH_WIDTH
) {
614 case IO_DATA_PATH_WIDTH_16
:
615 iomap
.flags
|= MAP_16BIT
; break;
616 case IO_DATA_PATH_WIDTH_AUTO
:
617 iomap
.flags
|= MAP_AUTOSZ
; break;
621 iomap
.start
= s
->io
[i
].res
->start
;
622 iomap
.stop
= s
->io
[i
].res
->end
;
623 s
->ops
->set_io_map(s
, &iomap
);
626 mutex_unlock(&s
->ops_mutex
);
629 c
->state
|= CONFIG_LOCKED
;
632 } /* pcmcia_request_configuration */
633 EXPORT_SYMBOL(pcmcia_request_configuration
);
636 /** pcmcia_request_io
638 * Request_io() reserves ranges of port addresses for a socket.
639 * I have not implemented range sharing or alias addressing.
641 int pcmcia_request_io(struct pcmcia_device
*p_dev
, io_req_t
*req
)
643 struct pcmcia_socket
*s
= p_dev
->socket
;
647 mutex_lock(&s
->ops_mutex
);
649 if (!(s
->state
& SOCKET_PRESENT
)) {
650 dev_dbg(&s
->dev
, "No card present\n");
657 c
= p_dev
->function_config
;
658 if (c
->state
& CONFIG_LOCKED
) {
659 dev_dbg(&s
->dev
, "Configuration is locked\n");
662 if (c
->state
& CONFIG_IO_REQ
) {
663 dev_dbg(&s
->dev
, "IO already configured\n");
666 if (req
->Attributes1
& (IO_SHARED
| IO_FORCE_ALIAS_ACCESS
)) {
667 dev_dbg(&s
->dev
, "bad attribute setting for IO region 1\n");
670 if ((req
->NumPorts2
> 0) &&
671 (req
->Attributes2
& (IO_SHARED
| IO_FORCE_ALIAS_ACCESS
))) {
672 dev_dbg(&s
->dev
, "bad attribute setting for IO region 2\n");
676 dev_dbg(&s
->dev
, "trying to allocate resource 1\n");
677 ret
= alloc_io_space(s
, req
->Attributes1
, &req
->BasePort1
,
678 req
->NumPorts1
, req
->IOAddrLines
);
680 dev_dbg(&s
->dev
, "allocation of resource 1 failed\n");
684 if (req
->NumPorts2
) {
685 dev_dbg(&s
->dev
, "trying to allocate resource 2\n");
686 ret
= alloc_io_space(s
, req
->Attributes2
, &req
->BasePort2
,
687 req
->NumPorts2
, req
->IOAddrLines
);
689 dev_dbg(&s
->dev
, "allocation of resource 2 failed\n");
690 release_io_space(s
, req
->BasePort1
, req
->NumPorts1
);
696 c
->state
|= CONFIG_IO_REQ
;
698 dev_dbg(&s
->dev
, "allocating resources succeeded: %d\n", ret
);
701 mutex_unlock(&s
->ops_mutex
);
704 } /* pcmcia_request_io */
705 EXPORT_SYMBOL(pcmcia_request_io
);
708 /** pcmcia_request_irq
710 * Request_irq() reserves an irq for this client.
712 * Also, since Linux only reserves irq's when they are actually
713 * hooked, we don't guarantee that an irq will still be available
714 * when the configuration is locked. Now that I think about it,
715 * there might be a way to fix this using a dummy handler.
718 #ifdef CONFIG_PCMCIA_PROBE
719 static irqreturn_t
test_action(int cpl
, void *dev_id
)
725 int pcmcia_request_irq(struct pcmcia_device
*p_dev
, irq_req_t
*req
)
727 struct pcmcia_socket
*s
= p_dev
->socket
;
729 int ret
= -EINVAL
, irq
= 0;
732 mutex_lock(&s
->ops_mutex
);
734 if (!(s
->state
& SOCKET_PRESENT
)) {
735 dev_dbg(&s
->dev
, "No card present\n");
738 c
= p_dev
->function_config
;
739 if (c
->state
& CONFIG_LOCKED
) {
740 dev_dbg(&s
->dev
, "Configuration is locked\n");
743 if (c
->state
& CONFIG_IRQ_REQ
) {
744 dev_dbg(&s
->dev
, "IRQ already configured\n");
748 /* Decide what type of interrupt we are registering */
750 if (s
->functions
> 1) /* All of this ought to be handled higher up */
752 else if (req
->Attributes
& IRQ_TYPE_DYNAMIC_SHARING
)
755 printk(KERN_WARNING
"pcmcia: Driver needs updating to support IRQ sharing.\n");
757 #ifdef CONFIG_PCMCIA_PROBE
759 if (s
->irq
.AssignedIRQ
!= 0) {
760 /* If the interrupt is already assigned, it must be the same */
761 irq
= s
->irq
.AssignedIRQ
;
764 u32 mask
= s
->irq_mask
;
765 void *data
= p_dev
; /* something unique to this device */
767 for (try = 0; try < 64; try++) {
770 /* marked as available by driver, and not blocked by userspace? */
771 if (!((mask
>> irq
) & 1))
774 /* avoid an IRQ which is already used by a PCMCIA card */
775 if ((try < 32) && pcmcia_used_irq
[irq
])
778 /* register the correct driver, if possible, of check whether
779 * registering a dummy handle works, i.e. if the IRQ isn't
780 * marked as used by the kernel resource management core */
781 ret
= request_irq(irq
,
782 (req
->Handler
) ? req
->Handler
: test_action
,
785 (req
->Handler
) ? p_dev
->priv
: data
);
794 /* only assign PCI irq if no IRQ already assigned */
795 if (ret
&& !s
->irq
.AssignedIRQ
) {
797 dev_printk(KERN_INFO
, &s
->dev
, "no IRQ found\n");
804 if (ret
&& req
->Handler
) {
805 ret
= request_irq(irq
, req
->Handler
, type
,
806 p_dev
->devname
, p_dev
->priv
);
808 dev_printk(KERN_INFO
, &s
->dev
,
809 "request_irq() failed\n");
814 /* Make sure the fact the request type was overridden is passed back */
815 if (type
== IRQF_SHARED
&& !(req
->Attributes
& IRQ_TYPE_DYNAMIC_SHARING
)) {
816 req
->Attributes
|= IRQ_TYPE_DYNAMIC_SHARING
;
817 dev_printk(KERN_WARNING
, &p_dev
->dev
, "pcmcia: "
818 "request for exclusive IRQ could not be fulfilled.\n");
819 dev_printk(KERN_WARNING
, &p_dev
->dev
, "pcmcia: the driver "
820 "needs updating to supported shared IRQ lines.\n");
822 c
->irq
.Attributes
= req
->Attributes
;
823 s
->irq
.AssignedIRQ
= req
->AssignedIRQ
= irq
;
826 c
->state
|= CONFIG_IRQ_REQ
;
829 #ifdef CONFIG_PCMCIA_PROBE
830 pcmcia_used_irq
[irq
]++;
835 mutex_unlock(&s
->ops_mutex
);
837 } /* pcmcia_request_irq */
838 EXPORT_SYMBOL(pcmcia_request_irq
);
841 /** pcmcia_request_window
843 * Request_window() establishes a mapping between card memory space
844 * and system memory space.
846 int pcmcia_request_window(struct pcmcia_device
*p_dev
, win_req_t
*req
, window_handle_t
*wh
)
848 struct pcmcia_socket
*s
= p_dev
->socket
;
853 if (!(s
->state
& SOCKET_PRESENT
)) {
854 dev_dbg(&s
->dev
, "No card present\n");
857 if (req
->Attributes
& (WIN_PAGED
| WIN_SHARED
)) {
858 dev_dbg(&s
->dev
, "bad attribute setting for iomem region\n");
862 /* Window size defaults to smallest available */
864 req
->Size
= s
->map_size
;
865 align
= (((s
->features
& SS_CAP_MEM_ALIGN
) ||
866 (req
->Attributes
& WIN_STRICT_ALIGN
)) ?
867 req
->Size
: s
->map_size
);
868 if (req
->Size
& (s
->map_size
-1)) {
869 dev_dbg(&s
->dev
, "invalid map size\n");
872 if ((req
->Base
&& (s
->features
& SS_CAP_STATIC_MAP
)) ||
873 (req
->Base
& (align
-1))) {
874 dev_dbg(&s
->dev
, "invalid base address\n");
880 /* Allocate system memory window */
881 for (w
= 0; w
< MAX_WIN
; w
++)
882 if (!(s
->state
& SOCKET_WIN_REQ(w
)))
885 dev_dbg(&s
->dev
, "all windows are used already\n");
889 mutex_lock(&s
->ops_mutex
);
892 if (!(s
->features
& SS_CAP_STATIC_MAP
)) {
893 win
->res
= pcmcia_find_mem_region(req
->Base
, req
->Size
, align
,
894 (req
->Attributes
& WIN_MAP_BELOW_1MB
), s
);
896 dev_dbg(&s
->dev
, "allocating mem region failed\n");
897 mutex_unlock(&s
->ops_mutex
);
901 p_dev
->_win
|= CLIENT_WIN_REQ(w
);
903 /* Configure the socket controller */
906 win
->speed
= req
->AccessSpeed
;
907 if (req
->Attributes
& WIN_MEMORY_TYPE
)
908 win
->flags
|= MAP_ATTRIB
;
909 if (req
->Attributes
& WIN_ENABLE
)
910 win
->flags
|= MAP_ACTIVE
;
911 if (req
->Attributes
& WIN_DATA_WIDTH_16
)
912 win
->flags
|= MAP_16BIT
;
913 if (req
->Attributes
& WIN_USE_WAIT
)
914 win
->flags
|= MAP_USE_WAIT
;
917 if (s
->ops
->set_mem_map(s
, win
) != 0) {
918 dev_dbg(&s
->dev
, "failed to set memory mapping\n");
919 mutex_unlock(&s
->ops_mutex
);
922 s
->state
|= SOCKET_WIN_REQ(w
);
924 /* Return window handle */
925 if (s
->features
& SS_CAP_STATIC_MAP
)
926 req
->Base
= win
->static_start
;
928 req
->Base
= win
->res
->start
;
930 mutex_unlock(&s
->ops_mutex
);
934 } /* pcmcia_request_window */
935 EXPORT_SYMBOL(pcmcia_request_window
);
937 void pcmcia_disable_device(struct pcmcia_device
*p_dev
)
939 pcmcia_release_configuration(p_dev
);
940 pcmcia_release_io(p_dev
, &p_dev
->io
);
941 pcmcia_release_irq(p_dev
, &p_dev
->irq
);
943 pcmcia_release_window(p_dev
, p_dev
->win
);
945 EXPORT_SYMBOL(pcmcia_disable_device
);
948 struct pcmcia_cfg_mem
{
949 struct pcmcia_device
*p_dev
;
951 int (*conf_check
) (struct pcmcia_device
*p_dev
,
952 cistpl_cftable_entry_t
*cfg
,
953 cistpl_cftable_entry_t
*dflt
,
957 cistpl_cftable_entry_t dflt
;
961 * pcmcia_do_loop_config() - internal helper for pcmcia_loop_config()
963 * pcmcia_do_loop_config() is the internal callback for the call from
964 * pcmcia_loop_config() to pccard_loop_tuple(). Data is transferred
965 * by a struct pcmcia_cfg_mem.
967 static int pcmcia_do_loop_config(tuple_t
*tuple
, cisparse_t
*parse
, void *priv
)
969 cistpl_cftable_entry_t
*cfg
= &parse
->cftable_entry
;
970 struct pcmcia_cfg_mem
*cfg_mem
= priv
;
973 cfg_mem
->p_dev
->conf
.ConfigIndex
= cfg
->index
;
974 if (cfg
->flags
& CISTPL_CFTABLE_DEFAULT
)
975 cfg_mem
->dflt
= *cfg
;
977 return cfg_mem
->conf_check(cfg_mem
->p_dev
, cfg
, &cfg_mem
->dflt
,
978 cfg_mem
->p_dev
->socket
->socket
.Vcc
,
983 * pcmcia_loop_config() - loop over configuration options
984 * @p_dev: the struct pcmcia_device which we need to loop for.
985 * @conf_check: function to call for each configuration option.
986 * It gets passed the struct pcmcia_device, the CIS data
987 * describing the configuration option, and private data
988 * being passed to pcmcia_loop_config()
989 * @priv_data: private data to be passed to the conf_check function.
991 * pcmcia_loop_config() loops over all configuration options, and calls
992 * the driver-specific conf_check() for each one, checking whether
993 * it is a valid one. Returns 0 on success or errorcode otherwise.
995 int pcmcia_loop_config(struct pcmcia_device
*p_dev
,
996 int (*conf_check
) (struct pcmcia_device
*p_dev
,
997 cistpl_cftable_entry_t
*cfg
,
998 cistpl_cftable_entry_t
*dflt
,
1003 struct pcmcia_cfg_mem
*cfg_mem
;
1006 cfg_mem
= kzalloc(sizeof(struct pcmcia_cfg_mem
), GFP_KERNEL
);
1007 if (cfg_mem
== NULL
)
1010 cfg_mem
->p_dev
= p_dev
;
1011 cfg_mem
->conf_check
= conf_check
;
1012 cfg_mem
->priv_data
= priv_data
;
1014 ret
= pccard_loop_tuple(p_dev
->socket
, p_dev
->func
,
1015 CISTPL_CFTABLE_ENTRY
, &cfg_mem
->parse
,
1016 cfg_mem
, pcmcia_do_loop_config
);
1021 EXPORT_SYMBOL(pcmcia_loop_config
);
1024 struct pcmcia_loop_mem
{
1025 struct pcmcia_device
*p_dev
;
1027 int (*loop_tuple
) (struct pcmcia_device
*p_dev
,
1033 * pcmcia_do_loop_tuple() - internal helper for pcmcia_loop_config()
1035 * pcmcia_do_loop_tuple() is the internal callback for the call from
1036 * pcmcia_loop_tuple() to pccard_loop_tuple(). Data is transferred
1037 * by a struct pcmcia_cfg_mem.
1039 static int pcmcia_do_loop_tuple(tuple_t
*tuple
, cisparse_t
*parse
, void *priv
)
1041 struct pcmcia_loop_mem
*loop
= priv
;
1043 return loop
->loop_tuple(loop
->p_dev
, tuple
, loop
->priv_data
);
1047 * pcmcia_loop_tuple() - loop over tuples in the CIS
1048 * @p_dev: the struct pcmcia_device which we need to loop for.
1049 * @code: which CIS code shall we look for?
1050 * @priv_data: private data to be passed to the loop_tuple function.
1051 * @loop_tuple: function to call for each CIS entry of type @function. IT
1052 * gets passed the raw tuple and @priv_data.
1054 * pcmcia_loop_tuple() loops over all CIS entries of type @function, and
1055 * calls the @loop_tuple function for each entry. If the call to @loop_tuple
1056 * returns 0, the loop exits. Returns 0 on success or errorcode otherwise.
1058 int pcmcia_loop_tuple(struct pcmcia_device
*p_dev
, cisdata_t code
,
1059 int (*loop_tuple
) (struct pcmcia_device
*p_dev
,
1064 struct pcmcia_loop_mem loop
= {
1066 .loop_tuple
= loop_tuple
,
1067 .priv_data
= priv_data
};
1069 return pccard_loop_tuple(p_dev
->socket
, p_dev
->func
, code
, NULL
,
1070 &loop
, pcmcia_do_loop_tuple
);
1072 EXPORT_SYMBOL(pcmcia_loop_tuple
);
1075 struct pcmcia_loop_get
{
1081 * pcmcia_do_get_tuple() - internal helper for pcmcia_get_tuple()
1083 * pcmcia_do_get_tuple() is the internal callback for the call from
1084 * pcmcia_get_tuple() to pcmcia_loop_tuple(). As we're only interested in
1085 * the first tuple, return 0 unconditionally. Create a memory buffer large
1086 * enough to hold the content of the tuple, and fill it with the tuple data.
1087 * The caller is responsible to free the buffer.
1089 static int pcmcia_do_get_tuple(struct pcmcia_device
*p_dev
, tuple_t
*tuple
,
1092 struct pcmcia_loop_get
*get
= priv
;
1094 *get
->buf
= kzalloc(tuple
->TupleDataLen
, GFP_KERNEL
);
1096 get
->len
= tuple
->TupleDataLen
;
1097 memcpy(*get
->buf
, tuple
->TupleData
, tuple
->TupleDataLen
);
1099 dev_dbg(&p_dev
->dev
, "do_get_tuple: out of memory\n");
1104 * pcmcia_get_tuple() - get first tuple from CIS
1105 * @p_dev: the struct pcmcia_device which we need to loop for.
1106 * @code: which CIS code shall we look for?
1107 * @buf: pointer to store the buffer to.
1109 * pcmcia_get_tuple() gets the content of the first CIS entry of type @code.
1110 * It returns the buffer length (or zero). The caller is responsible to free
1111 * the buffer passed in @buf.
1113 size_t pcmcia_get_tuple(struct pcmcia_device
*p_dev
, cisdata_t code
,
1114 unsigned char **buf
)
1116 struct pcmcia_loop_get get
= {
1122 pcmcia_loop_tuple(p_dev
, code
, pcmcia_do_get_tuple
, &get
);
1126 EXPORT_SYMBOL(pcmcia_get_tuple
);
1130 * pcmcia_do_get_mac() - internal helper for pcmcia_get_mac_from_cis()
1132 * pcmcia_do_get_mac() is the internal callback for the call from
1133 * pcmcia_get_mac_from_cis() to pcmcia_loop_tuple(). We check whether the
1134 * tuple contains a proper LAN_NODE_ID of length 6, and copy the data
1135 * to struct net_device->dev_addr[i].
1137 static int pcmcia_do_get_mac(struct pcmcia_device
*p_dev
, tuple_t
*tuple
,
1140 struct net_device
*dev
= priv
;
1143 if (tuple
->TupleData
[0] != CISTPL_FUNCE_LAN_NODE_ID
)
1145 if (tuple
->TupleDataLen
< ETH_ALEN
+ 2) {
1146 dev_warn(&p_dev
->dev
, "Invalid CIS tuple length for "
1151 if (tuple
->TupleData
[1] != ETH_ALEN
) {
1152 dev_warn(&p_dev
->dev
, "Invalid header for LAN_NODE_ID\n");
1155 for (i
= 0; i
< 6; i
++)
1156 dev
->dev_addr
[i
] = tuple
->TupleData
[i
+2];
1161 * pcmcia_get_mac_from_cis() - read out MAC address from CISTPL_FUNCE
1162 * @p_dev: the struct pcmcia_device for which we want the address.
1163 * @dev: a properly prepared struct net_device to store the info to.
1165 * pcmcia_get_mac_from_cis() reads out the hardware MAC address from
1166 * CISTPL_FUNCE and stores it into struct net_device *dev->dev_addr which
1167 * must be set up properly by the driver (see examples!).
1169 int pcmcia_get_mac_from_cis(struct pcmcia_device
*p_dev
, struct net_device
*dev
)
1171 return pcmcia_loop_tuple(p_dev
, CISTPL_FUNCE
, pcmcia_do_get_mac
, dev
);
1173 EXPORT_SYMBOL(pcmcia_get_mac_from_cis
);