[mirror_ubuntu-jammy-kernel.git] / drivers / pcmcia / pxa2xx_mainstone.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * linux/drivers/pcmcia/pxa2xx_mainstone.c
 *
 * Mainstone PCMCIA specific routines.
 *
 * Created:	May 12, 2004
 * Author:	Nicolas Pitre
 * Copyright:	MontaVista Software Inc.
 */
#include <linux/gpio/consumer.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/platform_device.h>

#include <pcmcia/ss.h>

#include <asm/mach-types.h>

#include "soc_common.h"
#include "max1600.h"

static int mst_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
{
	struct device *dev = skt->socket.dev.parent;
	struct max1600 *m;
	int ret;

	skt->stat[SOC_STAT_CD].name = skt->nr ? "bdetect" : "adetect";
	skt->stat[SOC_STAT_BVD1].name = skt->nr ? "bbvd1" : "abvd1";
	skt->stat[SOC_STAT_BVD2].name = skt->nr ? "bbvd2" : "abvd2";
	skt->stat[SOC_STAT_RDY].name = skt->nr ? "bready" : "aready";
	skt->stat[SOC_STAT_VS1].name = skt->nr ? "bvs1" : "avs1";
	skt->stat[SOC_STAT_VS2].name = skt->nr ? "bvs2" : "avs2";

	skt->gpio_reset = devm_gpiod_get(dev, skt->nr ? "breset" : "areset",
					 GPIOD_OUT_HIGH);
	if (IS_ERR(skt->gpio_reset))
		return PTR_ERR(skt->gpio_reset);

	ret = max1600_init(dev, &m, skt->nr ? MAX1600_CHAN_B : MAX1600_CHAN_A,
			   MAX1600_CODE_HIGH);
	if (ret)
		return ret;

	skt->driver_data = m;

	return soc_pcmcia_request_gpiods(skt);
}

static unsigned int mst_pcmcia_bvd1_status[2];

static void mst_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
				    struct pcmcia_state *state)
{
	unsigned int flip = mst_pcmcia_bvd1_status[skt->nr] ^ state->bvd1;

	/*
	 * Workaround for STSCHG which can't be deasserted:
	 * We therefore disable/enable corresponding IRQs
	 * as needed to avoid IRQ locks.
	 */
	if (flip) {
		mst_pcmcia_bvd1_status[skt->nr] = state->bvd1;
		if (state->bvd1)
			enable_irq(skt->stat[SOC_STAT_BVD1].irq);
		else
			disable_irq(skt->stat[SOC_STAT_BVD2].irq);
	}
}

static int mst_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
				       const socket_state_t *state)
{
	return max1600_configure(skt->driver_data, state->Vcc, state->Vpp);
}

static struct pcmcia_low_level mst_pcmcia_ops __initdata = {
	.owner			= THIS_MODULE,
	.hw_init		= mst_pcmcia_hw_init,
	.socket_state		= mst_pcmcia_socket_state,
	.configure_socket	= mst_pcmcia_configure_socket,
	.nr			= 2,
};

static struct platform_device *mst_pcmcia_device;

static int __init mst_pcmcia_init(void)
{
	int ret;

	if (!machine_is_mainstone())
		return -ENODEV;

	mst_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
	if (!mst_pcmcia_device)
		return -ENOMEM;

	ret = platform_device_add_data(mst_pcmcia_device, &mst_pcmcia_ops,
				       sizeof(mst_pcmcia_ops));
	if (ret == 0)
		ret = platform_device_add(mst_pcmcia_device);

	if (ret)
		platform_device_put(mst_pcmcia_device);

	return ret;
}

static void __exit mst_pcmcia_exit(void)
{
	platform_device_unregister(mst_pcmcia_device);
}

fs_initcall(mst_pcmcia_init);
module_exit(mst_pcmcia_exit);

MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:pxa2xx-pcmcia");
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
1da177e4 LT	2	/*
	3	* linux/drivers/pcmcia/pxa2xx_mainstone.c
	4	*
	5	* Mainstone PCMCIA specific routines.
	6	*
	7	* Created: May 12, 2004
	8	* Author: Nicolas Pitre
	9	* Copyright: MontaVista Software Inc.
1da177e4	10	*/
34fdbe64	11	#include <linux/gpio/consumer.h>
1da177e4 LT	12	#include <linux/module.h>
1da177e4 LT	13	#include <linux/init.h>
34fdbe64	14	#include <linux/interrupt.h>
1da177e4 LT	15	#include <linux/kernel.h>
1da177e4 LT	16	#include <linux/errno.h>
d052d1be	17	#include <linux/platform_device.h>
1da177e4 LT	18
	19	#include <pcmcia/ss.h>
	20
