Merge tag 'spi-fix-v6.8-merge-window' of git://git.kernel.org/pub/scm/linux/kernel...
[linux-2.6-block.git] / drivers / pcmcia / soc_common.c
CommitLineData
1da177e4
LT
1/*======================================================================
2
3 Common support code for the PCMCIA control functionality of
4 integrated SOCs like the SA-11x0 and PXA2xx microprocessors.
5
6 The contents of this file are subject to the Mozilla Public
7 License Version 1.1 (the "License"); you may not use this file
8 except in compliance with the License. You may obtain a copy of
9 the License at http://www.mozilla.org/MPL/
10
11 Software distributed under the License is distributed on an "AS
12 IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
13 implied. See the License for the specific language governing
14 rights and limitations under the License.
15
16 The initial developer of the original code is John G. Dorsey
17 <john+@cs.cmu.edu>. Portions created by John G. Dorsey are
18 Copyright (C) 1999 John G. Dorsey. All Rights Reserved.
19
20 Alternatively, the contents of this file may be used under the
21 terms of the GNU Public License version 2 (the "GPL"), in which
22 case the provisions of the GPL are applicable instead of the
23 above. If you wish to allow the use of your version of this file
24 only under the terms of the GPL and not to allow others to use
25 your version of this file under the MPL, indicate your decision
26 by deleting the provisions above and replace them with the notice
27 and other provisions required by the GPL. If you do not delete
28 the provisions above, a recipient may use your version of this
29 file under either the MPL or the GPL.
30
31======================================================================*/
32
33
17b38ebb 34#include <linux/cpufreq.h>
d9dc8787 35#include <linux/gpio.h>
45ca7536 36#include <linux/gpio/consumer.h>
1da177e4 37#include <linux/init.h>
17b38ebb
MRJ
38#include <linux/interrupt.h>
39#include <linux/io.h>
40#include <linux/irq.h>
1da177e4 41#include <linux/kernel.h>
1da177e4 42#include <linux/mm.h>
17b38ebb
MRJ
43#include <linux/module.h>
44#include <linux/moduleparam.h>
23d077e2 45#include <linux/mutex.h>
ac61b600 46#include <linux/regulator/consumer.h>
1da177e4 47#include <linux/spinlock.h>
17b38ebb 48#include <linux/timer.h>
645b3026 49#include <linux/pci.h>
1da177e4 50
1da177e4
LT
51#include "soc_common.h"
52
d9dc8787
RK
53static irqreturn_t soc_common_pcmcia_interrupt(int irq, void *dev);
54
7d16b658 55#ifdef CONFIG_PCMCIA_DEBUG
1da177e4
LT
56
57static int pc_debug;
58module_param(pc_debug, int, 0644);
59
60void soc_pcmcia_debug(struct soc_pcmcia_socket *skt, const char *func,
61 int lvl, const char *fmt, ...)
62{
106665d9 63 struct va_format vaf;
1da177e4
LT
64 va_list args;
65 if (pc_debug > lvl) {
1da177e4 66 va_start(args, fmt);
106665d9
JP
67
68 vaf.fmt = fmt;
69 vaf.va = &args;
70
71 printk(KERN_DEBUG "skt%u: %s: %pV", skt->nr, func, &vaf);
72
1da177e4
LT
73 va_end(args);
74 }
75}
b9f515e3 76EXPORT_SYMBOL(soc_pcmcia_debug);
1da177e4
LT
77
78#endif
79
17b38ebb
MRJ
80#define to_soc_pcmcia_socket(x) \
81 container_of(x, struct soc_pcmcia_socket, socket)
1da177e4 82
ac61b600
RK
83int soc_pcmcia_regulator_set(struct soc_pcmcia_socket *skt,
84 struct soc_pcmcia_regulator *r, int v)
85{
86 bool on;
87 int ret;
88
89 if (!r->reg)
90 return 0;
91
92 on = v != 0;
93 if (r->on == on)
94 return 0;
95
96 if (on) {
97 ret = regulator_set_voltage(r->reg, v * 100000, v * 100000);
98 if (ret) {
99 int vout = regulator_get_voltage(r->reg) / 100000;
100
101 dev_warn(&skt->socket.dev,
102 "CS requested %s=%u.%uV, applying %u.%uV\n",
103 r == &skt->vcc ? "Vcc" : "Vpp",
104 v / 10, v % 10, vout / 10, vout % 10);
105 }
106
107 ret = regulator_enable(r->reg);
108 } else {
75ed2687 109 ret = regulator_disable(r->reg);
ac61b600
RK
110 }
111 if (ret == 0)
112 r->on = on;
113
114 return ret;
115}
116EXPORT_SYMBOL_GPL(soc_pcmcia_regulator_set);
117
1da177e4
LT
118static unsigned short
119calc_speed(unsigned short *spds, int num, unsigned short dflt)
120{
121 unsigned short speed = 0;
122 int i;
123
124 for (i = 0; i < num; i++)
125 if (speed < spds[i])
126 speed = spds[i];
127 if (speed == 0)
128 speed = dflt;
129
130 return speed;
131}
132
17b38ebb
MRJ
133void soc_common_pcmcia_get_timing(struct soc_pcmcia_socket *skt,
134 struct soc_pcmcia_timing *timing)
1da177e4 135{
17b38ebb
MRJ
136 timing->io =
137 calc_speed(skt->spd_io, MAX_IO_WIN, SOC_PCMCIA_IO_ACCESS);
138 timing->mem =
139 calc_speed(skt->spd_mem, MAX_WIN, SOC_PCMCIA_3V_MEM_ACCESS);
140 timing->attr =
141 calc_speed(skt->spd_attr, MAX_WIN, SOC_PCMCIA_3V_MEM_ACCESS);
1da177e4
LT
142}
143EXPORT_SYMBOL(soc_common_pcmcia_get_timing);
144
d9dc8787
RK
145static void __soc_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt,
146 unsigned int nr)
147{
148 unsigned int i;
149
59ecfefa 150 for (i = 0; i < nr; i++)
d9dc8787
RK
151 if (skt->stat[i].irq)
152 free_irq(skt->stat[i].irq, skt);
d9dc8787
RK
153
154 if (skt->ops->hw_shutdown)
155 skt->ops->hw_shutdown(skt);
0821c3bc
DES
156
157 clk_disable_unprepare(skt->clk);
d9dc8787
RK
158}
159
160static void soc_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
161{
162 __soc_pcmcia_hw_shutdown(skt, ARRAY_SIZE(skt->stat));
163}
164
45ca7536
RK
165int soc_pcmcia_request_gpiods(struct soc_pcmcia_socket *skt)
166{
167 struct device *dev = skt->socket.dev.parent;
168 struct gpio_desc *desc;
169 int i;
170
171 for (i = 0; i < ARRAY_SIZE(skt->stat); i++) {
172 if (!skt->stat[i].name)
173 continue;
174
175 desc = devm_gpiod_get(dev, skt->stat[i].name, GPIOD_IN);
176 if (IS_ERR(desc)) {
177 dev_err(dev, "Failed to get GPIO for %s: %ld\n",
178 skt->stat[i].name, PTR_ERR(desc));
179 return PTR_ERR(desc);
180 }
181
182 skt->stat[i].desc = desc;
183 }
184
185 return 0;
186}
187EXPORT_SYMBOL_GPL(soc_pcmcia_request_gpiods);
188
d9dc8787
RK
189static int soc_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
190{
191 int ret = 0, i;
192
d3fdd701
AY
193 ret = clk_prepare_enable(skt->clk);
194 if (ret)
195 return ret;
0821c3bc 196
d9dc8787
RK
197 if (skt->ops->hw_init) {
198 ret = skt->ops->hw_init(skt);
d3fdd701
AY
199 if (ret) {
200 clk_disable_unprepare(skt->clk);
d9dc8787 201 return ret;
d3fdd701 202 }
d9dc8787
RK
203 }
204
205 for (i = 0; i < ARRAY_SIZE(skt->stat); i++) {
206 if (gpio_is_valid(skt->stat[i].gpio)) {
7bfe4978
RK
207 unsigned long flags = GPIOF_IN;
208
209 /* CD is active low by default */
210 if (i == SOC_STAT_CD)
211 flags |= GPIOF_ACTIVE_LOW;
212
59ecfefa 213 ret = devm_gpio_request_one(skt->socket.dev.parent,
7bfe4978 214 skt->stat[i].gpio, flags,
59ecfefa 215 skt->stat[i].name);
d9dc8787
RK
216 if (ret) {
217 __soc_pcmcia_hw_shutdown(skt, i);
218 return ret;
219 }
220
45ca7536
RK
221 skt->stat[i].desc = gpio_to_desc(skt->stat[i].gpio);
222 }
223
5805271d 224 if (i < SOC_STAT_VS1 && skt->stat[i].desc) {
45ca7536 225 int irq = gpiod_to_irq(skt->stat[i].desc);
d9dc8787 226
a4941191
RK
227 if (irq > 0) {
228 if (i == SOC_STAT_RDY)
229 skt->socket.pci_irq = irq;
230 else
231 skt->stat[i].irq = irq;
232 }
d9dc8787
RK
233 }
234
235 if (skt->stat[i].irq) {
236 ret = request_irq(skt->stat[i].irq,
237 soc_common_pcmcia_interrupt,
238 IRQF_TRIGGER_NONE,
239 skt->stat[i].name, skt);
240 if (ret) {
d9dc8787
RK
241 __soc_pcmcia_hw_shutdown(skt, i);
242 return ret;
243 }
244 }
245 }
246
247 return ret;
248}
249
250static void soc_pcmcia_hw_enable(struct soc_pcmcia_socket *skt)
251{
252 int i;
253
254 for (i = 0; i < ARRAY_SIZE(skt->stat); i++)
255 if (skt->stat[i].irq) {
256 irq_set_irq_type(skt->stat[i].irq, IRQ_TYPE_EDGE_RISING);
257 irq_set_irq_type(skt->stat[i].irq, IRQ_TYPE_EDGE_BOTH);
258 }
259}
260
261static void soc_pcmcia_hw_disable(struct soc_pcmcia_socket *skt)
262{
263 int i;
264
265 for (i = 0; i < ARRAY_SIZE(skt->stat); i++)
266 if (skt->stat[i].irq)
267 irq_set_irq_type(skt->stat[i].irq, IRQ_TYPE_NONE);
268}
269
a1d05002
RK
270/*
271 * The CF 3.0 specification says that cards tie VS1 to ground and leave
272 * VS2 open. Many implementations do not wire up the VS signals, so we
273 * provide hard-coded values as per the CF 3.0 spec.
274 */
275void soc_common_cf_socket_state(struct soc_pcmcia_socket *skt,
276 struct pcmcia_state *state)
277{
278 state->vs_3v = 1;
279}
280EXPORT_SYMBOL_GPL(soc_common_cf_socket_state);
281
1da177e4
LT
282static unsigned int soc_common_pcmcia_skt_state(struct soc_pcmcia_socket *skt)
283{
284 struct pcmcia_state state;
285 unsigned int stat;
286
287 memset(&state, 0, sizeof(struct pcmcia_state));
288
d9dc8787
RK
289 /* Make battery voltage state report 'good' */
290 state.bvd1 = 1;
291 state.bvd2 = 1;
292
45ca7536 293 if (skt->stat[SOC_STAT_CD].desc)
7bfe4978 294 state.detect = !!gpiod_get_value(skt->stat[SOC_STAT_CD].desc);
45ca7536
RK
295 if (skt->stat[SOC_STAT_RDY].desc)
296 state.ready = !!gpiod_get_value(skt->stat[SOC_STAT_RDY].desc);
297 if (skt->stat[SOC_STAT_BVD1].desc)
298 state.bvd1 = !!gpiod_get_value(skt->stat[SOC_STAT_BVD1].desc);
299 if (skt->stat[SOC_STAT_BVD2].desc)
300 state.bvd2 = !!gpiod_get_value(skt->stat[SOC_STAT_BVD2].desc);
5805271d
RK
301 if (skt->stat[SOC_STAT_VS1].desc)
302 state.vs_3v = !!gpiod_get_value(skt->stat[SOC_STAT_VS1].desc);
303 if (skt->stat[SOC_STAT_VS2].desc)
304 state.vs_Xv = !!gpiod_get_value(skt->stat[SOC_STAT_VS2].desc);
d9dc8787 305
1da177e4
LT
306 skt->ops->socket_state(skt, &state);
307
308 stat = state.detect ? SS_DETECT : 0;
309 stat |= state.ready ? SS_READY : 0;
310 stat |= state.wrprot ? SS_WRPROT : 0;
311 stat |= state.vs_3v ? SS_3VCARD : 0;
312 stat |= state.vs_Xv ? SS_XVCARD : 0;
313
314 /* The power status of individual sockets is not available
315 * explicitly from the hardware, so we just remember the state
316 * and regurgitate it upon request:
317 */
318 stat |= skt->cs_state.Vcc ? SS_POWERON : 0;
319
320 if (skt->cs_state.flags & SS_IOCARD)
a466ebd2 321 stat |= state.bvd1 ? 0 : SS_STSCHG;
1da177e4
LT
322 else {
323 if (state.bvd1 == 0)
324 stat |= SS_BATDEAD;
325 else if (state.bvd2 == 0)
326 stat |= SS_BATWARN;
327 }
328 return stat;
329}
330
331/*
332 * soc_common_pcmcia_config_skt
333 * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^
334 *
335 * Convert PCMCIA socket state to our socket configure structure.
336 */
17b38ebb
MRJ
337static int soc_common_pcmcia_config_skt(
338 struct soc_pcmcia_socket *skt, socket_state_t *state)
1da177e4
LT
339{
340 int ret;
341
342 ret = skt->ops->configure_socket(skt, state);
6ac95d82
RK
343 if (ret < 0) {
344 pr_err("soc_common_pcmcia: unable to configure socket %d\n",
345 skt->nr);
346 /* restore the previous state */
347 WARN_ON(skt->ops->configure_socket(skt, &skt->cs_state));
348 return ret;
349 }
350
1da177e4 351 if (ret == 0) {
535e0abc 352 struct gpio_desc *descs[2];
b9762beb
JK
353 DECLARE_BITMAP(values, 2);
354 int n = 0;
535e0abc
RK
355
356 if (skt->gpio_reset) {
357 descs[n] = skt->gpio_reset;
b9762beb 358 __assign_bit(n++, values, state->flags & SS_RESET);
535e0abc
RK
359 }
360 if (skt->gpio_bus_enable) {
361 descs[n] = skt->gpio_bus_enable;
b9762beb 362 __assign_bit(n++, values, state->flags & SS_OUTPUT_ENA);
535e0abc
RK
363 }
364
365 if (n)
77588c14 366 gpiod_set_array_value_cansleep(n, descs, NULL, values);
535e0abc 367
1da177e4
LT
368 /*
369 * This really needs a better solution. The IRQ
370 * may or may not be claimed by the driver.
371 */
372 if (skt->irq_state != 1 && state->io_irq) {
373 skt->irq_state = 1;
dced35ae
TG
374 irq_set_irq_type(skt->socket.pci_irq,
375 IRQ_TYPE_EDGE_FALLING);
1da177e4
LT
376 } else if (skt->irq_state == 1 && state->io_irq == 0) {
377 skt->irq_state = 0;
dced35ae 378 irq_set_irq_type(skt->socket.pci_irq, IRQ_TYPE_NONE);
1da177e4
LT
379 }
380
381 skt->cs_state = *state;
382 }
383
1da177e4
LT
384 return ret;
385}
386
387/* soc_common_pcmcia_sock_init()
388 * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
389 *
390 * (Re-)Initialise the socket, turning on status interrupts
391 * and PCMCIA bus. This must wait for power to stabilise
392 * so that the card status signals report correctly.
393 *
394 * Returns: 0
395 */
396static int soc_common_pcmcia_sock_init(struct pcmcia_socket *sock)
397{
398 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
399
400 debug(skt, 2, "initializing socket\n");
a747ce83
JC
401 if (skt->ops->socket_init)
402 skt->ops->socket_init(skt);
d9dc8787 403 soc_pcmcia_hw_enable(skt);
1da177e4
LT
404 return 0;
405}
406
407
408/*
409 * soc_common_pcmcia_suspend()
410 * ^^^^^^^^^^^^^^^^^^^^^^^^^^^
411 *
412 * Remove power on the socket, disable IRQs from the card.
413 * Turn off status interrupts, and disable the PCMCIA bus.
414 *
415 * Returns: 0
416 */
417static int soc_common_pcmcia_suspend(struct pcmcia_socket *sock)
418{
419 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
420
421 debug(skt, 2, "suspending socket\n");
422
d9dc8787 423 soc_pcmcia_hw_disable(skt);
a747ce83
JC
424 if (skt->ops->socket_suspend)
425 skt->ops->socket_suspend(skt);
1da177e4
LT
426
427 return 0;
428}
429
430static DEFINE_SPINLOCK(status_lock);
431
432static void soc_common_check_status(struct soc_pcmcia_socket *skt)
433{
434 unsigned int events;
435
436 debug(skt, 4, "entering PCMCIA monitoring thread\n");
437
438 do {
439 unsigned int status;
440 unsigned long flags;
441
442 status = soc_common_pcmcia_skt_state(skt);
443
444 spin_lock_irqsave(&status_lock, flags);
445 events = (status ^ skt->status) & skt->cs_state.csc_mask;
446 skt->status = status;
447 spin_unlock_irqrestore(&status_lock, flags);
448
449 debug(skt, 4, "events: %s%s%s%s%s%s\n",
450 events == 0 ? "<NONE>" : "",
451 events & SS_DETECT ? "DETECT " : "",
452 events & SS_READY ? "READY " : "",
453 events & SS_BATDEAD ? "BATDEAD " : "",
454 events & SS_BATWARN ? "BATWARN " : "",
455 events & SS_STSCHG ? "STSCHG " : "");
456
457 if (events)
458 pcmcia_parse_events(&skt->socket, events);
459 } while (events);
460}
461
462/* Let's poll for events in addition to IRQs since IRQ only is unreliable... */
41760d0e 463static void soc_common_pcmcia_poll_event(struct timer_list *t)
1da177e4 464{
41760d0e 465 struct soc_pcmcia_socket *skt = from_timer(skt, t, poll_timer);
1da177e4
LT
466 debug(skt, 4, "polling for events\n");
467
468 mod_timer(&skt->poll_timer, jiffies + SOC_PCMCIA_POLL_PERIOD);
469
470 soc_common_check_status(skt);
471}
472
473
474/*
475 * Service routine for socket driver interrupts (requested by the
476 * low-level PCMCIA init() operation via soc_common_pcmcia_thread()).
477 * The actual interrupt-servicing work is performed by
478 * soc_common_pcmcia_thread(), largely because the Card Services event-
479 * handling code performs scheduling operations which cannot be
480 * executed from within an interrupt context.
481 */
7d12e780 482static irqreturn_t soc_common_pcmcia_interrupt(int irq, void *dev)
1da177e4
LT
483{
484 struct soc_pcmcia_socket *skt = dev;
485
486 debug(skt, 3, "servicing IRQ %d\n", irq);
487
488 soc_common_check_status(skt);
489
490 return IRQ_HANDLED;
491}
492
493
494/*
495 * Implements the get_status() operation for the in-kernel PCMCIA
496 * service (formerly SS_GetStatus in Card Services). Essentially just
497 * fills in bits in `status' according to internal driver state or
498 * the value of the voltage detect chipselect register.
499 *
500 * As a debugging note, during card startup, the PCMCIA core issues
501 * three set_socket() commands in a row the first with RESET deasserted,
502 * the second with RESET asserted, and the last with RESET deasserted
503 * again. Following the third set_socket(), a get_status() command will
504 * be issued. The kernel is looking for the SS_READY flag (see
505 * setup_socket(), reset_socket(), and unreset_socket() in cs.c).
506 *
507 * Returns: 0
508 */
509static int
510soc_common_pcmcia_get_status(struct pcmcia_socket *sock, unsigned int *status)
511{
512 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
513
514 skt->status = soc_common_pcmcia_skt_state(skt);
515 *status = skt->status;
516
517 return 0;
518}
519
520
1da177e4
LT
521/*
522 * Implements the set_socket() operation for the in-kernel PCMCIA
523 * service (formerly SS_SetSocket in Card Services). We more or
524 * less punt all of this work and let the kernel handle the details
525 * of power configuration, reset, &c. We also record the value of
526 * `state' in order to regurgitate it to the PCMCIA core later.
1da177e4 527 */
17b38ebb
MRJ
528static int soc_common_pcmcia_set_socket(
529 struct pcmcia_socket *sock, socket_state_t *state)
1da177e4
LT
530{
531 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
532
17b38ebb
MRJ
533 debug(skt, 2, "mask: %s%s%s%s%s%s flags: %s%s%s%s%s%s Vcc %d Vpp %d irq %d\n",
534 (state->csc_mask == 0) ? "<NONE> " : "",
535 (state->csc_mask & SS_DETECT) ? "DETECT " : "",
536 (state->csc_mask & SS_READY) ? "READY " : "",
537 (state->csc_mask & SS_BATDEAD) ? "BATDEAD " : "",
538 (state->csc_mask & SS_BATWARN) ? "BATWARN " : "",
539 (state->csc_mask & SS_STSCHG) ? "STSCHG " : "",
540 (state->flags == 0) ? "<NONE> " : "",
541 (state->flags & SS_PWR_AUTO) ? "PWR_AUTO " : "",
542 (state->flags & SS_IOCARD) ? "IOCARD " : "",
543 (state->flags & SS_RESET) ? "RESET " : "",
544 (state->flags & SS_SPKR_ENA) ? "SPKR_ENA " : "",
545 (state->flags & SS_OUTPUT_ENA) ? "OUTPUT_ENA " : "",
1da177e4
LT
546 state->Vcc, state->Vpp, state->io_irq);
547
548 return soc_common_pcmcia_config_skt(skt, state);
549}
550
551
552/*
553 * Implements the set_io_map() operation for the in-kernel PCMCIA
554 * service (formerly SS_SetIOMap in Card Services). We configure
555 * the map speed as requested, but override the address ranges
556 * supplied by Card Services.
557 *
558 * Returns: 0 on success, -1 on error
559 */
17b38ebb
MRJ
560static int soc_common_pcmcia_set_io_map(
561 struct pcmcia_socket *sock, struct pccard_io_map *map)
1da177e4
LT
562{
563 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
564 unsigned short speed = map->speed;
565
5f784336
WS
566 debug(skt, 2, "map %u speed %u start 0x%08llx stop 0x%08llx\n",
567 map->map, map->speed, (unsigned long long)map->start,
568 (unsigned long long)map->stop);
1da177e4 569 debug(skt, 2, "flags: %s%s%s%s%s%s%s%s\n",
17b38ebb
MRJ
570 (map->flags == 0) ? "<NONE>" : "",
571 (map->flags & MAP_ACTIVE) ? "ACTIVE " : "",
572 (map->flags & MAP_16BIT) ? "16BIT " : "",
573 (map->flags & MAP_AUTOSZ) ? "AUTOSZ " : "",
574 (map->flags & MAP_0WS) ? "0WS " : "",
575 (map->flags & MAP_WRPROT) ? "WRPROT " : "",
576 (map->flags & MAP_USE_WAIT) ? "USE_WAIT " : "",
577 (map->flags & MAP_PREFETCH) ? "PREFETCH " : "");
1da177e4
LT
578
579 if (map->map >= MAX_IO_WIN) {
2e11cb4c 580 printk(KERN_ERR "%s(): map (%d) out of range\n", __func__,
1da177e4
LT
581 map->map);
582 return -1;
583 }
584
585 if (map->flags & MAP_ACTIVE) {
586 if (speed == 0)
587 speed = SOC_PCMCIA_IO_ACCESS;
588 } else {
589 speed = 0;
590 }
591
592 skt->spd_io[map->map] = speed;
593 skt->ops->set_timing(skt);
594
595 if (map->stop == 1)
596 map->stop = PAGE_SIZE-1;
597
598 map->stop -= map->start;
599 map->stop += skt->socket.io_offset;
600 map->start = skt->socket.io_offset;
601
602 return 0;
603}
604
605
606/*
607 * Implements the set_mem_map() operation for the in-kernel PCMCIA
608 * service (formerly SS_SetMemMap in Card Services). We configure
609 * the map speed as requested, but override the address ranges
610 * supplied by Card Services.
611 *
4846d017 612 * Returns: 0 on success, -ERRNO on error
1da177e4 613 */
17b38ebb
MRJ
614static int soc_common_pcmcia_set_mem_map(
615 struct pcmcia_socket *sock, struct pccard_mem_map *map)
1da177e4
LT
616{
617 struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
618 struct resource *res;
619 unsigned short speed = map->speed;
620
621 debug(skt, 2, "map %u speed %u card_start %08x\n",
622 map->map, map->speed, map->card_start);
623 debug(skt, 2, "flags: %s%s%s%s%s%s%s%s\n",
17b38ebb
MRJ
624 (map->flags == 0) ? "<NONE>" : "",
625 (map->flags & MAP_ACTIVE) ? "ACTIVE " : "",
626 (map->flags & MAP_16BIT) ? "16BIT " : "",
627 (map->flags & MAP_AUTOSZ) ? "AUTOSZ " : "",
628 (map->flags & MAP_0WS) ? "0WS " : "",
629 (map->flags & MAP_WRPROT) ? "WRPROT " : "",
630 (map->flags & MAP_ATTRIB) ? "ATTRIB " : "",
631 (map->flags & MAP_USE_WAIT) ? "USE_WAIT " : "");
1da177e4
LT
632
633 if (map->map >= MAX_WIN)
634 return -EINVAL;
635
636 if (map->flags & MAP_ACTIVE) {
637 if (speed == 0)
638 speed = 300;
639 } else {
640 speed = 0;
641 }
642
643 if (map->flags & MAP_ATTRIB) {
644 res = &skt->res_attr;
645 skt->spd_attr[map->map] = speed;
646 skt->spd_mem[map->map] = 0;
647 } else {
648 res = &skt->res_mem;
649 skt->spd_attr[map->map] = 0;
650 skt->spd_mem[map->map] = speed;
651 }
652
653 skt->ops->set_timing(skt);
654
655 map->static_start = res->start + map->card_start;
656
657 return 0;
658}
659
660struct bittbl {
661 unsigned int mask;
662 const char *name;
663};
664
665static struct bittbl status_bits[] = {
666 { SS_WRPROT, "SS_WRPROT" },
667 { SS_BATDEAD, "SS_BATDEAD" },
668 { SS_BATWARN, "SS_BATWARN" },
669 { SS_READY, "SS_READY" },
670 { SS_DETECT, "SS_DETECT" },
671 { SS_POWERON, "SS_POWERON" },
672 { SS_STSCHG, "SS_STSCHG" },
673 { SS_3VCARD, "SS_3VCARD" },
674 { SS_XVCARD, "SS_XVCARD" },
675};
676
677static struct bittbl conf_bits[] = {
678 { SS_PWR_AUTO, "SS_PWR_AUTO" },
679 { SS_IOCARD, "SS_IOCARD" },
680 { SS_RESET, "SS_RESET" },
681 { SS_DMA_MODE, "SS_DMA_MODE" },
682 { SS_SPKR_ENA, "SS_SPKR_ENA" },
683 { SS_OUTPUT_ENA, "SS_OUTPUT_ENA" },
684};
685
17b38ebb
MRJ
686static void dump_bits(char **p, const char *prefix,
687 unsigned int val, struct bittbl *bits, int sz)
1da177e4
LT
688{
689 char *b = *p;
690 int i;
691
692 b += sprintf(b, "%-9s:", prefix);
693 for (i = 0; i < sz; i++)
694 if (val & bits[i].mask)
695 b += sprintf(b, " %s", bits[i].name);
696 *b++ = '\n';
697 *p = b;
698}
699
700/*
701 * Implements the /sys/class/pcmcia_socket/??/status file.
702 *
703 * Returns: the number of characters added to the buffer
704 */
17b38ebb
MRJ
705static ssize_t show_status(
706 struct device *dev, struct device_attribute *attr, char *buf)
1da177e4
LT
707{
708 struct soc_pcmcia_socket *skt =
87373318 709 container_of(dev, struct soc_pcmcia_socket, socket.dev);
1da177e4
LT
710 char *p = buf;
711
17b38ebb 712 p += sprintf(p, "slot : %d\n", skt->nr);
1da177e4
LT
713
714 dump_bits(&p, "status", skt->status,
715 status_bits, ARRAY_SIZE(status_bits));
716 dump_bits(&p, "csc_mask", skt->cs_state.csc_mask,
717 status_bits, ARRAY_SIZE(status_bits));
718 dump_bits(&p, "cs_flags", skt->cs_state.flags,
719 conf_bits, ARRAY_SIZE(conf_bits));
720
17b38ebb
MRJ
721 p += sprintf(p, "Vcc : %d\n", skt->cs_state.Vcc);
722 p += sprintf(p, "Vpp : %d\n", skt->cs_state.Vpp);
723 p += sprintf(p, "IRQ : %d (%d)\n", skt->cs_state.io_irq,
66024db5 724 skt->socket.pci_irq);
1da177e4 725 if (skt->ops->show_timing)
17b38ebb 726 p += skt->ops->show_timing(skt, p);
1da177e4
LT
727
728 return p-buf;
729}
e4a3c3f0 730static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
1da177e4
LT
731
732
733static struct pccard_operations soc_common_pcmcia_operations = {
734 .init = soc_common_pcmcia_sock_init,
735 .suspend = soc_common_pcmcia_suspend,
736 .get_status = soc_common_pcmcia_get_status,
1da177e4
LT
737 .set_socket = soc_common_pcmcia_set_socket,
738 .set_io_map = soc_common_pcmcia_set_io_map,
739 .set_mem_map = soc_common_pcmcia_set_mem_map,
740};
741
742
1da177e4 743#ifdef CONFIG_CPU_FREQ
fb8c9959
RK
744static int soc_common_pcmcia_cpufreq_nb(struct notifier_block *nb,
745 unsigned long val, void *data)
1da177e4 746{
fb8c9959 747 struct soc_pcmcia_socket *skt = container_of(nb, struct soc_pcmcia_socket, cpufreq_nb);
1da177e4 748 struct cpufreq_freqs *freqs = data;
1da177e4 749
fb8c9959 750 return skt->ops->frequency_change(skt, val, freqs);
1da177e4 751}
1da177e4
LT
752#endif
753
e0d21178 754void soc_pcmcia_init_one(struct soc_pcmcia_socket *skt,
c8f9ce55 755 const struct pcmcia_low_level *ops, struct device *dev)
e0d21178 756{
d9dc8787
RK
757 int i;
758
e0d21178
RK
759 skt->ops = ops;
760 skt->socket.owner = ops->owner;
761 skt->socket.dev.parent = dev;
762 skt->socket.pci_irq = NO_IRQ;
d9dc8787
RK
763
764 for (i = 0; i < ARRAY_SIZE(skt->stat); i++)
765 skt->stat[i].gpio = -EINVAL;
e0d21178
RK
766}
767EXPORT_SYMBOL(soc_pcmcia_init_one);
768
097e296d 769void soc_pcmcia_remove_one(struct soc_pcmcia_socket *skt)
1da177e4 770{
097e296d 771 del_timer_sync(&skt->poll_timer);
1da177e4 772
097e296d 773 pcmcia_unregister_socket(&skt->socket);
1da177e4 774
fb8c9959
RK
775#ifdef CONFIG_CPU_FREQ
776 if (skt->ops->frequency_change)
777 cpufreq_unregister_notifier(&skt->cpufreq_nb,
778 CPUFREQ_TRANSITION_NOTIFIER);
779#endif
780
d9dc8787 781 soc_pcmcia_hw_shutdown(skt);
1da177e4 782
d9dc8787 783 /* should not be required; violates some lowlevel drivers */
097e296d 784 soc_common_pcmcia_config_skt(skt, &dead_socket);
1da177e4 785
645b3026 786 iounmap(PCI_IOBASE + skt->res_io_io.start);
097e296d
RKAL
787 release_resource(&skt->res_attr);
788 release_resource(&skt->res_mem);
789 release_resource(&skt->res_io);
790 release_resource(&skt->res_skt);
791}
792EXPORT_SYMBOL(soc_pcmcia_remove_one);
1da177e4 793
097e296d
RKAL
794int soc_pcmcia_add_one(struct soc_pcmcia_socket *skt)
795{
796 int ret;
1da177e4 797
6ac95d82
RK
798 skt->cs_state = dead_socket;
799
41760d0e 800 timer_setup(&skt->poll_timer, soc_common_pcmcia_poll_event, 0);
097e296d 801 skt->poll_timer.expires = jiffies + SOC_PCMCIA_POLL_PERIOD;
1da177e4 802
097e296d
RKAL
803 ret = request_resource(&iomem_resource, &skt->res_skt);
804 if (ret)
805 goto out_err_1;
1da177e4 806
097e296d
RKAL
807 ret = request_resource(&skt->res_skt, &skt->res_io);
808 if (ret)
809 goto out_err_2;
1da177e4 810
097e296d
RKAL
811 ret = request_resource(&skt->res_skt, &skt->res_mem);
812 if (ret)
813 goto out_err_3;
1da177e4 814
097e296d
RKAL
815 ret = request_resource(&skt->res_skt, &skt->res_attr);
816 if (ret)
817 goto out_err_4;
1da177e4 818
645b3026
AB
819 skt->res_io_io = (struct resource)
820 DEFINE_RES_IO_NAMED(skt->nr * 0x1000 + 0x10000, 0x1000,
821 "PCMCIA I/O");
822 ret = pci_remap_iospace(&skt->res_io_io, skt->res_io.start);
823 if (ret)
097e296d 824 goto out_err_5;
1da177e4 825
097e296d
RKAL
826 /*
827 * We initialize default socket timing here, because
828 * we are not guaranteed to see a SetIOMap operation at
829 * runtime.
830 */
831 skt->ops->set_timing(skt);
1da177e4 832
d9dc8787 833 ret = soc_pcmcia_hw_init(skt);
097e296d
RKAL
834 if (ret)
835 goto out_err_6;
1da177e4 836
097e296d
RKAL
837 skt->socket.ops = &soc_common_pcmcia_operations;
838 skt->socket.features = SS_CAP_STATIC_MAP|SS_CAP_PCCARD;
839 skt->socket.resource_ops = &pccard_static_ops;
840 skt->socket.irq_mask = 0;
841 skt->socket.map_size = PAGE_SIZE;
645b3026 842 skt->socket.io_offset = (unsigned long)skt->res_io_io.start;
1da177e4 843
097e296d 844 skt->status = soc_common_pcmcia_skt_state(skt);
1da177e4 845
fb8c9959
RK
846#ifdef CONFIG_CPU_FREQ
847 if (skt->ops->frequency_change) {
848 skt->cpufreq_nb.notifier_call = soc_common_pcmcia_cpufreq_nb;
849
850 ret = cpufreq_register_notifier(&skt->cpufreq_nb,
851 CPUFREQ_TRANSITION_NOTIFIER);
852 if (ret < 0)
853 dev_err(skt->socket.dev.parent,
854 "unable to register CPU frequency change notifier for PCMCIA (%d)\n",
855 ret);
856 }
857#endif
858
097e296d
RKAL
859 ret = pcmcia_register_socket(&skt->socket);
860 if (ret)
861 goto out_err_7;
862
097e296d
RKAL
863 ret = device_create_file(&skt->socket.dev, &dev_attr_status);
864 if (ret)
865 goto out_err_8;
866
867 return ret;
1da177e4 868
632480ea 869 out_err_8:
097e296d
RKAL
870 del_timer_sync(&skt->poll_timer);
871 pcmcia_unregister_socket(&skt->socket);
1da177e4
LT
872
873 out_err_7:
d9dc8787 874 soc_pcmcia_hw_shutdown(skt);
1da177e4 875 out_err_6:
645b3026 876 iounmap(PCI_IOBASE + skt->res_io_io.start);
1da177e4 877 out_err_5:
097e296d 878 release_resource(&skt->res_attr);
1da177e4 879 out_err_4:
097e296d 880 release_resource(&skt->res_mem);
1da177e4 881 out_err_3:
097e296d 882 release_resource(&skt->res_io);
1da177e4 883 out_err_2:
097e296d 884 release_resource(&skt->res_skt);
1da177e4 885 out_err_1:
1da177e4 886
1da177e4
LT
887 return ret;
888}
097e296d 889EXPORT_SYMBOL(soc_pcmcia_add_one);
1da177e4 890
0f767de6
RKAL
891MODULE_AUTHOR("John Dorsey <john+@cs.cmu.edu>");
892MODULE_DESCRIPTION("Linux PCMCIA Card Services: Common SoC support");
893MODULE_LICENSE("Dual MPL/GPL");