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
;
262 mutex_lock(&s
->ops_mutex
);
263 c
= p_dev
->function_config
;
265 if (!(s
->state
& SOCKET_PRESENT
)) {
266 dev_dbg(&s
->dev
, "No card present\n");
267 mutex_unlock(&s
->ops_mutex
);
270 if (!(c
->state
& CONFIG_LOCKED
)) {
271 dev_dbg(&s
->dev
, "Configuration isnt't locked\n");
272 mutex_unlock(&s
->ops_mutex
);
276 if (mod
->Attributes
& CONF_IRQ_CHANGE_VALID
) {
277 if (mod
->Attributes
& CONF_ENABLE_IRQ
) {
278 c
->Attributes
|= CONF_ENABLE_IRQ
;
279 s
->socket
.io_irq
= s
->irq
.AssignedIRQ
;
281 c
->Attributes
&= ~CONF_ENABLE_IRQ
;
282 s
->socket
.io_irq
= 0;
284 s
->ops
->set_socket(s
, &s
->socket
);
287 if (mod
->Attributes
& CONF_VCC_CHANGE_VALID
) {
288 dev_dbg(&s
->dev
, "changing Vcc is not allowed at this time\n");
292 /* We only allow changing Vpp1 and Vpp2 to the same value */
293 if ((mod
->Attributes
& CONF_VPP1_CHANGE_VALID
) &&
294 (mod
->Attributes
& CONF_VPP2_CHANGE_VALID
)) {
295 if (mod
->Vpp1
!= mod
->Vpp2
) {
296 dev_dbg(&s
->dev
, "Vpp1 and Vpp2 must be the same\n");
297 mutex_unlock(&s
->ops_mutex
);
300 s
->socket
.Vpp
= mod
->Vpp1
;
301 if (s
->ops
->set_socket(s
, &s
->socket
)) {
302 mutex_unlock(&s
->ops_mutex
);
303 dev_printk(KERN_WARNING
, &s
->dev
,
304 "Unable to set VPP\n");
307 } else if ((mod
->Attributes
& CONF_VPP1_CHANGE_VALID
) ||
308 (mod
->Attributes
& CONF_VPP2_CHANGE_VALID
)) {
309 dev_dbg(&s
->dev
, "changing Vcc is not allowed at this time\n");
310 mutex_unlock(&s
->ops_mutex
);
314 if (mod
->Attributes
& CONF_IO_CHANGE_WIDTH
) {
315 pccard_io_map io_off
= { 0, 0, 0, 0, 1 };
319 io_on
.speed
= io_speed
;
320 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
326 io_on
.flags
= MAP_ACTIVE
| IO_DATA_PATH_WIDTH_8
;
327 io_on
.start
= s
->io
[i
].res
->start
;
328 io_on
.stop
= s
->io
[i
].res
->end
;
330 s
->ops
->set_io_map(s
, &io_off
);
332 s
->ops
->set_io_map(s
, &io_on
);
335 mutex_unlock(&s
->ops_mutex
);
338 } /* modify_configuration */
339 EXPORT_SYMBOL(pcmcia_modify_configuration
);
342 int pcmcia_release_configuration(struct pcmcia_device
*p_dev
)
344 pccard_io_map io
= { 0, 0, 0, 0, 1 };
345 struct pcmcia_socket
*s
= p_dev
->socket
;
349 mutex_lock(&s
->ops_mutex
);
350 c
= p_dev
->function_config
;
351 if (p_dev
->_locked
) {
353 if (--(s
->lock_count
) == 0) {
354 s
->socket
.flags
= SS_OUTPUT_ENA
; /* Is this correct? */
356 s
->socket
.io_irq
= 0;
357 s
->ops
->set_socket(s
, &s
->socket
);
360 if (c
->state
& CONFIG_LOCKED
) {
361 c
->state
&= ~CONFIG_LOCKED
;
362 if (c
->state
& CONFIG_IO_REQ
)
363 for (i
= 0; i
< MAX_IO_WIN
; i
++) {
367 if (s
->io
[i
].Config
!= 0)
370 s
->ops
->set_io_map(s
, &io
);
373 mutex_unlock(&s
->ops_mutex
);
376 } /* pcmcia_release_configuration */
379 /** pcmcia_release_io
381 * Release_io() releases the I/O ranges allocated by a client. This
382 * may be invoked some time after a card ejection has already dumped
383 * the actual socket configuration, so if the client is "stale", we
384 * don't bother checking the port ranges against the current socket
387 static int pcmcia_release_io(struct pcmcia_device
*p_dev
, io_req_t
*req
)
389 struct pcmcia_socket
*s
= p_dev
->socket
;
393 mutex_lock(&s
->ops_mutex
);
394 c
= p_dev
->function_config
;
401 if ((c
->io
.BasePort1
!= req
->BasePort1
) ||
402 (c
->io
.NumPorts1
!= req
->NumPorts1
) ||
403 (c
->io
.BasePort2
!= req
->BasePort2
) ||
404 (c
->io
.NumPorts2
!= req
->NumPorts2
))
407 c
->state
&= ~CONFIG_IO_REQ
;
409 release_io_space(s
, req
->BasePort1
, req
->NumPorts1
);
411 release_io_space(s
, req
->BasePort2
, req
->NumPorts2
);
414 mutex_unlock(&s
->ops_mutex
);
417 } /* pcmcia_release_io */
420 static int pcmcia_release_irq(struct pcmcia_device
*p_dev
, irq_req_t
*req
)
422 struct pcmcia_socket
*s
= p_dev
->socket
;
426 mutex_lock(&s
->ops_mutex
);
428 c
= p_dev
->function_config
;
435 if (c
->state
& CONFIG_LOCKED
)
438 if (c
->irq
.Attributes
!= req
->Attributes
) {
439 dev_dbg(&s
->dev
, "IRQ attributes must match assigned ones\n");
442 if (s
->irq
.AssignedIRQ
!= req
->AssignedIRQ
) {
443 dev_dbg(&s
->dev
, "IRQ must match assigned one\n");
446 if (--s
->irq
.Config
== 0) {
447 c
->state
&= ~CONFIG_IRQ_REQ
;
448 s
->irq
.AssignedIRQ
= 0;
452 free_irq(req
->AssignedIRQ
, p_dev
->priv
);
454 #ifdef CONFIG_PCMCIA_PROBE
455 pcmcia_used_irq
[req
->AssignedIRQ
]--;
460 mutex_unlock(&s
->ops_mutex
);
463 } /* pcmcia_release_irq */
466 int pcmcia_release_window(struct pcmcia_device
*p_dev
, window_handle_t wh
)
468 struct pcmcia_socket
*s
= p_dev
->socket
;
475 mutex_lock(&s
->ops_mutex
);
478 if (!(p_dev
->_win
& CLIENT_WIN_REQ(wh
))) {
479 dev_dbg(&s
->dev
, "not releasing unknown window\n");
480 mutex_unlock(&s
->ops_mutex
);
484 /* Shut down memory window */
485 win
->flags
&= ~MAP_ACTIVE
;
486 s
->ops
->set_mem_map(s
, win
);
487 s
->state
&= ~SOCKET_WIN_REQ(wh
);
489 /* Release system memory */
491 release_resource(win
->res
);
495 p_dev
->_win
&= ~CLIENT_WIN_REQ(wh
);
496 mutex_unlock(&s
->ops_mutex
);
499 } /* pcmcia_release_window */
500 EXPORT_SYMBOL(pcmcia_release_window
);
503 int pcmcia_request_configuration(struct pcmcia_device
*p_dev
,
508 struct pcmcia_socket
*s
= p_dev
->socket
;
512 if (!(s
->state
& SOCKET_PRESENT
))
515 if (req
->IntType
& INT_CARDBUS
) {
516 dev_dbg(&s
->dev
, "IntType may not be INT_CARDBUS\n");
520 mutex_lock(&s
->ops_mutex
);
521 c
= p_dev
->function_config
;
522 if (c
->state
& CONFIG_LOCKED
) {
523 mutex_unlock(&s
->ops_mutex
);
524 dev_dbg(&s
->dev
, "Configuration is locked\n");
528 /* Do power control. We don't allow changes in Vcc. */
529 s
->socket
.Vpp
= req
->Vpp
;
530 if (s
->ops
->set_socket(s
, &s
->socket
)) {
531 mutex_unlock(&s
->ops_mutex
);
532 dev_printk(KERN_WARNING
, &s
->dev
,
533 "Unable to set socket state\n");
537 /* Pick memory or I/O card, DMA mode, interrupt */
538 c
->IntType
= req
->IntType
;
539 c
->Attributes
= req
->Attributes
;
540 if (req
->IntType
& INT_MEMORY_AND_IO
)
541 s
->socket
.flags
|= SS_IOCARD
;
542 if (req
->IntType
& INT_ZOOMED_VIDEO
)
543 s
->socket
.flags
|= SS_ZVCARD
| SS_IOCARD
;
544 if (req
->Attributes
& CONF_ENABLE_DMA
)
545 s
->socket
.flags
|= SS_DMA_MODE
;
546 if (req
->Attributes
& CONF_ENABLE_SPKR
)
547 s
->socket
.flags
|= SS_SPKR_ENA
;
548 if (req
->Attributes
& CONF_ENABLE_IRQ
)
549 s
->socket
.io_irq
= s
->irq
.AssignedIRQ
;
551 s
->socket
.io_irq
= 0;
552 s
->ops
->set_socket(s
, &s
->socket
);
554 mutex_unlock(&s
->ops_mutex
);
556 /* Set up CIS configuration registers */
557 base
= c
->ConfigBase
= req
->ConfigBase
;
558 c
->CardValues
= req
->Present
;
559 if (req
->Present
& PRESENT_COPY
) {
561 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_SCR
)>>1, 1, &c
->Copy
);
563 if (req
->Present
& PRESENT_OPTION
) {
564 if (s
->functions
== 1) {
565 c
->Option
= req
->ConfigIndex
& COR_CONFIG_MASK
;
567 c
->Option
= req
->ConfigIndex
& COR_MFC_CONFIG_MASK
;
568 c
->Option
|= COR_FUNC_ENA
|COR_IREQ_ENA
;
569 if (req
->Present
& PRESENT_IOBASE_0
)
570 c
->Option
|= COR_ADDR_DECODE
;
572 if (c
->state
& CONFIG_IRQ_REQ
)
573 if (!(c
->irq
.Attributes
& IRQ_FORCED_PULSE
))
574 c
->Option
|= COR_LEVEL_REQ
;
575 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_COR
)>>1, 1, &c
->Option
);
578 if (req
->Present
& PRESENT_STATUS
) {
579 c
->Status
= req
->Status
;
580 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_CCSR
)>>1, 1, &c
->Status
);
582 if (req
->Present
& PRESENT_PIN_REPLACE
) {
584 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_PRR
)>>1, 1, &c
->Pin
);
586 if (req
->Present
& PRESENT_EXT_STATUS
) {
587 c
->ExtStatus
= req
->ExtStatus
;
588 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_ESR
)>>1, 1, &c
->ExtStatus
);
590 if (req
->Present
& PRESENT_IOBASE_0
) {
591 u_char b
= c
->io
.BasePort1
& 0xff;
592 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOBASE_0
)>>1, 1, &b
);
593 b
= (c
->io
.BasePort1
>> 8) & 0xff;
594 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOBASE_1
)>>1, 1, &b
);
596 if (req
->Present
& PRESENT_IOSIZE
) {
597 u_char b
= c
->io
.NumPorts1
+ c
->io
.NumPorts2
- 1;
598 pcmcia_write_cis_mem(s
, 1, (base
+ CISREG_IOSIZE
)>>1, 1, &b
);
601 /* Configure I/O windows */
602 if (c
->state
& CONFIG_IO_REQ
) {
603 mutex_lock(&s
->ops_mutex
);
604 iomap
.speed
= io_speed
;
605 for (i
= 0; i
< MAX_IO_WIN
; i
++)
608 iomap
.flags
= MAP_ACTIVE
;
609 switch (s
->io
[i
].res
->flags
& IO_DATA_PATH_WIDTH
) {
610 case IO_DATA_PATH_WIDTH_16
:
611 iomap
.flags
|= MAP_16BIT
; break;
612 case IO_DATA_PATH_WIDTH_AUTO
:
613 iomap
.flags
|= MAP_AUTOSZ
; break;
617 iomap
.start
= s
->io
[i
].res
->start
;
618 iomap
.stop
= s
->io
[i
].res
->end
;
619 s
->ops
->set_io_map(s
, &iomap
);
622 mutex_unlock(&s
->ops_mutex
);
625 c
->state
|= CONFIG_LOCKED
;
628 } /* pcmcia_request_configuration */
629 EXPORT_SYMBOL(pcmcia_request_configuration
);
632 /** pcmcia_request_io
634 * Request_io() reserves ranges of port addresses for a socket.
635 * I have not implemented range sharing or alias addressing.
637 int pcmcia_request_io(struct pcmcia_device
*p_dev
, io_req_t
*req
)
639 struct pcmcia_socket
*s
= p_dev
->socket
;
643 mutex_lock(&s
->ops_mutex
);
645 if (!(s
->state
& SOCKET_PRESENT
)) {
646 dev_dbg(&s
->dev
, "No card present\n");
653 c
= p_dev
->function_config
;
654 if (c
->state
& CONFIG_LOCKED
) {
655 dev_dbg(&s
->dev
, "Configuration is locked\n");
658 if (c
->state
& CONFIG_IO_REQ
) {
659 dev_dbg(&s
->dev
, "IO already configured\n");
662 if (req
->Attributes1
& (IO_SHARED
| IO_FORCE_ALIAS_ACCESS
)) {
663 dev_dbg(&s
->dev
, "bad attribute setting for IO region 1\n");
666 if ((req
->NumPorts2
> 0) &&
667 (req
->Attributes2
& (IO_SHARED
| IO_FORCE_ALIAS_ACCESS
))) {
668 dev_dbg(&s
->dev
, "bad attribute setting for IO region 2\n");
672 dev_dbg(&s
->dev
, "trying to allocate resource 1\n");
673 ret
= alloc_io_space(s
, req
->Attributes1
, &req
->BasePort1
,
674 req
->NumPorts1
, req
->IOAddrLines
);
676 dev_dbg(&s
->dev
, "allocation of resource 1 failed\n");
680 if (req
->NumPorts2
) {
681 dev_dbg(&s
->dev
, "trying to allocate resource 2\n");
682 ret
= alloc_io_space(s
, req
->Attributes2
, &req
->BasePort2
,
683 req
->NumPorts2
, req
->IOAddrLines
);
685 dev_dbg(&s
->dev
, "allocation of resource 2 failed\n");
686 release_io_space(s
, req
->BasePort1
, req
->NumPorts1
);
692 c
->state
|= CONFIG_IO_REQ
;
694 dev_dbg(&s
->dev
, "allocating resources succeeded: %d\n", ret
);
697 mutex_unlock(&s
->ops_mutex
);
700 } /* pcmcia_request_io */
701 EXPORT_SYMBOL(pcmcia_request_io
);
704 /** pcmcia_request_irq
706 * Request_irq() reserves an irq for this client.
708 * Also, since Linux only reserves irq's when they are actually
709 * hooked, we don't guarantee that an irq will still be available
710 * when the configuration is locked. Now that I think about it,
711 * there might be a way to fix this using a dummy handler.
714 #ifdef CONFIG_PCMCIA_PROBE
715 static irqreturn_t
test_action(int cpl
, void *dev_id
)
721 int pcmcia_request_irq(struct pcmcia_device
*p_dev
, irq_req_t
*req
)
723 struct pcmcia_socket
*s
= p_dev
->socket
;
725 int ret
= -EINVAL
, irq
= 0;
728 mutex_lock(&s
->ops_mutex
);
730 if (!(s
->state
& SOCKET_PRESENT
)) {
731 dev_dbg(&s
->dev
, "No card present\n");
734 c
= p_dev
->function_config
;
735 if (c
->state
& CONFIG_LOCKED
) {
736 dev_dbg(&s
->dev
, "Configuration is locked\n");
739 if (c
->state
& CONFIG_IRQ_REQ
) {
740 dev_dbg(&s
->dev
, "IRQ already configured\n");
744 /* Decide what type of interrupt we are registering */
746 if (s
->functions
> 1) /* All of this ought to be handled higher up */
748 else if (req
->Attributes
& IRQ_TYPE_DYNAMIC_SHARING
)
751 printk(KERN_WARNING
"pcmcia: Driver needs updating to support IRQ sharing.\n");
753 #ifdef CONFIG_PCMCIA_PROBE
756 /* if the underlying IRQ infrastructure allows for it, only allocate
757 * the IRQ, but do not enable it
760 type
|= IRQ_NOAUTOEN
;
761 #endif /* IRQ_NOAUTOEN */
763 if (s
->irq
.AssignedIRQ
!= 0) {
764 /* If the interrupt is already assigned, it must be the same */
765 irq
= s
->irq
.AssignedIRQ
;
768 u32 mask
= s
->irq_mask
;
769 void *data
= p_dev
; /* something unique to this device */
771 for (try = 0; try < 64; try++) {
774 /* marked as available by driver, and not blocked by userspace? */
775 if (!((mask
>> irq
) & 1))
778 /* avoid an IRQ which is already used by a PCMCIA card */
779 if ((try < 32) && pcmcia_used_irq
[irq
])
782 /* register the correct driver, if possible, of check whether
783 * registering a dummy handle works, i.e. if the IRQ isn't
784 * marked as used by the kernel resource management core */
785 ret
= request_irq(irq
,
786 (req
->Handler
) ? req
->Handler
: test_action
,
789 (req
->Handler
) ? p_dev
->priv
: data
);
798 /* only assign PCI irq if no IRQ already assigned */
799 if (ret
&& !s
->irq
.AssignedIRQ
) {
801 dev_printk(KERN_INFO
, &s
->dev
, "no IRQ found\n");
808 if (ret
&& req
->Handler
) {
809 ret
= request_irq(irq
, req
->Handler
, type
,
810 p_dev
->devname
, p_dev
->priv
);
812 dev_printk(KERN_INFO
, &s
->dev
,
813 "request_irq() failed\n");
818 /* Make sure the fact the request type was overridden is passed back */
819 if (type
== IRQF_SHARED
&& !(req
->Attributes
& IRQ_TYPE_DYNAMIC_SHARING
)) {
820 req
->Attributes
|= IRQ_TYPE_DYNAMIC_SHARING
;
821 dev_printk(KERN_WARNING
, &p_dev
->dev
, "pcmcia: "
822 "request for exclusive IRQ could not be fulfilled.\n");
823 dev_printk(KERN_WARNING
, &p_dev
->dev
, "pcmcia: the driver "
824 "needs updating to supported shared IRQ lines.\n");
826 c
->irq
.Attributes
= req
->Attributes
;
827 s
->irq
.AssignedIRQ
= req
->AssignedIRQ
= irq
;
830 c
->state
|= CONFIG_IRQ_REQ
;
833 #ifdef CONFIG_PCMCIA_PROBE
834 pcmcia_used_irq
[irq
]++;
839 mutex_unlock(&s
->ops_mutex
);
841 } /* pcmcia_request_irq */
842 EXPORT_SYMBOL(pcmcia_request_irq
);
845 /** pcmcia_request_window
847 * Request_window() establishes a mapping between card memory space
848 * and system memory space.
850 int pcmcia_request_window(struct pcmcia_device
*p_dev
, win_req_t
*req
, window_handle_t
*wh
)
852 struct pcmcia_socket
*s
= p_dev
->socket
;
857 if (!(s
->state
& SOCKET_PRESENT
)) {
858 dev_dbg(&s
->dev
, "No card present\n");
861 if (req
->Attributes
& (WIN_PAGED
| WIN_SHARED
)) {
862 dev_dbg(&s
->dev
, "bad attribute setting for iomem region\n");
866 /* Window size defaults to smallest available */
868 req
->Size
= s
->map_size
;
869 align
= (((s
->features
& SS_CAP_MEM_ALIGN
) ||
870 (req
->Attributes
& WIN_STRICT_ALIGN
)) ?
871 req
->Size
: s
->map_size
);
872 if (req
->Size
& (s
->map_size
-1)) {
873 dev_dbg(&s
->dev
, "invalid map size\n");
876 if ((req
->Base
&& (s
->features
& SS_CAP_STATIC_MAP
)) ||
877 (req
->Base
& (align
-1))) {
878 dev_dbg(&s
->dev
, "invalid base address\n");
884 /* Allocate system memory window */
885 for (w
= 0; w
< MAX_WIN
; w
++)
886 if (!(s
->state
& SOCKET_WIN_REQ(w
)))
889 dev_dbg(&s
->dev
, "all windows are used already\n");
893 mutex_lock(&s
->ops_mutex
);
896 if (!(s
->features
& SS_CAP_STATIC_MAP
)) {
897 win
->res
= pcmcia_find_mem_region(req
->Base
, req
->Size
, align
,
898 (req
->Attributes
& WIN_MAP_BELOW_1MB
), s
);
900 dev_dbg(&s
->dev
, "allocating mem region failed\n");
901 mutex_unlock(&s
->ops_mutex
);
905 p_dev
->_win
|= CLIENT_WIN_REQ(w
);
907 /* Configure the socket controller */
910 win
->speed
= req
->AccessSpeed
;
911 if (req
->Attributes
& WIN_MEMORY_TYPE
)
912 win
->flags
|= MAP_ATTRIB
;
913 if (req
->Attributes
& WIN_ENABLE
)
914 win
->flags
|= MAP_ACTIVE
;
915 if (req
->Attributes
& WIN_DATA_WIDTH_16
)
916 win
->flags
|= MAP_16BIT
;
917 if (req
->Attributes
& WIN_USE_WAIT
)
918 win
->flags
|= MAP_USE_WAIT
;
921 if (s
->ops
->set_mem_map(s
, win
) != 0) {
922 dev_dbg(&s
->dev
, "failed to set memory mapping\n");
923 mutex_unlock(&s
->ops_mutex
);
926 s
->state
|= SOCKET_WIN_REQ(w
);
928 /* Return window handle */
929 if (s
->features
& SS_CAP_STATIC_MAP
)
930 req
->Base
= win
->static_start
;
932 req
->Base
= win
->res
->start
;
934 mutex_unlock(&s
->ops_mutex
);
938 } /* pcmcia_request_window */
939 EXPORT_SYMBOL(pcmcia_request_window
);
941 void pcmcia_disable_device(struct pcmcia_device
*p_dev
)
943 pcmcia_release_configuration(p_dev
);
944 pcmcia_release_io(p_dev
, &p_dev
->io
);
945 pcmcia_release_irq(p_dev
, &p_dev
->irq
);
947 pcmcia_release_window(p_dev
, p_dev
->win
);
949 EXPORT_SYMBOL(pcmcia_disable_device
);
952 struct pcmcia_cfg_mem
{
953 struct pcmcia_device
*p_dev
;
955 int (*conf_check
) (struct pcmcia_device
*p_dev
,
956 cistpl_cftable_entry_t
*cfg
,
957 cistpl_cftable_entry_t
*dflt
,
961 cistpl_cftable_entry_t dflt
;
965 * pcmcia_do_loop_config() - internal helper for pcmcia_loop_config()
967 * pcmcia_do_loop_config() is the internal callback for the call from
968 * pcmcia_loop_config() to pccard_loop_tuple(). Data is transferred
969 * by a struct pcmcia_cfg_mem.
971 static int pcmcia_do_loop_config(tuple_t
*tuple
, cisparse_t
*parse
, void *priv
)
973 cistpl_cftable_entry_t
*cfg
= &parse
->cftable_entry
;
974 struct pcmcia_cfg_mem
*cfg_mem
= priv
;
977 cfg_mem
->p_dev
->conf
.ConfigIndex
= cfg
->index
;
978 if (cfg
->flags
& CISTPL_CFTABLE_DEFAULT
)
979 cfg_mem
->dflt
= *cfg
;
981 return cfg_mem
->conf_check(cfg_mem
->p_dev
, cfg
, &cfg_mem
->dflt
,
982 cfg_mem
->p_dev
->socket
->socket
.Vcc
,
987 * pcmcia_loop_config() - loop over configuration options
988 * @p_dev: the struct pcmcia_device which we need to loop for.
989 * @conf_check: function to call for each configuration option.
990 * It gets passed the struct pcmcia_device, the CIS data
991 * describing the configuration option, and private data
992 * being passed to pcmcia_loop_config()
993 * @priv_data: private data to be passed to the conf_check function.
995 * pcmcia_loop_config() loops over all configuration options, and calls
996 * the driver-specific conf_check() for each one, checking whether
997 * it is a valid one. Returns 0 on success or errorcode otherwise.
999 int pcmcia_loop_config(struct pcmcia_device
*p_dev
,
1000 int (*conf_check
) (struct pcmcia_device
*p_dev
,
1001 cistpl_cftable_entry_t
*cfg
,
1002 cistpl_cftable_entry_t
*dflt
,
1007 struct pcmcia_cfg_mem
*cfg_mem
;
1010 cfg_mem
= kzalloc(sizeof(struct pcmcia_cfg_mem
), GFP_KERNEL
);
1011 if (cfg_mem
== NULL
)
1014 cfg_mem
->p_dev
= p_dev
;
1015 cfg_mem
->conf_check
= conf_check
;
1016 cfg_mem
->priv_data
= priv_data
;
1018 ret
= pccard_loop_tuple(p_dev
->socket
, p_dev
->func
,
1019 CISTPL_CFTABLE_ENTRY
, &cfg_mem
->parse
,
1020 cfg_mem
, pcmcia_do_loop_config
);
1025 EXPORT_SYMBOL(pcmcia_loop_config
);
1028 struct pcmcia_loop_mem
{
1029 struct pcmcia_device
*p_dev
;
1031 int (*loop_tuple
) (struct pcmcia_device
*p_dev
,
1037 * pcmcia_do_loop_tuple() - internal helper for pcmcia_loop_config()
1039 * pcmcia_do_loop_tuple() is the internal callback for the call from
1040 * pcmcia_loop_tuple() to pccard_loop_tuple(). Data is transferred
1041 * by a struct pcmcia_cfg_mem.
1043 static int pcmcia_do_loop_tuple(tuple_t
*tuple
, cisparse_t
*parse
, void *priv
)
1045 struct pcmcia_loop_mem
*loop
= priv
;
1047 return loop
->loop_tuple(loop
->p_dev
, tuple
, loop
->priv_data
);
1051 * pcmcia_loop_tuple() - loop over tuples in the CIS
1052 * @p_dev: the struct pcmcia_device which we need to loop for.
1053 * @code: which CIS code shall we look for?
1054 * @priv_data: private data to be passed to the loop_tuple function.
1055 * @loop_tuple: function to call for each CIS entry of type @function. IT
1056 * gets passed the raw tuple and @priv_data.
1058 * pcmcia_loop_tuple() loops over all CIS entries of type @function, and
1059 * calls the @loop_tuple function for each entry. If the call to @loop_tuple
1060 * returns 0, the loop exits. Returns 0 on success or errorcode otherwise.
1062 int pcmcia_loop_tuple(struct pcmcia_device
*p_dev
, cisdata_t code
,
1063 int (*loop_tuple
) (struct pcmcia_device
*p_dev
,
1068 struct pcmcia_loop_mem loop
= {
1070 .loop_tuple
= loop_tuple
,
1071 .priv_data
= priv_data
};
1073 return pccard_loop_tuple(p_dev
->socket
, p_dev
->func
, code
, NULL
,
1074 &loop
, pcmcia_do_loop_tuple
);
1076 EXPORT_SYMBOL(pcmcia_loop_tuple
);
1079 struct pcmcia_loop_get
{
1085 * pcmcia_do_get_tuple() - internal helper for pcmcia_get_tuple()
1087 * pcmcia_do_get_tuple() is the internal callback for the call from
1088 * pcmcia_get_tuple() to pcmcia_loop_tuple(). As we're only interested in
1089 * the first tuple, return 0 unconditionally. Create a memory buffer large
1090 * enough to hold the content of the tuple, and fill it with the tuple data.
1091 * The caller is responsible to free the buffer.
1093 static int pcmcia_do_get_tuple(struct pcmcia_device
*p_dev
, tuple_t
*tuple
,
1096 struct pcmcia_loop_get
*get
= priv
;
1098 *get
->buf
= kzalloc(tuple
->TupleDataLen
, GFP_KERNEL
);
1100 get
->len
= tuple
->TupleDataLen
;
1101 memcpy(*get
->buf
, tuple
->TupleData
, tuple
->TupleDataLen
);
1103 dev_dbg(&p_dev
->dev
, "do_get_tuple: out of memory\n");
1108 * pcmcia_get_tuple() - get first tuple from CIS
1109 * @p_dev: the struct pcmcia_device which we need to loop for.
1110 * @code: which CIS code shall we look for?
1111 * @buf: pointer to store the buffer to.
1113 * pcmcia_get_tuple() gets the content of the first CIS entry of type @code.
1114 * It returns the buffer length (or zero). The caller is responsible to free
1115 * the buffer passed in @buf.
1117 size_t pcmcia_get_tuple(struct pcmcia_device
*p_dev
, cisdata_t code
,
1118 unsigned char **buf
)
1120 struct pcmcia_loop_get get
= {
1126 pcmcia_loop_tuple(p_dev
, code
, pcmcia_do_get_tuple
, &get
);
1130 EXPORT_SYMBOL(pcmcia_get_tuple
);
1134 * pcmcia_do_get_mac() - internal helper for pcmcia_get_mac_from_cis()
1136 * pcmcia_do_get_mac() is the internal callback for the call from
1137 * pcmcia_get_mac_from_cis() to pcmcia_loop_tuple(). We check whether the
1138 * tuple contains a proper LAN_NODE_ID of length 6, and copy the data
1139 * to struct net_device->dev_addr[i].
1141 static int pcmcia_do_get_mac(struct pcmcia_device
*p_dev
, tuple_t
*tuple
,
1144 struct net_device
*dev
= priv
;
1147 if (tuple
->TupleData
[0] != CISTPL_FUNCE_LAN_NODE_ID
)
1149 if (tuple
->TupleDataLen
< ETH_ALEN
+ 2) {
1150 dev_warn(&p_dev
->dev
, "Invalid CIS tuple length for "
1155 if (tuple
->TupleData
[1] != ETH_ALEN
) {
1156 dev_warn(&p_dev
->dev
, "Invalid header for LAN_NODE_ID\n");
1159 for (i
= 0; i
< 6; i
++)
1160 dev
->dev_addr
[i
] = tuple
->TupleData
[i
+2];
1165 * pcmcia_get_mac_from_cis() - read out MAC address from CISTPL_FUNCE
1166 * @p_dev: the struct pcmcia_device for which we want the address.
1167 * @dev: a properly prepared struct net_device to store the info to.
1169 * pcmcia_get_mac_from_cis() reads out the hardware MAC address from
1170 * CISTPL_FUNCE and stores it into struct net_device *dev->dev_addr which
1171 * must be set up properly by the driver (see examples!).
1173 int pcmcia_get_mac_from_cis(struct pcmcia_device
*p_dev
, struct net_device
*dev
)
1175 return pcmcia_loop_tuple(p_dev
, CISTPL_FUNCE
, pcmcia_do_get_mac
, dev
);
1177 EXPORT_SYMBOL(pcmcia_get_mac_from_cis
);