04ba0f65	21	#include <asm/mach-types.h>
1da177e4 LT	22
1da177e4 LT	23	#include "soc_common.h"
34fdbe64	24	#include "max1600.h"
1da177e4	25
1da177e4 LT	26	static int mst_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
1da177e4 LT	27	{
34fdbe64 RK	28	struct device *dev = skt->socket.dev.parent;
	29	struct max1600 *m;
	30	int ret;
	31
	32	skt->stat[SOC_STAT_CD].name = skt->nr ? "bdetect" : "adetect";
	33	skt->stat[SOC_STAT_BVD1].name = skt->nr ? "bbvd1" : "abvd1";
	34	skt->stat[SOC_STAT_BVD2].name = skt->nr ? "bbvd2" : "abvd2";
	35	skt->stat[SOC_STAT_RDY].name = skt->nr ? "bready" : "aready";
	36	skt->stat[SOC_STAT_VS1].name = skt->nr ? "bvs1" : "avs1";
	37	skt->stat[SOC_STAT_VS2].name = skt->nr ? "bvs2" : "avs2";
	38
	39	skt->gpio_reset = devm_gpiod_get(dev, skt->nr ? "breset" : "areset",
	40	GPIOD_OUT_HIGH);
	41	if (IS_ERR(skt->gpio_reset))
	42	return PTR_ERR(skt->gpio_reset);
	43
	44	ret = max1600_init(dev, &m, skt->nr ? MAX1600_CHAN_B : MAX1600_CHAN_A,
	45	MAX1600_CODE_HIGH);
	46	if (ret)
	47	return ret;
	48
	49	skt->driver_data = m;
	50
	51	return soc_pcmcia_request_gpiods(skt);
1da177e4 LT	52	}
1da177e4 LT	53
34fdbe64	54	static unsigned int mst_pcmcia_bvd1_status[2];
1da177e4 LT	55
	56	static void mst_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
	57	struct pcmcia_state *state)
	58	{
34fdbe64	59	unsigned int flip = mst_pcmcia_bvd1_status[skt->nr] ^ state->bvd1;
1da177e4 LT	60
	61	/*
	62	* Workaround for STSCHG which can't be deasserted:
	63	* We therefore disable/enable corresponding IRQs
	64	* as needed to avoid IRQ locks.
	65	*/
	66	if (flip) {
34fdbe64 RK	67	mst_pcmcia_bvd1_status[skt->nr] = state->bvd1;
	68	if (state->bvd1)
	69	enable_irq(skt->stat[SOC_STAT_BVD1].irq);
1da177e4	70	else
34fdbe64	71	disable_irq(skt->stat[SOC_STAT_BVD2].irq);
1da177e4	72	}
1da177e4 LT	73	}
	74
	75	static int mst_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
	76	const socket_state_t *state)
	77	{
34fdbe64	78	return max1600_configure(skt->driver_data, state->Vcc, state->Vpp);
1da177e4 LT	79	}
1da177e4 LT	80
4e5e8de0	81	static struct pcmcia_low_level mst_pcmcia_ops __initdata = {
1da177e4 LT	82	.owner = THIS_MODULE,
1da177e4 LT	83	.hw_init = mst_pcmcia_hw_init,
1da177e4 LT	84	.socket_state = mst_pcmcia_socket_state,
1da177e4 LT	85	.configure_socket = mst_pcmcia_configure_socket,
1da177e4 LT	86	.nr = 2,
	87	};
	88
	89	static struct platform_device *mst_pcmcia_device;
	90
	91	static int __init mst_pcmcia_init(void)
	92	{
	93	int ret;
	94
04ba0f65 RK	95	if (!machine_is_mainstone())
	96	return -ENODEV;
	97
b016450f	98	mst_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
1da177e4 LT	99	if (!mst_pcmcia_device)
1da177e4 LT	100	return -ENOMEM;
b016450f	101
4e5e8de0 RK	102	ret = platform_device_add_data(mst_pcmcia_device, &mst_pcmcia_ops,
	103	sizeof(mst_pcmcia_ops));
	104	if (ret == 0)
	105	ret = platform_device_add(mst_pcmcia_device);
b016450f	106
1da177e4	107	if (ret)
b016450f	108	platform_device_put(mst_pcmcia_device);
1da177e4 LT	109
	110	return ret;
	111	}
	112
	113	static void __exit mst_pcmcia_exit(void)
	114	{
1da177e4 LT	115	platform_device_unregister(mst_pcmcia_device);
	116	}
	117
f36598ae	118	fs_initcall(mst_pcmcia_init);
1da177e4 LT	119	module_exit(mst_pcmcia_exit);
	120
	121	MODULE_LICENSE("GPL");
43cc71ee	122	MODULE_ALIAS("platform:pxa2xx-pcmcia");