[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / pcmcia / sa1100_cerf.c

/*
 * drivers/pcmcia/sa1100_cerf.c
 *
 * PCMCIA implementation routines for CerfBoard
 * Based off the Assabet.
 *
 */
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/device.h>
#include <linux/init.h>
#include <linux/delay.h>

#include <asm/arch/hardware.h>
#include <asm/mach-types.h>
#include <asm/irq.h>
#include <asm/arch/cerf.h>
#include "sa1100_generic.h"

#define CERF_SOCKET	1

static struct pcmcia_irqs irqs[] = {
	{ CERF_SOCKET, CERF_IRQ_GPIO_CF_CD,   "CF_CD"   },
	{ CERF_SOCKET, CERF_IRQ_GPIO_CF_BVD2, "CF_BVD2" },
	{ CERF_SOCKET, CERF_IRQ_GPIO_CF_BVD1, "CF_BVD1" }
};

static int cerf_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
{
	skt->irq = CERF_IRQ_GPIO_CF_IRQ;

	return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
}

static void cerf_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
{
	soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
}

static void
cerf_pcmcia_socket_state(struct soc_pcmcia_socket *skt, struct pcmcia_state *state)
{
	unsigned long levels = GPLR;

	state->detect	= (levels & CERF_GPIO_CF_CD)  ?0:1;
	state->ready	= (levels & CERF_GPIO_CF_IRQ) ?1:0;
	state->bvd1	= (levels & CERF_GPIO_CF_BVD1)?1:0;
	state->bvd2	= (levels & CERF_GPIO_CF_BVD2)?1:0;
	state->wrprot	= 0;
	state->vs_3v	= 1;
	state->vs_Xv	= 0;
}

static int
cerf_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
			     const socket_state_t *state)
{
	switch (state->Vcc) {
	case 0:
	case 50:
	case 33:
		break;

	default:
		printk(KERN_ERR "%s(): unrecognized Vcc %u\n",
			__func__, state->Vcc);
		return -1;
	}

	if (state->flags & SS_RESET) {
		GPSR = CERF_GPIO_CF_RESET;
	} else {
		GPCR = CERF_GPIO_CF_RESET;
	}

	return 0;
}

static void cerf_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
{
	soc_pcmcia_enable_irqs(skt, irqs, ARRAY_SIZE(irqs));
}

static void cerf_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
{
	soc_pcmcia_disable_irqs(skt, irqs, ARRAY_SIZE(irqs));
}

static struct pcmcia_low_level cerf_pcmcia_ops = { 
	.owner			= THIS_MODULE,
	.hw_init		= cerf_pcmcia_hw_init,
	.hw_shutdown		= cerf_pcmcia_hw_shutdown,
	.socket_state		= cerf_pcmcia_socket_state,
	.configure_socket	= cerf_pcmcia_configure_socket,

	.socket_init		= cerf_pcmcia_socket_init,
	.socket_suspend		= cerf_pcmcia_socket_suspend,
};

int __init pcmcia_cerf_init(struct device *dev)
{
	int ret = -ENODEV;

	if (machine_is_cerf())
		ret = sa11xx_drv_pcmcia_probe(dev, &cerf_pcmcia_ops, CERF_SOCKET, 1);

	return ret;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* drivers/pcmcia/sa1100_cerf.c
	3	*
	4	* PCMCIA implementation routines for CerfBoard
	5	* Based off the Assabet.
	6	*
	7	*/
1da177e4 LT	8	#include <linux/module.h>
1da177e4 LT	9	#include <linux/kernel.h>
1da177e4 LT	10	#include <linux/device.h>
	11	#include <linux/init.h>
	12	#include <linux/delay.h>
	13
be509729	14	#include <asm/arch/hardware.h>
1da177e4 LT	15	#include <asm/mach-types.h>
	16	#include <asm/irq.h>
	17	#include <asm/arch/cerf.h>
	18	#include "sa1100_generic.h"
	19
	20	#define CERF_SOCKET 1
	21
	22	static struct pcmcia_irqs irqs[] = {
	23	{ CERF_SOCKET, CERF_IRQ_GPIO_CF_CD, "CF_CD" },
	24	{ CERF_SOCKET, CERF_IRQ_GPIO_CF_BVD2, "CF_BVD2" },
	25	{ CERF_SOCKET, CERF_IRQ_GPIO_CF_BVD1, "CF_BVD1" }
	26	};
	27
	28	static int cerf_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
	29	{
	30	skt->irq = CERF_IRQ_GPIO_CF_IRQ;
	31
	32	return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
	33	}
	34
	35	static void cerf_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
	36	{
	37	soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
	38	}
	39
	40	static void
	41	cerf_pcmcia_socket_state(struct soc_pcmcia_socket skt, struct pcmcia_state state)
	42	{
	43	unsigned long levels = GPLR;
	44
	45	state->detect = (levels & CERF_GPIO_CF_CD) ?0:1;
	46	state->ready = (levels & CERF_GPIO_CF_IRQ) ?1:0;
	47	state->bvd1 = (levels & CERF_GPIO_CF_BVD1)?1:0;
	48	state->bvd2 = (levels & CERF_GPIO_CF_BVD2)?1:0;
	49	state->wrprot = 0;
	50	state->vs_3v = 1;
	51	state->vs_Xv = 0;
	52	}
	53
	54	static int
	55	cerf_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
	56	const socket_state_t *state)
	57	{
	58	switch (state->Vcc) {
	59	case 0:
	60	case 50:
	61	case 33:
	62	break;
	63
	64	default:
	65	printk(KERN_ERR "%s(): unrecognized Vcc %u\n",
2e11cb4c	66	__func__, state->Vcc);
1da177e4 LT	67	return -1;
	68	}
	69
	70	if (state->flags & SS_RESET) {
	71	GPSR = CERF_GPIO_CF_RESET;
	72	} else {
	73	GPCR = CERF_GPIO_CF_RESET;
	74	}
	75
	76	return 0;
	77	}
	78
	79	static void cerf_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
	80	{
	81	soc_pcmcia_enable_irqs(skt, irqs, ARRAY_SIZE(irqs));
	82	}
	83
	84	static void cerf_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
	85	{
	86	soc_pcmcia_disable_irqs(skt, irqs, ARRAY_SIZE(irqs));
	87	}
	88
	89	static struct pcmcia_low_level cerf_pcmcia_ops = {
	90	.owner = THIS_MODULE,
	91	.hw_init = cerf_pcmcia_hw_init,
	92	.hw_shutdown = cerf_pcmcia_hw_shutdown,
	93	.socket_state = cerf_pcmcia_socket_state,
	94	.configure_socket = cerf_pcmcia_configure_socket,
	95
	96	.socket_init = cerf_pcmcia_socket_init,
	97	.socket_suspend = cerf_pcmcia_socket_suspend,
	98	};
	99
	100	int __init pcmcia_cerf_init(struct device *dev)
	101	{
	102	int ret = -ENODEV;
	103
	104	if (machine_is_cerf())
	105	ret = sa11xx_drv_pcmcia_probe(dev, &cerf_pcmcia_ops, CERF_SOCKET, 1);
	106
	107	return ret;
	108	}