xref: /openbmc/linux/drivers/pcmcia/soc_common.c (revision a466ebd2)
11da177e4SLinus Torvalds /*======================================================================
21da177e4SLinus Torvalds 
31da177e4SLinus Torvalds     Common support code for the PCMCIA control functionality of
41da177e4SLinus Torvalds     integrated SOCs like the SA-11x0 and PXA2xx microprocessors.
51da177e4SLinus Torvalds 
61da177e4SLinus Torvalds     The contents of this file are subject to the Mozilla Public
71da177e4SLinus Torvalds     License Version 1.1 (the "License"); you may not use this file
81da177e4SLinus Torvalds     except in compliance with the License. You may obtain a copy of
91da177e4SLinus Torvalds     the License at http://www.mozilla.org/MPL/
101da177e4SLinus Torvalds 
111da177e4SLinus Torvalds     Software distributed under the License is distributed on an "AS
121da177e4SLinus Torvalds     IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
131da177e4SLinus Torvalds     implied. See the License for the specific language governing
141da177e4SLinus Torvalds     rights and limitations under the License.
151da177e4SLinus Torvalds 
161da177e4SLinus Torvalds     The initial developer of the original code is John G. Dorsey
171da177e4SLinus Torvalds     <john+@cs.cmu.edu>.  Portions created by John G. Dorsey are
181da177e4SLinus Torvalds     Copyright (C) 1999 John G. Dorsey.  All Rights Reserved.
191da177e4SLinus Torvalds 
201da177e4SLinus Torvalds     Alternatively, the contents of this file may be used under the
211da177e4SLinus Torvalds     terms of the GNU Public License version 2 (the "GPL"), in which
221da177e4SLinus Torvalds     case the provisions of the GPL are applicable instead of the
231da177e4SLinus Torvalds     above.  If you wish to allow the use of your version of this file
241da177e4SLinus Torvalds     only under the terms of the GPL and not to allow others to use
251da177e4SLinus Torvalds     your version of this file under the MPL, indicate your decision
261da177e4SLinus Torvalds     by deleting the provisions above and replace them with the notice
271da177e4SLinus Torvalds     and other provisions required by the GPL.  If you do not delete
281da177e4SLinus Torvalds     the provisions above, a recipient may use your version of this
291da177e4SLinus Torvalds     file under either the MPL or the GPL.
301da177e4SLinus Torvalds 
311da177e4SLinus Torvalds ======================================================================*/
321da177e4SLinus Torvalds 
331da177e4SLinus Torvalds 
3417b38ebbSMarcelo Roberto Jimenez #include <linux/cpufreq.h>
35d9dc8787SRussell King #include <linux/gpio.h>
3617b38ebbSMarcelo Roberto Jimenez #include <linux/init.h>
3717b38ebbSMarcelo Roberto Jimenez #include <linux/interrupt.h>
3817b38ebbSMarcelo Roberto Jimenez #include <linux/io.h>
3917b38ebbSMarcelo Roberto Jimenez #include <linux/irq.h>
4017b38ebbSMarcelo Roberto Jimenez #include <linux/kernel.h>
4117b38ebbSMarcelo Roberto Jimenez #include <linux/mm.h>
421da177e4SLinus Torvalds #include <linux/module.h>
431da177e4SLinus Torvalds #include <linux/moduleparam.h>
4423d077e2SAndrew Morton #include <linux/mutex.h>
451da177e4SLinus Torvalds #include <linux/spinlock.h>
4617b38ebbSMarcelo Roberto Jimenez #include <linux/timer.h>
471da177e4SLinus Torvalds 
48a09e64fbSRussell King #include <mach/hardware.h>
491da177e4SLinus Torvalds 
501da177e4SLinus Torvalds #include "soc_common.h"
511da177e4SLinus Torvalds 
52d9dc8787SRussell King static irqreturn_t soc_common_pcmcia_interrupt(int irq, void *dev);
53d9dc8787SRussell King 
547d16b658SDominik Brodowski #ifdef CONFIG_PCMCIA_DEBUG
551da177e4SLinus Torvalds 
561da177e4SLinus Torvalds static int pc_debug;
571da177e4SLinus Torvalds module_param(pc_debug, int, 0644);
581da177e4SLinus Torvalds 
591da177e4SLinus Torvalds void soc_pcmcia_debug(struct soc_pcmcia_socket *skt, const char *func,
601da177e4SLinus Torvalds 		      int lvl, const char *fmt, ...)
611da177e4SLinus Torvalds {
62106665d9SJoe Perches 	struct va_format vaf;
631da177e4SLinus Torvalds 	va_list args;
641da177e4SLinus Torvalds 	if (pc_debug > lvl) {
651da177e4SLinus Torvalds 		va_start(args, fmt);
66106665d9SJoe Perches 
67106665d9SJoe Perches 		vaf.fmt = fmt;
68106665d9SJoe Perches 		vaf.va = &args;
69106665d9SJoe Perches 
70106665d9SJoe Perches 		printk(KERN_DEBUG "skt%u: %s: %pV", skt->nr, func, &vaf);
71106665d9SJoe Perches 
721da177e4SLinus Torvalds 		va_end(args);
731da177e4SLinus Torvalds 	}
741da177e4SLinus Torvalds }
75b9f515e3SMarcelo Roberto Jimenez EXPORT_SYMBOL(soc_pcmcia_debug);
761da177e4SLinus Torvalds 
771da177e4SLinus Torvalds #endif
781da177e4SLinus Torvalds 
7917b38ebbSMarcelo Roberto Jimenez #define to_soc_pcmcia_socket(x)	\
8017b38ebbSMarcelo Roberto Jimenez 	container_of(x, struct soc_pcmcia_socket, socket)
811da177e4SLinus Torvalds 
821da177e4SLinus Torvalds static unsigned short
831da177e4SLinus Torvalds calc_speed(unsigned short *spds, int num, unsigned short dflt)
841da177e4SLinus Torvalds {
851da177e4SLinus Torvalds 	unsigned short speed = 0;
861da177e4SLinus Torvalds 	int i;
871da177e4SLinus Torvalds 
881da177e4SLinus Torvalds 	for (i = 0; i < num; i++)
891da177e4SLinus Torvalds 		if (speed < spds[i])
901da177e4SLinus Torvalds 			speed = spds[i];
911da177e4SLinus Torvalds 	if (speed == 0)
921da177e4SLinus Torvalds 		speed = dflt;
931da177e4SLinus Torvalds 
941da177e4SLinus Torvalds 	return speed;
951da177e4SLinus Torvalds }
961da177e4SLinus Torvalds 
9717b38ebbSMarcelo Roberto Jimenez void soc_common_pcmcia_get_timing(struct soc_pcmcia_socket *skt,
9817b38ebbSMarcelo Roberto Jimenez 	struct soc_pcmcia_timing *timing)
991da177e4SLinus Torvalds {
10017b38ebbSMarcelo Roberto Jimenez 	timing->io =
10117b38ebbSMarcelo Roberto Jimenez 		calc_speed(skt->spd_io, MAX_IO_WIN, SOC_PCMCIA_IO_ACCESS);
10217b38ebbSMarcelo Roberto Jimenez 	timing->mem =
10317b38ebbSMarcelo Roberto Jimenez 		calc_speed(skt->spd_mem, MAX_WIN, SOC_PCMCIA_3V_MEM_ACCESS);
10417b38ebbSMarcelo Roberto Jimenez 	timing->attr =
10517b38ebbSMarcelo Roberto Jimenez 		calc_speed(skt->spd_attr, MAX_WIN, SOC_PCMCIA_3V_MEM_ACCESS);
1061da177e4SLinus Torvalds }
1071da177e4SLinus Torvalds EXPORT_SYMBOL(soc_common_pcmcia_get_timing);
1081da177e4SLinus Torvalds 
109d9dc8787SRussell King static void __soc_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt,
110d9dc8787SRussell King 	unsigned int nr)
111d9dc8787SRussell King {
112d9dc8787SRussell King 	unsigned int i;
113d9dc8787SRussell King 
114d9dc8787SRussell King 	for (i = 0; i < nr; i++) {
115d9dc8787SRussell King 		if (skt->stat[i].irq)
116d9dc8787SRussell King 			free_irq(skt->stat[i].irq, skt);
117d9dc8787SRussell King 		if (gpio_is_valid(skt->stat[i].gpio))
118d9dc8787SRussell King 			gpio_free(skt->stat[i].gpio);
119d9dc8787SRussell King 	}
120d9dc8787SRussell King 
121d9dc8787SRussell King 	if (skt->ops->hw_shutdown)
122d9dc8787SRussell King 		skt->ops->hw_shutdown(skt);
1230821c3bcSDmitry Eremin-Solenikov 
1240821c3bcSDmitry Eremin-Solenikov 	clk_disable_unprepare(skt->clk);
125d9dc8787SRussell King }
126d9dc8787SRussell King 
127d9dc8787SRussell King static void soc_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
128d9dc8787SRussell King {
129d9dc8787SRussell King 	__soc_pcmcia_hw_shutdown(skt, ARRAY_SIZE(skt->stat));
130d9dc8787SRussell King }
131d9dc8787SRussell King 
132d9dc8787SRussell King static int soc_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
133d9dc8787SRussell King {
134d9dc8787SRussell King 	int ret = 0, i;
135d9dc8787SRussell King 
1360821c3bcSDmitry Eremin-Solenikov 	clk_prepare_enable(skt->clk);
1370821c3bcSDmitry Eremin-Solenikov 
138d9dc8787SRussell King 	if (skt->ops->hw_init) {
139d9dc8787SRussell King 		ret = skt->ops->hw_init(skt);
140d9dc8787SRussell King 		if (ret)
141d9dc8787SRussell King 			return ret;
142d9dc8787SRussell King 	}
143d9dc8787SRussell King 
144d9dc8787SRussell King 	for (i = 0; i < ARRAY_SIZE(skt->stat); i++) {
145d9dc8787SRussell King 		if (gpio_is_valid(skt->stat[i].gpio)) {
146d9dc8787SRussell King 			int irq;
147d9dc8787SRussell King 
148d9dc8787SRussell King 			ret = gpio_request_one(skt->stat[i].gpio, GPIOF_IN,
149d9dc8787SRussell King 					       skt->stat[i].name);
150d9dc8787SRussell King 			if (ret) {
151d9dc8787SRussell King 				__soc_pcmcia_hw_shutdown(skt, i);
152d9dc8787SRussell King 				return ret;
153d9dc8787SRussell King 			}
154d9dc8787SRussell King 
155d9dc8787SRussell King 			irq = gpio_to_irq(skt->stat[i].gpio);
156d9dc8787SRussell King 
157d9dc8787SRussell King 			if (i == SOC_STAT_RDY)
158d9dc8787SRussell King 				skt->socket.pci_irq = irq;
159d9dc8787SRussell King 			else
160d9dc8787SRussell King 				skt->stat[i].irq = irq;
161d9dc8787SRussell King 		}
162d9dc8787SRussell King 
163d9dc8787SRussell King 		if (skt->stat[i].irq) {
164d9dc8787SRussell King 			ret = request_irq(skt->stat[i].irq,
165d9dc8787SRussell King 					  soc_common_pcmcia_interrupt,
166d9dc8787SRussell King 					  IRQF_TRIGGER_NONE,
167d9dc8787SRussell King 					  skt->stat[i].name, skt);
168d9dc8787SRussell King 			if (ret) {
169d9dc8787SRussell King 				if (gpio_is_valid(skt->stat[i].gpio))
170d9dc8787SRussell King 					gpio_free(skt->stat[i].gpio);
171d9dc8787SRussell King 				__soc_pcmcia_hw_shutdown(skt, i);
172d9dc8787SRussell King 				return ret;
173d9dc8787SRussell King 			}
174d9dc8787SRussell King 		}
175d9dc8787SRussell King 	}
176d9dc8787SRussell King 
177d9dc8787SRussell King 	return ret;
178d9dc8787SRussell King }
179d9dc8787SRussell King 
180d9dc8787SRussell King static void soc_pcmcia_hw_enable(struct soc_pcmcia_socket *skt)
181d9dc8787SRussell King {
182d9dc8787SRussell King 	int i;
183d9dc8787SRussell King 
184d9dc8787SRussell King 	for (i = 0; i < ARRAY_SIZE(skt->stat); i++)
185d9dc8787SRussell King 		if (skt->stat[i].irq) {
186d9dc8787SRussell King 			irq_set_irq_type(skt->stat[i].irq, IRQ_TYPE_EDGE_RISING);
187d9dc8787SRussell King 			irq_set_irq_type(skt->stat[i].irq, IRQ_TYPE_EDGE_BOTH);
188d9dc8787SRussell King 		}
189d9dc8787SRussell King }
190d9dc8787SRussell King 
191d9dc8787SRussell King static void soc_pcmcia_hw_disable(struct soc_pcmcia_socket *skt)
192d9dc8787SRussell King {
193d9dc8787SRussell King 	int i;
194d9dc8787SRussell King 
195d9dc8787SRussell King 	for (i = 0; i < ARRAY_SIZE(skt->stat); i++)
196d9dc8787SRussell King 		if (skt->stat[i].irq)
197d9dc8787SRussell King 			irq_set_irq_type(skt->stat[i].irq, IRQ_TYPE_NONE);
198d9dc8787SRussell King }
199d9dc8787SRussell King 
2001da177e4SLinus Torvalds static unsigned int soc_common_pcmcia_skt_state(struct soc_pcmcia_socket *skt)
2011da177e4SLinus Torvalds {
2021da177e4SLinus Torvalds 	struct pcmcia_state state;
2031da177e4SLinus Torvalds 	unsigned int stat;
2041da177e4SLinus Torvalds 
2051da177e4SLinus Torvalds 	memset(&state, 0, sizeof(struct pcmcia_state));
2061da177e4SLinus Torvalds 
207d9dc8787SRussell King 	/* Make battery voltage state report 'good' */
208d9dc8787SRussell King 	state.bvd1 = 1;
209d9dc8787SRussell King 	state.bvd2 = 1;
210d9dc8787SRussell King 
211d9dc8787SRussell King 	/* CD is active low by default */
212d9dc8787SRussell King 	if (gpio_is_valid(skt->stat[SOC_STAT_CD].gpio))
213d9dc8787SRussell King 		state.detect = !gpio_get_value(skt->stat[SOC_STAT_CD].gpio);
214d9dc8787SRussell King 
215d9dc8787SRussell King 	/* RDY and BVD are active high by default */
216d9dc8787SRussell King 	if (gpio_is_valid(skt->stat[SOC_STAT_RDY].gpio))
217d9dc8787SRussell King 		state.ready = !!gpio_get_value(skt->stat[SOC_STAT_RDY].gpio);
218d9dc8787SRussell King 	if (gpio_is_valid(skt->stat[SOC_STAT_BVD1].gpio))
219d9dc8787SRussell King 		state.bvd1 = !!gpio_get_value(skt->stat[SOC_STAT_BVD1].gpio);
220d9dc8787SRussell King 	if (gpio_is_valid(skt->stat[SOC_STAT_BVD2].gpio))
221d9dc8787SRussell King 		state.bvd2 = !!gpio_get_value(skt->stat[SOC_STAT_BVD2].gpio);
222d9dc8787SRussell King 
2231da177e4SLinus Torvalds 	skt->ops->socket_state(skt, &state);
2241da177e4SLinus Torvalds 
2251da177e4SLinus Torvalds 	stat = state.detect  ? SS_DETECT : 0;
2261da177e4SLinus Torvalds 	stat |= state.ready  ? SS_READY  : 0;
2271da177e4SLinus Torvalds 	stat |= state.wrprot ? SS_WRPROT : 0;
2281da177e4SLinus Torvalds 	stat |= state.vs_3v  ? SS_3VCARD : 0;
2291da177e4SLinus Torvalds 	stat |= state.vs_Xv  ? SS_XVCARD : 0;
2301da177e4SLinus Torvalds 
2311da177e4SLinus Torvalds 	/* The power status of individual sockets is not available
2321da177e4SLinus Torvalds 	 * explicitly from the hardware, so we just remember the state
2331da177e4SLinus Torvalds 	 * and regurgitate it upon request:
2341da177e4SLinus Torvalds 	 */
2351da177e4SLinus Torvalds 	stat |= skt->cs_state.Vcc ? SS_POWERON : 0;
2361da177e4SLinus Torvalds 
2371da177e4SLinus Torvalds 	if (skt->cs_state.flags & SS_IOCARD)
238a466ebd2SRussell King 		stat |= state.bvd1 ? 0 : SS_STSCHG;
2391da177e4SLinus Torvalds 	else {
2401da177e4SLinus Torvalds 		if (state.bvd1 == 0)
2411da177e4SLinus Torvalds 			stat |= SS_BATDEAD;
2421da177e4SLinus Torvalds 		else if (state.bvd2 == 0)
2431da177e4SLinus Torvalds 			stat |= SS_BATWARN;
2441da177e4SLinus Torvalds 	}
2451da177e4SLinus Torvalds 	return stat;
2461da177e4SLinus Torvalds }
2471da177e4SLinus Torvalds 
2481da177e4SLinus Torvalds /*
2491da177e4SLinus Torvalds  * soc_common_pcmcia_config_skt
2501da177e4SLinus Torvalds  * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^
2511da177e4SLinus Torvalds  *
2521da177e4SLinus Torvalds  * Convert PCMCIA socket state to our socket configure structure.
2531da177e4SLinus Torvalds  */
25417b38ebbSMarcelo Roberto Jimenez static int soc_common_pcmcia_config_skt(
25517b38ebbSMarcelo Roberto Jimenez 	struct soc_pcmcia_socket *skt, socket_state_t *state)
2561da177e4SLinus Torvalds {
2571da177e4SLinus Torvalds 	int ret;
2581da177e4SLinus Torvalds 
2591da177e4SLinus Torvalds 	ret = skt->ops->configure_socket(skt, state);
2601da177e4SLinus Torvalds 	if (ret == 0) {
2611da177e4SLinus Torvalds 		/*
2621da177e4SLinus Torvalds 		 * This really needs a better solution.  The IRQ
2631da177e4SLinus Torvalds 		 * may or may not be claimed by the driver.
2641da177e4SLinus Torvalds 		 */
2651da177e4SLinus Torvalds 		if (skt->irq_state != 1 && state->io_irq) {
2661da177e4SLinus Torvalds 			skt->irq_state = 1;
267dced35aeSThomas Gleixner 			irq_set_irq_type(skt->socket.pci_irq,
26817b38ebbSMarcelo Roberto Jimenez 					 IRQ_TYPE_EDGE_FALLING);
2691da177e4SLinus Torvalds 		} else if (skt->irq_state == 1 && state->io_irq == 0) {
2701da177e4SLinus Torvalds 			skt->irq_state = 0;
271dced35aeSThomas Gleixner 			irq_set_irq_type(skt->socket.pci_irq, IRQ_TYPE_NONE);
2721da177e4SLinus Torvalds 		}
2731da177e4SLinus Torvalds 
2741da177e4SLinus Torvalds 		skt->cs_state = *state;
2751da177e4SLinus Torvalds 	}
2761da177e4SLinus Torvalds 
2771da177e4SLinus Torvalds 	if (ret < 0)
2781da177e4SLinus Torvalds 		printk(KERN_ERR "soc_common_pcmcia: unable to configure "
2791da177e4SLinus Torvalds 		       "socket %d\n", skt->nr);
2801da177e4SLinus Torvalds 
2811da177e4SLinus Torvalds 	return ret;
2821da177e4SLinus Torvalds }
2831da177e4SLinus Torvalds 
2841da177e4SLinus Torvalds /* soc_common_pcmcia_sock_init()
2851da177e4SLinus Torvalds  * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
2861da177e4SLinus Torvalds  *
2871da177e4SLinus Torvalds  * (Re-)Initialise the socket, turning on status interrupts
2881da177e4SLinus Torvalds  * and PCMCIA bus.  This must wait for power to stabilise
2891da177e4SLinus Torvalds  * so that the card status signals report correctly.
2901da177e4SLinus Torvalds  *
2911da177e4SLinus Torvalds  * Returns: 0
2921da177e4SLinus Torvalds  */
2931da177e4SLinus Torvalds static int soc_common_pcmcia_sock_init(struct pcmcia_socket *sock)
2941da177e4SLinus Torvalds {
2951da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
2961da177e4SLinus Torvalds 
2971da177e4SLinus Torvalds 	debug(skt, 2, "initializing socket\n");
298a747ce83SJonathan Cameron 	if (skt->ops->socket_init)
2991da177e4SLinus Torvalds 		skt->ops->socket_init(skt);
300d9dc8787SRussell King 	soc_pcmcia_hw_enable(skt);
3011da177e4SLinus Torvalds 	return 0;
3021da177e4SLinus Torvalds }
3031da177e4SLinus Torvalds 
3041da177e4SLinus Torvalds 
3051da177e4SLinus Torvalds /*
3061da177e4SLinus Torvalds  * soc_common_pcmcia_suspend()
3071da177e4SLinus Torvalds  * ^^^^^^^^^^^^^^^^^^^^^^^^^^^
3081da177e4SLinus Torvalds  *
3091da177e4SLinus Torvalds  * Remove power on the socket, disable IRQs from the card.
3101da177e4SLinus Torvalds  * Turn off status interrupts, and disable the PCMCIA bus.
3111da177e4SLinus Torvalds  *
3121da177e4SLinus Torvalds  * Returns: 0
3131da177e4SLinus Torvalds  */
3141da177e4SLinus Torvalds static int soc_common_pcmcia_suspend(struct pcmcia_socket *sock)
3151da177e4SLinus Torvalds {
3161da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
3171da177e4SLinus Torvalds 
3181da177e4SLinus Torvalds 	debug(skt, 2, "suspending socket\n");
3191da177e4SLinus Torvalds 
320d9dc8787SRussell King 	soc_pcmcia_hw_disable(skt);
321a747ce83SJonathan Cameron 	if (skt->ops->socket_suspend)
3221da177e4SLinus Torvalds 		skt->ops->socket_suspend(skt);
3231da177e4SLinus Torvalds 
3241da177e4SLinus Torvalds 	return 0;
3251da177e4SLinus Torvalds }
3261da177e4SLinus Torvalds 
3271da177e4SLinus Torvalds static DEFINE_SPINLOCK(status_lock);
3281da177e4SLinus Torvalds 
3291da177e4SLinus Torvalds static void soc_common_check_status(struct soc_pcmcia_socket *skt)
3301da177e4SLinus Torvalds {
3311da177e4SLinus Torvalds 	unsigned int events;
3321da177e4SLinus Torvalds 
3331da177e4SLinus Torvalds 	debug(skt, 4, "entering PCMCIA monitoring thread\n");
3341da177e4SLinus Torvalds 
3351da177e4SLinus Torvalds 	do {
3361da177e4SLinus Torvalds 		unsigned int status;
3371da177e4SLinus Torvalds 		unsigned long flags;
3381da177e4SLinus Torvalds 
3391da177e4SLinus Torvalds 		status = soc_common_pcmcia_skt_state(skt);
3401da177e4SLinus Torvalds 
3411da177e4SLinus Torvalds 		spin_lock_irqsave(&status_lock, flags);
3421da177e4SLinus Torvalds 		events = (status ^ skt->status) & skt->cs_state.csc_mask;
3431da177e4SLinus Torvalds 		skt->status = status;
3441da177e4SLinus Torvalds 		spin_unlock_irqrestore(&status_lock, flags);
3451da177e4SLinus Torvalds 
3461da177e4SLinus Torvalds 		debug(skt, 4, "events: %s%s%s%s%s%s\n",
3471da177e4SLinus Torvalds 			events == 0         ? "<NONE>"   : "",
3481da177e4SLinus Torvalds 			events & SS_DETECT  ? "DETECT "  : "",
3491da177e4SLinus Torvalds 			events & SS_READY   ? "READY "   : "",
3501da177e4SLinus Torvalds 			events & SS_BATDEAD ? "BATDEAD " : "",
3511da177e4SLinus Torvalds 			events & SS_BATWARN ? "BATWARN " : "",
3521da177e4SLinus Torvalds 			events & SS_STSCHG  ? "STSCHG "  : "");
3531da177e4SLinus Torvalds 
3541da177e4SLinus Torvalds 		if (events)
3551da177e4SLinus Torvalds 			pcmcia_parse_events(&skt->socket, events);
3561da177e4SLinus Torvalds 	} while (events);
3571da177e4SLinus Torvalds }
3581da177e4SLinus Torvalds 
3591da177e4SLinus Torvalds /* Let's poll for events in addition to IRQs since IRQ only is unreliable... */
3601da177e4SLinus Torvalds static void soc_common_pcmcia_poll_event(unsigned long dummy)
3611da177e4SLinus Torvalds {
3621da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = (struct soc_pcmcia_socket *)dummy;
3631da177e4SLinus Torvalds 	debug(skt, 4, "polling for events\n");
3641da177e4SLinus Torvalds 
3651da177e4SLinus Torvalds 	mod_timer(&skt->poll_timer, jiffies + SOC_PCMCIA_POLL_PERIOD);
3661da177e4SLinus Torvalds 
3671da177e4SLinus Torvalds 	soc_common_check_status(skt);
3681da177e4SLinus Torvalds }
3691da177e4SLinus Torvalds 
3701da177e4SLinus Torvalds 
3711da177e4SLinus Torvalds /*
3721da177e4SLinus Torvalds  * Service routine for socket driver interrupts (requested by the
3731da177e4SLinus Torvalds  * low-level PCMCIA init() operation via soc_common_pcmcia_thread()).
3741da177e4SLinus Torvalds  * The actual interrupt-servicing work is performed by
3751da177e4SLinus Torvalds  * soc_common_pcmcia_thread(), largely because the Card Services event-
3761da177e4SLinus Torvalds  * handling code performs scheduling operations which cannot be
3771da177e4SLinus Torvalds  * executed from within an interrupt context.
3781da177e4SLinus Torvalds  */
3797d12e780SDavid Howells static irqreturn_t soc_common_pcmcia_interrupt(int irq, void *dev)
3801da177e4SLinus Torvalds {
3811da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = dev;
3821da177e4SLinus Torvalds 
3831da177e4SLinus Torvalds 	debug(skt, 3, "servicing IRQ %d\n", irq);
3841da177e4SLinus Torvalds 
3851da177e4SLinus Torvalds 	soc_common_check_status(skt);
3861da177e4SLinus Torvalds 
3871da177e4SLinus Torvalds 	return IRQ_HANDLED;
3881da177e4SLinus Torvalds }
3891da177e4SLinus Torvalds 
3901da177e4SLinus Torvalds 
3911da177e4SLinus Torvalds /*
3921da177e4SLinus Torvalds  *  Implements the get_status() operation for the in-kernel PCMCIA
3931da177e4SLinus Torvalds  * service (formerly SS_GetStatus in Card Services). Essentially just
3941da177e4SLinus Torvalds  * fills in bits in `status' according to internal driver state or
3951da177e4SLinus Torvalds  * the value of the voltage detect chipselect register.
3961da177e4SLinus Torvalds  *
3971da177e4SLinus Torvalds  * As a debugging note, during card startup, the PCMCIA core issues
3981da177e4SLinus Torvalds  * three set_socket() commands in a row the first with RESET deasserted,
3991da177e4SLinus Torvalds  * the second with RESET asserted, and the last with RESET deasserted
4001da177e4SLinus Torvalds  * again. Following the third set_socket(), a get_status() command will
4011da177e4SLinus Torvalds  * be issued. The kernel is looking for the SS_READY flag (see
4021da177e4SLinus Torvalds  * setup_socket(), reset_socket(), and unreset_socket() in cs.c).
4031da177e4SLinus Torvalds  *
4041da177e4SLinus Torvalds  * Returns: 0
4051da177e4SLinus Torvalds  */
4061da177e4SLinus Torvalds static int
4071da177e4SLinus Torvalds soc_common_pcmcia_get_status(struct pcmcia_socket *sock, unsigned int *status)
4081da177e4SLinus Torvalds {
4091da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
4101da177e4SLinus Torvalds 
4111da177e4SLinus Torvalds 	skt->status = soc_common_pcmcia_skt_state(skt);
4121da177e4SLinus Torvalds 	*status = skt->status;
4131da177e4SLinus Torvalds 
4141da177e4SLinus Torvalds 	return 0;
4151da177e4SLinus Torvalds }
4161da177e4SLinus Torvalds 
4171da177e4SLinus Torvalds 
4181da177e4SLinus Torvalds /*
4191da177e4SLinus Torvalds  * Implements the set_socket() operation for the in-kernel PCMCIA
4201da177e4SLinus Torvalds  * service (formerly SS_SetSocket in Card Services). We more or
4211da177e4SLinus Torvalds  * less punt all of this work and let the kernel handle the details
4221da177e4SLinus Torvalds  * of power configuration, reset, &c. We also record the value of
4231da177e4SLinus Torvalds  * `state' in order to regurgitate it to the PCMCIA core later.
4241da177e4SLinus Torvalds  */
42517b38ebbSMarcelo Roberto Jimenez static int soc_common_pcmcia_set_socket(
42617b38ebbSMarcelo Roberto Jimenez 	struct pcmcia_socket *sock, socket_state_t *state)
4271da177e4SLinus Torvalds {
4281da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
4291da177e4SLinus Torvalds 
4301da177e4SLinus Torvalds 	debug(skt, 2, "mask: %s%s%s%s%s%s flags: %s%s%s%s%s%s Vcc %d Vpp %d irq %d\n",
4311da177e4SLinus Torvalds 			(state->csc_mask == 0)		? "<NONE> " :	"",
4321da177e4SLinus Torvalds 			(state->csc_mask & SS_DETECT)	? "DETECT " :	"",
4331da177e4SLinus Torvalds 			(state->csc_mask & SS_READY)	? "READY " :	"",
4341da177e4SLinus Torvalds 			(state->csc_mask & SS_BATDEAD)	? "BATDEAD " :	"",
4351da177e4SLinus Torvalds 			(state->csc_mask & SS_BATWARN)	? "BATWARN " :	"",
4361da177e4SLinus Torvalds 			(state->csc_mask & SS_STSCHG)	? "STSCHG " :	"",
4371da177e4SLinus Torvalds 			(state->flags == 0)		? "<NONE> " :	"",
4381da177e4SLinus Torvalds 			(state->flags & SS_PWR_AUTO)	? "PWR_AUTO " :	"",
4391da177e4SLinus Torvalds 			(state->flags & SS_IOCARD)	? "IOCARD " :	"",
4401da177e4SLinus Torvalds 			(state->flags & SS_RESET)	? "RESET " :	"",
4411da177e4SLinus Torvalds 			(state->flags & SS_SPKR_ENA)	? "SPKR_ENA " :	"",
4421da177e4SLinus Torvalds 			(state->flags & SS_OUTPUT_ENA)	? "OUTPUT_ENA " : "",
4431da177e4SLinus Torvalds 			state->Vcc, state->Vpp, state->io_irq);
4441da177e4SLinus Torvalds 
4451da177e4SLinus Torvalds 	return soc_common_pcmcia_config_skt(skt, state);
4461da177e4SLinus Torvalds }
4471da177e4SLinus Torvalds 
4481da177e4SLinus Torvalds 
4491da177e4SLinus Torvalds /*
4501da177e4SLinus Torvalds  * Implements the set_io_map() operation for the in-kernel PCMCIA
4511da177e4SLinus Torvalds  * service (formerly SS_SetIOMap in Card Services). We configure
4521da177e4SLinus Torvalds  * the map speed as requested, but override the address ranges
4531da177e4SLinus Torvalds  * supplied by Card Services.
4541da177e4SLinus Torvalds  *
4551da177e4SLinus Torvalds  * Returns: 0 on success, -1 on error
4561da177e4SLinus Torvalds  */
45717b38ebbSMarcelo Roberto Jimenez static int soc_common_pcmcia_set_io_map(
45817b38ebbSMarcelo Roberto Jimenez 	struct pcmcia_socket *sock, struct pccard_io_map *map)
4591da177e4SLinus Torvalds {
4601da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
4611da177e4SLinus Torvalds 	unsigned short speed = map->speed;
4621da177e4SLinus Torvalds 
4635f784336SWolfram Sang 	debug(skt, 2, "map %u  speed %u start 0x%08llx stop 0x%08llx\n",
4645f784336SWolfram Sang 		map->map, map->speed, (unsigned long long)map->start,
4655f784336SWolfram Sang 		(unsigned long long)map->stop);
4661da177e4SLinus Torvalds 	debug(skt, 2, "flags: %s%s%s%s%s%s%s%s\n",
4671da177e4SLinus Torvalds 		(map->flags == 0)		? "<NONE>"	: "",
4681da177e4SLinus Torvalds 		(map->flags & MAP_ACTIVE)	? "ACTIVE "	: "",
4691da177e4SLinus Torvalds 		(map->flags & MAP_16BIT)	? "16BIT "	: "",
4701da177e4SLinus Torvalds 		(map->flags & MAP_AUTOSZ)	? "AUTOSZ "	: "",
4711da177e4SLinus Torvalds 		(map->flags & MAP_0WS)		? "0WS "	: "",
4721da177e4SLinus Torvalds 		(map->flags & MAP_WRPROT)	? "WRPROT "	: "",
4731da177e4SLinus Torvalds 		(map->flags & MAP_USE_WAIT)	? "USE_WAIT "	: "",
4741da177e4SLinus Torvalds 		(map->flags & MAP_PREFETCH)	? "PREFETCH "	: "");
4751da177e4SLinus Torvalds 
4761da177e4SLinus Torvalds 	if (map->map >= MAX_IO_WIN) {
4772e11cb4cSHarvey Harrison 		printk(KERN_ERR "%s(): map (%d) out of range\n", __func__,
4781da177e4SLinus Torvalds 		       map->map);
4791da177e4SLinus Torvalds 		return -1;
4801da177e4SLinus Torvalds 	}
4811da177e4SLinus Torvalds 
4821da177e4SLinus Torvalds 	if (map->flags & MAP_ACTIVE) {
4831da177e4SLinus Torvalds 		if (speed == 0)
4841da177e4SLinus Torvalds 			speed = SOC_PCMCIA_IO_ACCESS;
4851da177e4SLinus Torvalds 	} else {
4861da177e4SLinus Torvalds 		speed = 0;
4871da177e4SLinus Torvalds 	}
4881da177e4SLinus Torvalds 
4891da177e4SLinus Torvalds 	skt->spd_io[map->map] = speed;
4901da177e4SLinus Torvalds 	skt->ops->set_timing(skt);
4911da177e4SLinus Torvalds 
4921da177e4SLinus Torvalds 	if (map->stop == 1)
4931da177e4SLinus Torvalds 		map->stop = PAGE_SIZE-1;
4941da177e4SLinus Torvalds 
4951da177e4SLinus Torvalds 	map->stop -= map->start;
4961da177e4SLinus Torvalds 	map->stop += skt->socket.io_offset;
4971da177e4SLinus Torvalds 	map->start = skt->socket.io_offset;
4981da177e4SLinus Torvalds 
4991da177e4SLinus Torvalds 	return 0;
5001da177e4SLinus Torvalds }
5011da177e4SLinus Torvalds 
5021da177e4SLinus Torvalds 
5031da177e4SLinus Torvalds /*
5041da177e4SLinus Torvalds  * Implements the set_mem_map() operation for the in-kernel PCMCIA
5051da177e4SLinus Torvalds  * service (formerly SS_SetMemMap in Card Services). We configure
5061da177e4SLinus Torvalds  * the map speed as requested, but override the address ranges
5071da177e4SLinus Torvalds  * supplied by Card Services.
5081da177e4SLinus Torvalds  *
5094846d017SPavel Machek  * Returns: 0 on success, -ERRNO on error
5101da177e4SLinus Torvalds  */
51117b38ebbSMarcelo Roberto Jimenez static int soc_common_pcmcia_set_mem_map(
51217b38ebbSMarcelo Roberto Jimenez 	struct pcmcia_socket *sock, struct pccard_mem_map *map)
5131da177e4SLinus Torvalds {
5141da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt = to_soc_pcmcia_socket(sock);
5151da177e4SLinus Torvalds 	struct resource *res;
5161da177e4SLinus Torvalds 	unsigned short speed = map->speed;
5171da177e4SLinus Torvalds 
5181da177e4SLinus Torvalds 	debug(skt, 2, "map %u speed %u card_start %08x\n",
5191da177e4SLinus Torvalds 		map->map, map->speed, map->card_start);
5201da177e4SLinus Torvalds 	debug(skt, 2, "flags: %s%s%s%s%s%s%s%s\n",
5211da177e4SLinus Torvalds 		(map->flags == 0)		? "<NONE>"	: "",
5221da177e4SLinus Torvalds 		(map->flags & MAP_ACTIVE)	? "ACTIVE "	: "",
5231da177e4SLinus Torvalds 		(map->flags & MAP_16BIT)	? "16BIT "	: "",
5241da177e4SLinus Torvalds 		(map->flags & MAP_AUTOSZ)	? "AUTOSZ "	: "",
5251da177e4SLinus Torvalds 		(map->flags & MAP_0WS)		? "0WS "	: "",
5261da177e4SLinus Torvalds 		(map->flags & MAP_WRPROT)	? "WRPROT "	: "",
5271da177e4SLinus Torvalds 		(map->flags & MAP_ATTRIB)	? "ATTRIB "	: "",
5281da177e4SLinus Torvalds 		(map->flags & MAP_USE_WAIT)	? "USE_WAIT "	: "");
5291da177e4SLinus Torvalds 
5301da177e4SLinus Torvalds 	if (map->map >= MAX_WIN)
5311da177e4SLinus Torvalds 		return -EINVAL;
5321da177e4SLinus Torvalds 
5331da177e4SLinus Torvalds 	if (map->flags & MAP_ACTIVE) {
5341da177e4SLinus Torvalds 		if (speed == 0)
5351da177e4SLinus Torvalds 			speed = 300;
5361da177e4SLinus Torvalds 	} else {
5371da177e4SLinus Torvalds 		speed = 0;
5381da177e4SLinus Torvalds 	}
5391da177e4SLinus Torvalds 
5401da177e4SLinus Torvalds 	if (map->flags & MAP_ATTRIB) {
5411da177e4SLinus Torvalds 		res = &skt->res_attr;
5421da177e4SLinus Torvalds 		skt->spd_attr[map->map] = speed;
5431da177e4SLinus Torvalds 		skt->spd_mem[map->map] = 0;
5441da177e4SLinus Torvalds 	} else {
5451da177e4SLinus Torvalds 		res = &skt->res_mem;
5461da177e4SLinus Torvalds 		skt->spd_attr[map->map] = 0;
5471da177e4SLinus Torvalds 		skt->spd_mem[map->map] = speed;
5481da177e4SLinus Torvalds 	}
5491da177e4SLinus Torvalds 
5501da177e4SLinus Torvalds 	skt->ops->set_timing(skt);
5511da177e4SLinus Torvalds 
5521da177e4SLinus Torvalds 	map->static_start = res->start + map->card_start;
5531da177e4SLinus Torvalds 
5541da177e4SLinus Torvalds 	return 0;
5551da177e4SLinus Torvalds }
5561da177e4SLinus Torvalds 
5571da177e4SLinus Torvalds struct bittbl {
5581da177e4SLinus Torvalds 	unsigned int mask;
5591da177e4SLinus Torvalds 	const char *name;
5601da177e4SLinus Torvalds };
5611da177e4SLinus Torvalds 
5621da177e4SLinus Torvalds static struct bittbl status_bits[] = {
5631da177e4SLinus Torvalds 	{ SS_WRPROT,		"SS_WRPROT"	},
5641da177e4SLinus Torvalds 	{ SS_BATDEAD,		"SS_BATDEAD"	},
5651da177e4SLinus Torvalds 	{ SS_BATWARN,		"SS_BATWARN"	},
5661da177e4SLinus Torvalds 	{ SS_READY,		"SS_READY"	},
5671da177e4SLinus Torvalds 	{ SS_DETECT,		"SS_DETECT"	},
5681da177e4SLinus Torvalds 	{ SS_POWERON,		"SS_POWERON"	},
5691da177e4SLinus Torvalds 	{ SS_STSCHG,		"SS_STSCHG"	},
5701da177e4SLinus Torvalds 	{ SS_3VCARD,		"SS_3VCARD"	},
5711da177e4SLinus Torvalds 	{ SS_XVCARD,		"SS_XVCARD"	},
5721da177e4SLinus Torvalds };
5731da177e4SLinus Torvalds 
5741da177e4SLinus Torvalds static struct bittbl conf_bits[] = {
5751da177e4SLinus Torvalds 	{ SS_PWR_AUTO,		"SS_PWR_AUTO"	},
5761da177e4SLinus Torvalds 	{ SS_IOCARD,		"SS_IOCARD"	},
5771da177e4SLinus Torvalds 	{ SS_RESET,		"SS_RESET"	},
5781da177e4SLinus Torvalds 	{ SS_DMA_MODE,		"SS_DMA_MODE"	},
5791da177e4SLinus Torvalds 	{ SS_SPKR_ENA,		"SS_SPKR_ENA"	},
5801da177e4SLinus Torvalds 	{ SS_OUTPUT_ENA,	"SS_OUTPUT_ENA"	},
5811da177e4SLinus Torvalds };
5821da177e4SLinus Torvalds 
58317b38ebbSMarcelo Roberto Jimenez static void dump_bits(char **p, const char *prefix,
58417b38ebbSMarcelo Roberto Jimenez 	unsigned int val, struct bittbl *bits, int sz)
5851da177e4SLinus Torvalds {
5861da177e4SLinus Torvalds 	char *b = *p;
5871da177e4SLinus Torvalds 	int i;
5881da177e4SLinus Torvalds 
5891da177e4SLinus Torvalds 	b += sprintf(b, "%-9s:", prefix);
5901da177e4SLinus Torvalds 	for (i = 0; i < sz; i++)
5911da177e4SLinus Torvalds 		if (val & bits[i].mask)
5921da177e4SLinus Torvalds 			b += sprintf(b, " %s", bits[i].name);
5931da177e4SLinus Torvalds 	*b++ = '\n';
5941da177e4SLinus Torvalds 	*p = b;
5951da177e4SLinus Torvalds }
5961da177e4SLinus Torvalds 
5971da177e4SLinus Torvalds /*
5981da177e4SLinus Torvalds  * Implements the /sys/class/pcmcia_socket/??/status file.
5991da177e4SLinus Torvalds  *
6001da177e4SLinus Torvalds  * Returns: the number of characters added to the buffer
6011da177e4SLinus Torvalds  */
60217b38ebbSMarcelo Roberto Jimenez static ssize_t show_status(
60317b38ebbSMarcelo Roberto Jimenez 	struct device *dev, struct device_attribute *attr, char *buf)
6041da177e4SLinus Torvalds {
6051da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt =
60687373318SGreg Kroah-Hartman 		container_of(dev, struct soc_pcmcia_socket, socket.dev);
6071da177e4SLinus Torvalds 	char *p = buf;
6081da177e4SLinus Torvalds 
6091da177e4SLinus Torvalds 	p += sprintf(p, "slot     : %d\n", skt->nr);
6101da177e4SLinus Torvalds 
6111da177e4SLinus Torvalds 	dump_bits(&p, "status", skt->status,
6121da177e4SLinus Torvalds 		  status_bits, ARRAY_SIZE(status_bits));
6131da177e4SLinus Torvalds 	dump_bits(&p, "csc_mask", skt->cs_state.csc_mask,
6141da177e4SLinus Torvalds 		  status_bits, ARRAY_SIZE(status_bits));
6151da177e4SLinus Torvalds 	dump_bits(&p, "cs_flags", skt->cs_state.flags,
6161da177e4SLinus Torvalds 		  conf_bits, ARRAY_SIZE(conf_bits));
6171da177e4SLinus Torvalds 
6181da177e4SLinus Torvalds 	p += sprintf(p, "Vcc      : %d\n", skt->cs_state.Vcc);
6191da177e4SLinus Torvalds 	p += sprintf(p, "Vpp      : %d\n", skt->cs_state.Vpp);
62066024db5SRussell King - ARM Linux 	p += sprintf(p, "IRQ      : %d (%d)\n", skt->cs_state.io_irq,
62166024db5SRussell King - ARM Linux 		skt->socket.pci_irq);
6221da177e4SLinus Torvalds 	if (skt->ops->show_timing)
6231da177e4SLinus Torvalds 		p += skt->ops->show_timing(skt, p);
6241da177e4SLinus Torvalds 
6251da177e4SLinus Torvalds 	return p-buf;
6261da177e4SLinus Torvalds }
627e4a3c3f0SAlexey Dobriyan static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
6281da177e4SLinus Torvalds 
6291da177e4SLinus Torvalds 
6301da177e4SLinus Torvalds static struct pccard_operations soc_common_pcmcia_operations = {
6311da177e4SLinus Torvalds 	.init			= soc_common_pcmcia_sock_init,
6321da177e4SLinus Torvalds 	.suspend		= soc_common_pcmcia_suspend,
6331da177e4SLinus Torvalds 	.get_status		= soc_common_pcmcia_get_status,
6341da177e4SLinus Torvalds 	.set_socket		= soc_common_pcmcia_set_socket,
6351da177e4SLinus Torvalds 	.set_io_map		= soc_common_pcmcia_set_io_map,
6361da177e4SLinus Torvalds 	.set_mem_map		= soc_common_pcmcia_set_mem_map,
6371da177e4SLinus Torvalds };
6381da177e4SLinus Torvalds 
6391da177e4SLinus Torvalds 
640097e296dSRussell King - ARM Linux static LIST_HEAD(soc_pcmcia_sockets);
64123d077e2SAndrew Morton static DEFINE_MUTEX(soc_pcmcia_sockets_lock);
6421da177e4SLinus Torvalds 
6431da177e4SLinus Torvalds #ifdef CONFIG_CPU_FREQ
6441da177e4SLinus Torvalds static int
6451da177e4SLinus Torvalds soc_pcmcia_notifier(struct notifier_block *nb, unsigned long val, void *data)
6461da177e4SLinus Torvalds {
6471da177e4SLinus Torvalds 	struct soc_pcmcia_socket *skt;
6481da177e4SLinus Torvalds 	struct cpufreq_freqs *freqs = data;
6491da177e4SLinus Torvalds 	int ret = 0;
6501da177e4SLinus Torvalds 
65123d077e2SAndrew Morton 	mutex_lock(&soc_pcmcia_sockets_lock);
6521da177e4SLinus Torvalds 	list_for_each_entry(skt, &soc_pcmcia_sockets, node)
6531da177e4SLinus Torvalds 		if (skt->ops->frequency_change)
6541da177e4SLinus Torvalds 			ret += skt->ops->frequency_change(skt, val, freqs);
65523d077e2SAndrew Morton 	mutex_unlock(&soc_pcmcia_sockets_lock);
6561da177e4SLinus Torvalds 
6571da177e4SLinus Torvalds 	return ret;
6581da177e4SLinus Torvalds }
6591da177e4SLinus Torvalds 
6601da177e4SLinus Torvalds static struct notifier_block soc_pcmcia_notifier_block = {
6611da177e4SLinus Torvalds 	.notifier_call	= soc_pcmcia_notifier
6621da177e4SLinus Torvalds };
6631da177e4SLinus Torvalds 
6641da177e4SLinus Torvalds static int soc_pcmcia_cpufreq_register(void)
6651da177e4SLinus Torvalds {
6661da177e4SLinus Torvalds 	int ret;
6671da177e4SLinus Torvalds 
6681da177e4SLinus Torvalds 	ret = cpufreq_register_notifier(&soc_pcmcia_notifier_block,
6691da177e4SLinus Torvalds 					CPUFREQ_TRANSITION_NOTIFIER);
6701da177e4SLinus Torvalds 	if (ret < 0)
6711da177e4SLinus Torvalds 		printk(KERN_ERR "Unable to register CPU frequency change "
6721da177e4SLinus Torvalds 				"notifier for PCMCIA (%d)\n", ret);
6731da177e4SLinus Torvalds 	return ret;
6741da177e4SLinus Torvalds }
6750f767de6SRussell King - ARM Linux fs_initcall(soc_pcmcia_cpufreq_register);
6761da177e4SLinus Torvalds 
6771da177e4SLinus Torvalds static void soc_pcmcia_cpufreq_unregister(void)
6781da177e4SLinus Torvalds {
67917b38ebbSMarcelo Roberto Jimenez 	cpufreq_unregister_notifier(&soc_pcmcia_notifier_block,
68017b38ebbSMarcelo Roberto Jimenez 		CPUFREQ_TRANSITION_NOTIFIER);
6811da177e4SLinus Torvalds }
6820f767de6SRussell King - ARM Linux module_exit(soc_pcmcia_cpufreq_unregister);
6831da177e4SLinus Torvalds 
6841da177e4SLinus Torvalds #endif
6851da177e4SLinus Torvalds 
686e0d21178SRussell King void soc_pcmcia_init_one(struct soc_pcmcia_socket *skt,
687e0d21178SRussell King 	struct pcmcia_low_level *ops, struct device *dev)
688e0d21178SRussell King {
689d9dc8787SRussell King 	int i;
690d9dc8787SRussell King 
691e0d21178SRussell King 	skt->ops = ops;
692e0d21178SRussell King 	skt->socket.owner = ops->owner;
693e0d21178SRussell King 	skt->socket.dev.parent = dev;
694e0d21178SRussell King 	skt->socket.pci_irq = NO_IRQ;
695d9dc8787SRussell King 
696d9dc8787SRussell King 	for (i = 0; i < ARRAY_SIZE(skt->stat); i++)
697d9dc8787SRussell King 		skt->stat[i].gpio = -EINVAL;
698e0d21178SRussell King }
699e0d21178SRussell King EXPORT_SYMBOL(soc_pcmcia_init_one);
700e0d21178SRussell King 
701097e296dSRussell King - ARM Linux void soc_pcmcia_remove_one(struct soc_pcmcia_socket *skt)
7021da177e4SLinus Torvalds {
70323d077e2SAndrew Morton 	mutex_lock(&soc_pcmcia_sockets_lock);
704097e296dSRussell King - ARM Linux 	del_timer_sync(&skt->poll_timer);
7051da177e4SLinus Torvalds 
706097e296dSRussell King - ARM Linux 	pcmcia_unregister_socket(&skt->socket);
7071da177e4SLinus Torvalds 
708d9dc8787SRussell King 	soc_pcmcia_hw_shutdown(skt);
709097e296dSRussell King - ARM Linux 
710d9dc8787SRussell King 	/* should not be required; violates some lowlevel drivers */
711097e296dSRussell King - ARM Linux 	soc_common_pcmcia_config_skt(skt, &dead_socket);
712097e296dSRussell King - ARM Linux 
713097e296dSRussell King - ARM Linux 	list_del(&skt->node);
714097e296dSRussell King - ARM Linux 	mutex_unlock(&soc_pcmcia_sockets_lock);
715097e296dSRussell King - ARM Linux 
716097e296dSRussell King - ARM Linux 	iounmap(skt->virt_io);
717097e296dSRussell King - ARM Linux 	skt->virt_io = NULL;
718097e296dSRussell King - ARM Linux 	release_resource(&skt->res_attr);
719097e296dSRussell King - ARM Linux 	release_resource(&skt->res_mem);
720097e296dSRussell King - ARM Linux 	release_resource(&skt->res_io);
721097e296dSRussell King - ARM Linux 	release_resource(&skt->res_skt);
722097e296dSRussell King - ARM Linux }
723097e296dSRussell King - ARM Linux EXPORT_SYMBOL(soc_pcmcia_remove_one);
724097e296dSRussell King - ARM Linux 
725097e296dSRussell King - ARM Linux int soc_pcmcia_add_one(struct soc_pcmcia_socket *skt)
726097e296dSRussell King - ARM Linux {
727097e296dSRussell King - ARM Linux 	int ret;
7281da177e4SLinus Torvalds 
729dae6cdabSVaishali Thakkar 	setup_timer(&skt->poll_timer, soc_common_pcmcia_poll_event,
730dae6cdabSVaishali Thakkar 		    (unsigned long)skt);
7311da177e4SLinus Torvalds 	skt->poll_timer.expires = jiffies + SOC_PCMCIA_POLL_PERIOD;
7321da177e4SLinus Torvalds 
7331da177e4SLinus Torvalds 	ret = request_resource(&iomem_resource, &skt->res_skt);
7341da177e4SLinus Torvalds 	if (ret)
7351da177e4SLinus Torvalds 		goto out_err_1;
7361da177e4SLinus Torvalds 
7371da177e4SLinus Torvalds 	ret = request_resource(&skt->res_skt, &skt->res_io);
7381da177e4SLinus Torvalds 	if (ret)
7391da177e4SLinus Torvalds 		goto out_err_2;
7401da177e4SLinus Torvalds 
7411da177e4SLinus Torvalds 	ret = request_resource(&skt->res_skt, &skt->res_mem);
7421da177e4SLinus Torvalds 	if (ret)
7431da177e4SLinus Torvalds 		goto out_err_3;
7441da177e4SLinus Torvalds 
7451da177e4SLinus Torvalds 	ret = request_resource(&skt->res_skt, &skt->res_attr);
7461da177e4SLinus Torvalds 	if (ret)
7471da177e4SLinus Torvalds 		goto out_err_4;
7481da177e4SLinus Torvalds 
7491da177e4SLinus Torvalds 	skt->virt_io = ioremap(skt->res_io.start, 0x10000);
7501da177e4SLinus Torvalds 	if (skt->virt_io == NULL) {
7511da177e4SLinus Torvalds 		ret = -ENOMEM;
7521da177e4SLinus Torvalds 		goto out_err_5;
7531da177e4SLinus Torvalds 	}
7541da177e4SLinus Torvalds 
755097e296dSRussell King - ARM Linux 	mutex_lock(&soc_pcmcia_sockets_lock);
756097e296dSRussell King - ARM Linux 
7571da177e4SLinus Torvalds 	list_add(&skt->node, &soc_pcmcia_sockets);
7581da177e4SLinus Torvalds 
7591da177e4SLinus Torvalds 	/*
7601da177e4SLinus Torvalds 	 * We initialize default socket timing here, because
7611da177e4SLinus Torvalds 	 * we are not guaranteed to see a SetIOMap operation at
7621da177e4SLinus Torvalds 	 * runtime.
7631da177e4SLinus Torvalds 	 */
764097e296dSRussell King - ARM Linux 	skt->ops->set_timing(skt);
7651da177e4SLinus Torvalds 
766d9dc8787SRussell King 	ret = soc_pcmcia_hw_init(skt);
7671da177e4SLinus Torvalds 	if (ret)
7681da177e4SLinus Torvalds 		goto out_err_6;
7691da177e4SLinus Torvalds 
770097e296dSRussell King - ARM Linux 	skt->socket.ops = &soc_common_pcmcia_operations;
7711da177e4SLinus Torvalds 	skt->socket.features = SS_CAP_STATIC_MAP|SS_CAP_PCCARD;
7721da177e4SLinus Torvalds 	skt->socket.resource_ops = &pccard_static_ops;
7731da177e4SLinus Torvalds 	skt->socket.irq_mask = 0;
7741da177e4SLinus Torvalds 	skt->socket.map_size = PAGE_SIZE;
7751da177e4SLinus Torvalds 	skt->socket.io_offset = (unsigned long)skt->virt_io;
7761da177e4SLinus Torvalds 
7771da177e4SLinus Torvalds 	skt->status = soc_common_pcmcia_skt_state(skt);
7781da177e4SLinus Torvalds 
7791da177e4SLinus Torvalds 	ret = pcmcia_register_socket(&skt->socket);
7801da177e4SLinus Torvalds 	if (ret)
7811da177e4SLinus Torvalds 		goto out_err_7;
7821da177e4SLinus Torvalds 
7831da177e4SLinus Torvalds 	add_timer(&skt->poll_timer);
7841da177e4SLinus Torvalds 
785097e296dSRussell King - ARM Linux 	mutex_unlock(&soc_pcmcia_sockets_lock);
786097e296dSRussell King - ARM Linux 
787632480eaSJürgen Schindele 	ret = device_create_file(&skt->socket.dev, &dev_attr_status);
788632480eaSJürgen Schindele 	if (ret)
789632480eaSJürgen Schindele 		goto out_err_8;
7901da177e4SLinus Torvalds 
791097e296dSRussell King - ARM Linux 	return ret;
7921da177e4SLinus Torvalds 
793632480eaSJürgen Schindele  out_err_8:
794097e296dSRussell King - ARM Linux 	mutex_lock(&soc_pcmcia_sockets_lock);
7951da177e4SLinus Torvalds 	del_timer_sync(&skt->poll_timer);
7961da177e4SLinus Torvalds 	pcmcia_unregister_socket(&skt->socket);
7971da177e4SLinus Torvalds 
7981da177e4SLinus Torvalds  out_err_7:
799d9dc8787SRussell King 	soc_pcmcia_hw_shutdown(skt);
8001da177e4SLinus Torvalds  out_err_6:
8011da177e4SLinus Torvalds 	list_del(&skt->node);
802097e296dSRussell King - ARM Linux 	mutex_unlock(&soc_pcmcia_sockets_lock);
8031da177e4SLinus Torvalds 	iounmap(skt->virt_io);
8041da177e4SLinus Torvalds  out_err_5:
8051da177e4SLinus Torvalds 	release_resource(&skt->res_attr);
8061da177e4SLinus Torvalds  out_err_4:
8071da177e4SLinus Torvalds 	release_resource(&skt->res_mem);
8081da177e4SLinus Torvalds  out_err_3:
8091da177e4SLinus Torvalds 	release_resource(&skt->res_io);
8101da177e4SLinus Torvalds  out_err_2:
8111da177e4SLinus Torvalds 	release_resource(&skt->res_skt);
8121da177e4SLinus Torvalds  out_err_1:
8131da177e4SLinus Torvalds 
814097e296dSRussell King - ARM Linux 	return ret;
815097e296dSRussell King - ARM Linux }
816097e296dSRussell King - ARM Linux EXPORT_SYMBOL(soc_pcmcia_add_one);
817097e296dSRussell King - ARM Linux 
8180f767de6SRussell King - ARM Linux MODULE_AUTHOR("John Dorsey <john+@cs.cmu.edu>");
8190f767de6SRussell King - ARM Linux MODULE_DESCRIPTION("Linux PCMCIA Card Services: Common SoC support");
8200f767de6SRussell King - ARM Linux MODULE_LICENSE("Dual MPL/GPL");
821