Commit | Line | Data |
---|---|---|
e4d6b795 MB |
1 | /* |
2 | ||
3 | Broadcom B43 wireless driver | |
4 | ||
5 | Copyright (c) 2007 Michael Buesch <mb@bu3sch.de> | |
6 | ||
7 | This program is free software; you can redistribute it and/or modify | |
8 | it under the terms of the GNU General Public License as published by | |
9 | the Free Software Foundation; either version 2 of the License, or | |
10 | (at your option) any later version. | |
11 | ||
12 | This program is distributed in the hope that it will be useful, | |
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | GNU General Public License for more details. | |
16 | ||
17 | You should have received a copy of the GNU General Public License | |
18 | along with this program; see the file COPYING. If not, write to | |
19 | the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor, | |
20 | Boston, MA 02110-1301, USA. | |
21 | ||
22 | */ | |
23 | ||
1a09404a MB |
24 | #include "pcmcia.h" |
25 | ||
e4d6b795 MB |
26 | #include <linux/ssb/ssb.h> |
27 | ||
28 | #include <pcmcia/cs_types.h> | |
29 | #include <pcmcia/cs.h> | |
30 | #include <pcmcia/cistpl.h> | |
31 | #include <pcmcia/ciscode.h> | |
32 | #include <pcmcia/ds.h> | |
33 | #include <pcmcia/cisreg.h> | |
34 | ||
1a09404a | 35 | |
e4d6b795 MB |
36 | static /*const */ struct pcmcia_device_id b43_pcmcia_tbl[] = { |
37 | PCMCIA_DEVICE_MANF_CARD(0x2D0, 0x448), | |
38 | PCMCIA_DEVICE_NULL, | |
39 | }; | |
40 | ||
41 | MODULE_DEVICE_TABLE(pcmcia, b43_pcmcia_tbl); | |
42 | ||
43 | #ifdef CONFIG_PM | |
44 | static int b43_pcmcia_suspend(struct pcmcia_device *dev) | |
45 | { | |
46 | //TODO | |
47 | return 0; | |
48 | } | |
49 | ||
50 | static int b43_pcmcia_resume(struct pcmcia_device *dev) | |
51 | { | |
52 | //TODO | |
53 | return 0; | |
54 | } | |
55 | #else /* CONFIG_PM */ | |
56 | # define b43_pcmcia_suspend NULL | |
57 | # define b43_pcmcia_resume NULL | |
58 | #endif /* CONFIG_PM */ | |
59 | ||
60 | static int __devinit b43_pcmcia_probe(struct pcmcia_device *dev) | |
61 | { | |
62 | struct ssb_bus *ssb; | |
63 | win_req_t win; | |
64 | memreq_t mem; | |
65 | tuple_t tuple; | |
66 | cisparse_t parse; | |
67 | int err = -ENOMEM; | |
68 | int res; | |
69 | unsigned char buf[64]; | |
70 | ||
71 | ssb = kzalloc(sizeof(*ssb), GFP_KERNEL); | |
72 | if (!ssb) | |
73 | goto out; | |
74 | ||
75 | err = -ENODEV; | |
76 | tuple.DesiredTuple = CISTPL_CONFIG; | |
77 | tuple.Attributes = 0; | |
78 | tuple.TupleData = buf; | |
79 | tuple.TupleDataMax = sizeof(buf); | |
80 | tuple.TupleOffset = 0; | |
81 | ||
82 | res = pcmcia_get_first_tuple(dev, &tuple); | |
83 | if (res != CS_SUCCESS) | |
84 | goto err_kfree_ssb; | |
85 | res = pcmcia_get_tuple_data(dev, &tuple); | |
86 | if (res != CS_SUCCESS) | |
87 | goto err_kfree_ssb; | |
88 | res = pcmcia_parse_tuple(dev, &tuple, &parse); | |
89 | if (res != CS_SUCCESS) | |
90 | goto err_kfree_ssb; | |
91 | ||
92 | dev->conf.ConfigBase = parse.config.base; | |
93 | dev->conf.Present = parse.config.rmask[0]; | |
94 | ||
95 | dev->io.BasePort2 = 0; | |
96 | dev->io.NumPorts2 = 0; | |
97 | dev->io.Attributes2 = 0; | |
98 | ||
99 | win.Attributes = WIN_MEMORY_TYPE_CM | WIN_ENABLE | WIN_USE_WAIT; | |
100 | win.Base = 0; | |
101 | win.Size = SSB_CORE_SIZE; | |
102 | win.AccessSpeed = 1000; | |
103 | res = pcmcia_request_window(&dev, &win, &dev->win); | |
104 | if (res != CS_SUCCESS) | |
105 | goto err_kfree_ssb; | |
106 | ||
107 | mem.CardOffset = 0; | |
108 | mem.Page = 0; | |
109 | res = pcmcia_map_mem_page(dev->win, &mem); | |
110 | if (res != CS_SUCCESS) | |
111 | goto err_kfree_ssb; | |
112 | ||
113 | res = pcmcia_request_configuration(dev, &dev->conf); | |
114 | if (res != CS_SUCCESS) | |
115 | goto err_disable; | |
116 | ||
117 | err = ssb_bus_pcmciabus_register(ssb, dev, win.Base); | |
118 | dev->priv = ssb; | |
119 | ||
120 | out: | |
121 | return err; | |
122 | err_disable: | |
123 | pcmcia_disable_device(dev); | |
124 | err_kfree_ssb: | |
125 | kfree(ssb); | |
126 | return err; | |
127 | } | |
128 | ||
129 | static void __devexit b43_pcmcia_remove(struct pcmcia_device *dev) | |
130 | { | |
131 | struct ssb_bus *ssb = dev->priv; | |
132 | ||
133 | ssb_bus_unregister(ssb); | |
134 | pcmcia_release_window(dev->win); | |
135 | pcmcia_disable_device(dev); | |
136 | kfree(ssb); | |
137 | dev->priv = NULL; | |
138 | } | |
139 | ||
140 | static struct pcmcia_driver b43_pcmcia_driver = { | |
141 | .owner = THIS_MODULE, | |
142 | .drv = { | |
143 | .name = "b43-pcmcia", | |
144 | }, | |
145 | .id_table = b43_pcmcia_tbl, | |
146 | .probe = b43_pcmcia_probe, | |
147 | .remove = b43_pcmcia_remove, | |
148 | .suspend = b43_pcmcia_suspend, | |
149 | .resume = b43_pcmcia_resume, | |
150 | }; | |
151 | ||
152 | int b43_pcmcia_init(void) | |
153 | { | |
154 | return pcmcia_register_driver(&b43_pcmcia_driver); | |
155 | } | |
156 | ||
157 | void b43_pcmcia_exit(void) | |
158 | { | |
159 | pcmcia_unregister_driver(&b43_pcmcia_driver); | |
160 | } |