[mirror_ubuntu-jammy-kernel.git] / drivers / misc / tifm_7xx1.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 *  tifm_7xx1.c - TI FlashMedia driver
 *
 *  Copyright (C) 2006 Alex Dubov <oakad@yahoo.com>
 */

#include <linux/tifm.h>
#include <linux/dma-mapping.h>
#include <linux/module.h>

#define DRIVER_NAME "tifm_7xx1"
#define DRIVER_VERSION "0.8"

#define TIFM_IRQ_ENABLE           0x80000000
#define TIFM_IRQ_SOCKMASK(x)      (x)
#define TIFM_IRQ_CARDMASK(x)      ((x) << 8)
#define TIFM_IRQ_FIFOMASK(x)      ((x) << 16)
#define TIFM_IRQ_SETALL           0xffffffff

static void tifm_7xx1_dummy_eject(struct tifm_adapter *fm,
				  struct tifm_dev *sock)
{
}

static void tifm_7xx1_eject(struct tifm_adapter *fm, struct tifm_dev *sock)
{
	unsigned long flags;

	spin_lock_irqsave(&fm->lock, flags);
	fm->socket_change_set |= 1 << sock->socket_id;
	tifm_queue_work(&fm->media_switcher);
	spin_unlock_irqrestore(&fm->lock, flags);
}

static irqreturn_t tifm_7xx1_isr(int irq, void *dev_id)
{
	struct tifm_adapter *fm = dev_id;
	struct tifm_dev *sock;
	unsigned int irq_status, cnt;

	spin_lock(&fm->lock);
	irq_status = readl(fm->addr + FM_INTERRUPT_STATUS);
	if (irq_status == 0 || irq_status == (~0)) {
		spin_unlock(&fm->lock);
		return IRQ_NONE;
	}

	if (irq_status & TIFM_IRQ_ENABLE) {
		writel(TIFM_IRQ_ENABLE, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);

		for (cnt = 0; cnt < fm->num_sockets; cnt++) {
			sock = fm->sockets[cnt];
			if (sock) {
				if ((irq_status >> cnt) & TIFM_IRQ_FIFOMASK(1))
					sock->data_event(sock);
				if ((irq_status >> cnt) & TIFM_IRQ_CARDMASK(1))
					sock->card_event(sock);
			}
		}

		fm->socket_change_set |= irq_status
					 & ((1 << fm->num_sockets) - 1);
	}
	writel(irq_status, fm->addr + FM_INTERRUPT_STATUS);

	if (fm->finish_me)
		complete_all(fm->finish_me);
	else if (!fm->socket_change_set)
		writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
	else
		tifm_queue_work(&fm->media_switcher);

	spin_unlock(&fm->lock);
	return IRQ_HANDLED;
}

static unsigned char tifm_7xx1_toggle_sock_power(char __iomem *sock_addr)
{
	unsigned int s_state;
	int cnt;

	writel(0x0e00, sock_addr + SOCK_CONTROL);

	for (cnt = 16; cnt <= 256; cnt <<= 1) {
		if (!(TIFM_SOCK_STATE_POWERED
		      & readl(sock_addr + SOCK_PRESENT_STATE)))
			break;

		msleep(cnt);
	}

	s_state = readl(sock_addr + SOCK_PRESENT_STATE);
	if (!(TIFM_SOCK_STATE_OCCUPIED & s_state))
		return 0;

	writel(readl(sock_addr + SOCK_CONTROL) | TIFM_CTRL_LED,
	       sock_addr + SOCK_CONTROL);

	/* xd needs some extra time before power on */
	if (((readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7)
	    == TIFM_TYPE_XD)
		msleep(40);

	writel((s_state & TIFM_CTRL_POWER_MASK) | 0x0c00,
	       sock_addr + SOCK_CONTROL);
	/* wait for power to stabilize */
	msleep(20);
	for (cnt = 16; cnt <= 256; cnt <<= 1) {
		if ((TIFM_SOCK_STATE_POWERED
		     & readl(sock_addr + SOCK_PRESENT_STATE)))
			break;

		msleep(cnt);
	}

	writel(readl(sock_addr + SOCK_CONTROL) & (~TIFM_CTRL_LED),
	       sock_addr + SOCK_CONTROL);

	return (readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7;
}

inline static void tifm_7xx1_sock_power_off(char __iomem *sock_addr)
{
	writel((~TIFM_CTRL_POWER_MASK) & readl(sock_addr + SOCK_CONTROL),
	       sock_addr + SOCK_CONTROL);
}

inline static char __iomem *
tifm_7xx1_sock_addr(char __iomem *base_addr, unsigned int sock_num)
{
	return base_addr + ((sock_num + 1) << 10);
}

static void tifm_7xx1_switch_media(struct work_struct *work)
{
	struct tifm_adapter *fm = container_of(work, struct tifm_adapter,
					       media_switcher);
	struct tifm_dev *sock;
	char __iomem *sock_addr;
	unsigned long flags;
	unsigned char media_id;
	unsigned int socket_change_set, cnt;

	spin_lock_irqsave(&fm->lock, flags);
	socket_change_set = fm->socket_change_set;
	fm->socket_change_set = 0;

	dev_dbg(fm->dev.parent, "checking media set %x\n",
		socket_change_set);

	if (!socket_change_set) {
		spin_unlock_irqrestore(&fm->lock, flags);
		return;
	}

	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
		if (!(socket_change_set & (1 << cnt)))
			continue;
		sock = fm->sockets[cnt];
		if (sock) {
			printk(KERN_INFO
			       "%s : demand removing card from socket %u:%u\n",
			       dev_name(&fm->dev), fm->id, cnt);
			fm->sockets[cnt] = NULL;
			sock_addr = sock->addr;
			spin_unlock_irqrestore(&fm->lock, flags);
			device_unregister(&sock->dev);
			spin_lock_irqsave(&fm->lock, flags);
			tifm_7xx1_sock_power_off(sock_addr);
			writel(0x0e00, sock_addr + SOCK_CONTROL);
		}

		spin_unlock_irqrestore(&fm->lock, flags);

		media_id = tifm_7xx1_toggle_sock_power(
				tifm_7xx1_sock_addr(fm->addr, cnt));

		// tifm_alloc_device will check if media_id is valid
		sock = tifm_alloc_device(fm, cnt, media_id);
		if (sock) {
			sock->addr = tifm_7xx1_sock_addr(fm->addr, cnt);

			if (!device_register(&sock->dev)) {
				spin_lock_irqsave(&fm->lock, flags);
				if (!fm->sockets[cnt]) {
					fm->sockets[cnt] = sock;
					sock = NULL;
				}
				spin_unlock_irqrestore(&fm->lock, flags);
			}
			if (sock)
				tifm_free_device(&sock->dev);
		}
		spin_lock_irqsave(&fm->lock, flags);
	}

	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	       | TIFM_IRQ_CARDMASK(socket_change_set),
	       fm->addr + FM_CLEAR_INTERRUPT_ENABLE);

	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	       | TIFM_IRQ_CARDMASK(socket_change_set),
	       fm->addr + FM_SET_INTERRUPT_ENABLE);

	writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
	spin_unlock_irqrestore(&fm->lock, flags);
}

static int __maybe_unused tifm_7xx1_suspend(struct device *dev_d)
{
	struct pci_dev *dev = to_pci_dev(dev_d);
	struct tifm_adapter *fm = pci_get_drvdata(dev);
	int cnt;

	dev_dbg(&dev->dev, "suspending host\n");

	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
		if (fm->sockets[cnt])
			tifm_7xx1_sock_power_off(fm->sockets[cnt]->addr);
	}

	device_wakeup_disable(dev_d);
	return 0;
}

static int __maybe_unused tifm_7xx1_resume(struct device *dev_d)
{
	struct pci_dev *dev = to_pci_dev(dev_d);
	struct tifm_adapter *fm = pci_get_drvdata(dev);
	int rc;
	unsigned long timeout;
	unsigned int good_sockets = 0, bad_sockets = 0;
	unsigned long flags;
	/* Maximum number of entries is 4 */
	unsigned char new_ids[4];
	DECLARE_COMPLETION_ONSTACK(finish_resume);

	if (WARN_ON(fm->num_sockets > ARRAY_SIZE(new_ids)))
		return -ENXIO;

	pci_set_master(dev);

	dev_dbg(&dev->dev, "resuming host\n");

	for (rc = 0; rc < fm->num_sockets; rc++)
		new_ids[rc] = tifm_7xx1_toggle_sock_power(
					tifm_7xx1_sock_addr(fm->addr, rc));
	spin_lock_irqsave(&fm->lock, flags);
	for (rc = 0; rc < fm->num_sockets; rc++) {
		if (fm->sockets[rc]) {
			if (fm->sockets[rc]->type == new_ids[rc])
				good_sockets |= 1 << rc;
			else
				bad_sockets |= 1 << rc;
		}
	}

	writel(TIFM_IRQ_ENABLE | TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
	       fm->addr + FM_SET_INTERRUPT_ENABLE);
	dev_dbg(&dev->dev, "change sets on resume: good %x, bad %x\n",
		good_sockets, bad_sockets);

	fm->socket_change_set = 0;
	if (good_sockets) {
		fm->finish_me = &finish_resume;
		spin_unlock_irqrestore(&fm->lock, flags);
		timeout = wait_for_completion_timeout(&finish_resume, HZ);
		dev_dbg(&dev->dev, "wait returned %lu\n", timeout);
		writel(TIFM_IRQ_FIFOMASK(good_sockets)
		       | TIFM_IRQ_CARDMASK(good_sockets),
		       fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
		writel(TIFM_IRQ_FIFOMASK(good_sockets)
		       | TIFM_IRQ_CARDMASK(good_sockets),
		       fm->addr + FM_SET_INTERRUPT_ENABLE);
		spin_lock_irqsave(&fm->lock, flags);
		fm->finish_me = NULL;
		fm->socket_change_set ^= good_sockets & fm->socket_change_set;
	}

	fm->socket_change_set |= bad_sockets;
	if (fm->socket_change_set)
		tifm_queue_work(&fm->media_switcher);

	spin_unlock_irqrestore(&fm->lock, flags);
	writel(TIFM_IRQ_ENABLE,
	       fm->addr + FM_SET_INTERRUPT_ENABLE);

	return 0;
}

static int tifm_7xx1_dummy_has_ms_pif(struct tifm_adapter *fm,
				      struct tifm_dev *sock)
{
	return 0;
}

static int tifm_7xx1_has_ms_pif(struct tifm_adapter *fm, struct tifm_dev *sock)
{
	if (((fm->num_sockets == 4) && (sock->socket_id == 2))
	    || ((fm->num_sockets == 2) && (sock->socket_id == 0)))
		return 1;

	return 0;
}

static int tifm_7xx1_probe(struct pci_dev *dev,
			   const struct pci_device_id *dev_id)
{
	struct tifm_adapter *fm;
	int pci_dev_busy = 0;
	int rc;

	rc = pci_set_dma_mask(dev, DMA_BIT_MASK(32));
	if (rc)
		return rc;

	rc = pci_enable_device(dev);
	if (rc)
		return rc;

	pci_set_master(dev);

	rc = pci_request_regions(dev, DRIVER_NAME);
	if (rc) {
		pci_dev_busy = 1;
		goto err_out;
	}

	pci_intx(dev, 1);

	fm = tifm_alloc_adapter(dev->device == PCI_DEVICE_ID_TI_XX21_XX11_FM
				? 4 : 2, &dev->dev);
	if (!fm) {
		rc = -ENOMEM;
		goto err_out_int;
	}

	INIT_WORK(&fm->media_switcher, tifm_7xx1_switch_media);
	fm->eject = tifm_7xx1_eject;
	fm->has_ms_pif = tifm_7xx1_has_ms_pif;
	pci_set_drvdata(dev, fm);

	fm->addr = pci_ioremap_bar(dev, 0);
	if (!fm->addr) {
		rc = -ENODEV;
		goto err_out_free;
	}

	rc = request_irq(dev->irq, tifm_7xx1_isr, IRQF_SHARED, DRIVER_NAME, fm);
	if (rc)
		goto err_out_unmap;

	rc = tifm_add_adapter(fm);
	if (rc)
		goto err_out_irq;

	writel(TIFM_IRQ_ENABLE | TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
	       fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	writel(TIFM_IRQ_ENABLE | TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
	       fm->addr + FM_SET_INTERRUPT_ENABLE);
	return 0;

err_out_irq:
	free_irq(dev->irq, fm);
err_out_unmap:
	iounmap(fm->addr);
err_out_free:
	tifm_free_adapter(fm);
err_out_int:
	pci_intx(dev, 0);
	pci_release_regions(dev);
err_out:
	if (!pci_dev_busy)
		pci_disable_device(dev);
	return rc;
}

static void tifm_7xx1_remove(struct pci_dev *dev)
{
	struct tifm_adapter *fm = pci_get_drvdata(dev);
	int cnt;

	fm->eject = tifm_7xx1_dummy_eject;
	fm->has_ms_pif = tifm_7xx1_dummy_has_ms_pif;
	writel(TIFM_IRQ_SETALL, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	free_irq(dev->irq, fm);

	tifm_remove_adapter(fm);

	for (cnt = 0; cnt < fm->num_sockets; cnt++)
		tifm_7xx1_sock_power_off(tifm_7xx1_sock_addr(fm->addr, cnt));

	iounmap(fm->addr);
	pci_intx(dev, 0);
	pci_release_regions(dev);

	pci_disable_device(dev);
	tifm_free_adapter(fm);
}

static const struct pci_device_id tifm_7xx1_pci_tbl[] = {
	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX21_XX11_FM, PCI_ANY_ID,
	  PCI_ANY_ID, 0, 0, 0 }, /* xx21 - the one I have */
        { PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX12_FM, PCI_ANY_ID,
	  PCI_ANY_ID, 0, 0, 0 },
	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX20_FM, PCI_ANY_ID,
	  PCI_ANY_ID, 0, 0, 0 },
	{ }
};

static SIMPLE_DEV_PM_OPS(tifm_7xx1_pm_ops, tifm_7xx1_suspend, tifm_7xx1_resume);

static struct pci_driver tifm_7xx1_driver = {
	.name = DRIVER_NAME,
	.id_table = tifm_7xx1_pci_tbl,
	.probe = tifm_7xx1_probe,
	.remove = tifm_7xx1_remove,
	.driver.pm = &tifm_7xx1_pm_ops,
};

module_pci_driver(tifm_7xx1_driver);
MODULE_AUTHOR("Alex Dubov");
MODULE_DESCRIPTION("TI FlashMedia host driver");
MODULE_LICENSE("GPL");
MODULE_DEVICE_TABLE(pci, tifm_7xx1_pci_tbl);
MODULE_VERSION(DRIVER_VERSION);
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
4020f2d7 AD	2	/*
	3	* tifm_7xx1.c - TI FlashMedia driver
	4	*
	5	* Copyright (C) 2006 Alex Dubov <oakad@yahoo.com>
4020f2d7 AD	6	*/
	7
	8	#include <linux/tifm.h>
c4030698	9	#include <linux/dma-mapping.h>
eb12a679	10	#include <linux/module.h>
4020f2d7 AD	11
4020f2d7 AD	12	#define DRIVER_NAME "tifm_7xx1"
4552f0cb AD	13	#define DRIVER_VERSION "0.8"
	14
	15	#define TIFM_IRQ_ENABLE 0x80000000
	16	#define TIFM_IRQ_SOCKMASK(x) (x)
	17	#define TIFM_IRQ_CARDMASK(x) ((x) << 8)
	18	#define TIFM_IRQ_FIFOMASK(x) ((x) << 16)
	19	#define TIFM_IRQ_SETALL 0xffffffff
4020f2d7	20
6113ed73 AD	21	static void tifm_7xx1_dummy_eject(struct tifm_adapter *fm,
	22	struct tifm_dev *sock)
	23	{
	24	}
	25
4020f2d7 AD	26	static void tifm_7xx1_eject(struct tifm_adapter fm, struct tifm_dev sock)
4020f2d7 AD	27	{
4020f2d7 AD	28	unsigned long flags;
	29
	30	spin_lock_irqsave(&fm->lock, flags);
7146f0d3	31	fm->socket_change_set \|= 1 << sock->socket_id;
3540af8f	32	tifm_queue_work(&fm->media_switcher);
4020f2d7 AD	33	spin_unlock_irqrestore(&fm->lock, flags);
	34	}
	35
7d12e780	36	static irqreturn_t tifm_7xx1_isr(int irq, void *dev_id)
4020f2d7 AD	37	{
4020f2d7 AD	38	struct tifm_adapter *fm = dev_id;
217334d1	39	struct tifm_dev *sock;
91f8d011	40	unsigned int irq_status, cnt;
4020f2d7 AD	41
	42	spin_lock(&fm->lock);
	43	irq_status = readl(fm->addr + FM_INTERRUPT_STATUS);
	44	if (irq_status == 0 \|\| irq_status == (~0)) {
	45	spin_unlock(&fm->lock);
	46	return IRQ_NONE;
	47	}
	48
	49	if (irq_status & TIFM_IRQ_ENABLE) {
	50	writel(TIFM_IRQ_ENABLE, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	51
8b40adab	52	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
217334d1	53	sock = fm->sockets[cnt];
4552f0cb AD	54	if (sock) {
	55	if ((irq_status >> cnt) & TIFM_IRQ_FIFOMASK(1))
	56	sock->data_event(sock);
	57	if ((irq_status >> cnt) & TIFM_IRQ_CARDMASK(1))
	58	sock->card_event(sock);
	59	}
4020f2d7	60	}
6412d927	61
8b40adab AD	62	fm->socket_change_set \|= irq_status
8b40adab AD	63	& ((1 << fm->num_sockets) - 1);
4020f2d7 AD	64	}
	65	writel(irq_status, fm->addr + FM_INTERRUPT_STATUS);
	66
3540af8f AD	67	if (fm->finish_me)
	68	complete_all(fm->finish_me);
	69	else if (!fm->socket_change_set)
7146f0d3 AD	70	writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
7146f0d3 AD	71	else
3540af8f	72	tifm_queue_work(&fm->media_switcher);
4020f2d7 AD	73
	74	spin_unlock(&fm->lock);
	75	return IRQ_HANDLED;
	76	}
	77
342c0ec4	78	static unsigned char tifm_7xx1_toggle_sock_power(char __iomem *sock_addr)
4020f2d7 AD	79	{
	80	unsigned int s_state;
	81	int cnt;
	82
	83	writel(0x0e00, sock_addr + SOCK_CONTROL);
	84
342c0ec4	85	for (cnt = 16; cnt <= 256; cnt <<= 1) {
8b40adab AD	86	if (!(TIFM_SOCK_STATE_POWERED
8b40adab AD	87	& readl(sock_addr + SOCK_PRESENT_STATE)))
4020f2d7	88	break;
342c0ec4 AD	89
342c0ec4 AD	90	msleep(cnt);
4020f2d7 AD	91	}
	92
	93	s_state = readl(sock_addr + SOCK_PRESENT_STATE);
	94	if (!(TIFM_SOCK_STATE_OCCUPIED & s_state))
e23f2b8a	95	return 0;
4020f2d7	96
342c0ec4 AD	97	writel(readl(sock_addr + SOCK_CONTROL) \| TIFM_CTRL_LED,
342c0ec4 AD	98	sock_addr + SOCK_CONTROL);
4020f2d7	99
342c0ec4 AD	100	/* xd needs some extra time before power on */
	101	if (((readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7)
	102	== TIFM_TYPE_XD)
	103	msleep(40);
	104
055b8224 AD	105	writel((s_state & TIFM_CTRL_POWER_MASK) \| 0x0c00,
055b8224 AD	106	sock_addr + SOCK_CONTROL);
342c0ec4 AD	107	/* wait for power to stabilize */
	108	msleep(20);
	109	for (cnt = 16; cnt <= 256; cnt <<= 1) {
8b40adab AD	110	if ((TIFM_SOCK_STATE_POWERED
8b40adab AD	111	& readl(sock_addr + SOCK_PRESENT_STATE)))
4020f2d7	112	break;
342c0ec4 AD	113
342c0ec4 AD	114	msleep(cnt);
4020f2d7 AD	115	}
4020f2d7 AD	116
342c0ec4 AD	117	writel(readl(sock_addr + SOCK_CONTROL) & (~TIFM_CTRL_LED),
342c0ec4 AD	118	sock_addr + SOCK_CONTROL);
4020f2d7 AD	119
	120	return (readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7;
	121	}
	122
055b8224 AD	123	inline static void tifm_7xx1_sock_power_off(char __iomem *sock_addr)
	124	{
	125	writel((~TIFM_CTRL_POWER_MASK) & readl(sock_addr + SOCK_CONTROL),
	126	sock_addr + SOCK_CONTROL);
	127	}
	128
e069d79d AV	129	inline static char __iomem *
e069d79d AV	130	tifm_7xx1_sock_addr(char __iomem *base_addr, unsigned int sock_num)
4020f2d7 AD	131	{
	132	return base_addr + ((sock_num + 1) << 10);
	133	}
	134
3540af8f	135	static void tifm_7xx1_switch_media(struct work_struct *work)
4020f2d7	136	{
3540af8f AD	137	struct tifm_adapter *fm = container_of(work, struct tifm_adapter,
3540af8f AD	138	media_switcher);
91f8d011	139	struct tifm_dev *sock;
055b8224	140	char __iomem *sock_addr;
4020f2d7	141	unsigned long flags;
e23f2b8a	142	unsigned char media_id;
91f8d011	143	unsigned int socket_change_set, cnt;
4020f2d7	144
3540af8f AD	145	spin_lock_irqsave(&fm->lock, flags);
	146	socket_change_set = fm->socket_change_set;
	147	fm->socket_change_set = 0;
6412d927	148
7dd817d0	149	dev_dbg(fm->dev.parent, "checking media set %x\n",
3540af8f	150	socket_change_set);
6412d927	151
3540af8f	152	if (!socket_change_set) {
4020f2d7	153	spin_unlock_irqrestore(&fm->lock, flags);
3540af8f AD	154	return;
3540af8f AD	155	}
4020f2d7	156
2428a8fe AD	157	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
	158	if (!(socket_change_set & (1 << cnt)))
	159	continue;
	160	sock = fm->sockets[cnt];
	161	if (sock) {
	162	printk(KERN_INFO
	163	"%s : demand removing card from socket %u:%u\n",
0bad16aa	164	dev_name(&fm->dev), fm->id, cnt);
2428a8fe	165	fm->sockets[cnt] = NULL;
055b8224	166	sock_addr = sock->addr;
6412d927	167	spin_unlock_irqrestore(&fm->lock, flags);
2428a8fe AD	168	device_unregister(&sock->dev);
2428a8fe AD	169	spin_lock_irqsave(&fm->lock, flags);
055b8224 AD	170	tifm_7xx1_sock_power_off(sock_addr);
055b8224 AD	171	writel(0x0e00, sock_addr + SOCK_CONTROL);
2428a8fe AD	172	}
	173
	174	spin_unlock_irqrestore(&fm->lock, flags);
	175
	176	media_id = tifm_7xx1_toggle_sock_power(
	177	tifm_7xx1_sock_addr(fm->addr, cnt));
	178
	179	// tifm_alloc_device will check if media_id is valid
	180	sock = tifm_alloc_device(fm, cnt, media_id);
	181	if (sock) {
	182	sock->addr = tifm_7xx1_sock_addr(fm->addr, cnt);
	183
	184	if (!device_register(&sock->dev)) {
6412d927	185	spin_lock_irqsave(&fm->lock, flags);
2428a8fe AD	186	if (!fm->sockets[cnt]) {
	187	fm->sockets[cnt] = sock;
	188	sock = NULL;
	189	}
	190	spin_unlock_irqrestore(&fm->lock, flags);
6412d927	191	}
2428a8fe AD	192	if (sock)
2428a8fe AD	193	tifm_free_device(&sock->dev);
6412d927	194	}
2428a8fe AD	195	spin_lock_irqsave(&fm->lock, flags);
2428a8fe AD	196	}
6412d927	197
3540af8f AD	198	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	199	\| TIFM_IRQ_CARDMASK(socket_change_set),
	200	fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	201
	202	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	203	\| TIFM_IRQ_CARDMASK(socket_change_set),
	204	fm->addr + FM_SET_INTERRUPT_ENABLE);
	205
	206	writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
	207	spin_unlock_irqrestore(&fm->lock, flags);
4020f2d7 AD	208	}
4020f2d7 AD	209
ff249c1c	210	static int __maybe_unused tifm_7xx1_suspend(struct device *dev_d)
4020f2d7	211	{
ff249c1c	212	struct pci_dev *dev = to_pci_dev(dev_d);
055b8224 AD	213	struct tifm_adapter *fm = pci_get_drvdata(dev);
	214	int cnt;
	215
7146f0d3	216	dev_dbg(&dev->dev, "suspending host\n");
4020f2d7	217
055b8224 AD	218	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
	219	if (fm->sockets[cnt])
	220	tifm_7xx1_sock_power_off(fm->sockets[cnt]->addr);
	221	}
	222
ff249c1c	223	device_wakeup_disable(dev_d);
4020f2d7 AD	224	return 0;
	225	}
	226
ff249c1c	227	static int __maybe_unused tifm_7xx1_resume(struct device *dev_d)
4020f2d7	228	{
ff249c1c	229	struct pci_dev *dev = to_pci_dev(dev_d);
4020f2d7	230	struct tifm_adapter *fm = pci_get_drvdata(dev);
88de1b2f	231	int rc;
a819a228	232	unsigned long timeout;
88de1b2f	233	unsigned int good_sockets = 0, bad_sockets = 0;
4020f2d7	234	unsigned long flags;
c13884a8 LA	235	/* Maximum number of entries is 4 */
c13884a8 LA	236	unsigned char new_ids[4];
3540af8f	237	DECLARE_COMPLETION_ONSTACK(finish_resume);
4020f2d7	238
c13884a8 LA	239	if (WARN_ON(fm->num_sockets > ARRAY_SIZE(new_ids)))
	240	return -ENXIO;
	241
7146f0d3 AD	242	pci_set_master(dev);
	243
	244	dev_dbg(&dev->dev, "resuming host\n");
4020f2d7	245
88de1b2f AD	246	for (rc = 0; rc < fm->num_sockets; rc++)
	247	new_ids[rc] = tifm_7xx1_toggle_sock_power(
	248	tifm_7xx1_sock_addr(fm->addr, rc));
4020f2d7	249	spin_lock_irqsave(&fm->lock, flags);
88de1b2f AD	250	for (rc = 0; rc < fm->num_sockets; rc++) {
	251	if (fm->sockets[rc]) {
	252	if (fm->sockets[rc]->type == new_ids[rc])
	253	good_sockets \|= 1 << rc;
	254	else
	255	bad_sockets \|= 1 << rc;
7146f0d3 AD	256	}
	257	}
	258
6412d927	259	writel(TIFM_IRQ_ENABLE \| TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
7146f0d3	260	fm->addr + FM_SET_INTERRUPT_ENABLE);
88de1b2f AD	261	dev_dbg(&dev->dev, "change sets on resume: good %x, bad %x\n",
	262	good_sockets, bad_sockets);
	263
	264	fm->socket_change_set = 0;
	265	if (good_sockets) {
3540af8f	266	fm->finish_me = &finish_resume;
7146f0d3	267	spin_unlock_irqrestore(&fm->lock, flags);
a819a228 NMG	268	timeout = wait_for_completion_timeout(&finish_resume, HZ);
a819a228 NMG	269	dev_dbg(&dev->dev, "wait returned %lu\n", timeout);
88de1b2f AD	270	writel(TIFM_IRQ_FIFOMASK(good_sockets)
	271	\| TIFM_IRQ_CARDMASK(good_sockets),
	272	fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	273	writel(TIFM_IRQ_FIFOMASK(good_sockets)
	274	\| TIFM_IRQ_CARDMASK(good_sockets),
	275	fm->addr + FM_SET_INTERRUPT_ENABLE);
	276	spin_lock_irqsave(&fm->lock, flags);
	277	fm->finish_me = NULL;
	278	fm->socket_change_set ^= good_sockets & fm->socket_change_set;
7146f0d3 AD	279	}
7146f0d3 AD	280
88de1b2f AD	281	fm->socket_change_set \|= bad_sockets;
	282	if (fm->socket_change_set)
	283	tifm_queue_work(&fm->media_switcher);
7146f0d3	284
88de1b2f	285	spin_unlock_irqrestore(&fm->lock, flags);
7146f0d3 AD	286	writel(TIFM_IRQ_ENABLE,
7146f0d3 AD	287	fm->addr + FM_SET_INTERRUPT_ENABLE);
7146f0d3	288
4020f2d7 AD	289	return 0;
	290	}
	291
baf8532a AD	292	static int tifm_7xx1_dummy_has_ms_pif(struct tifm_adapter *fm,
	293	struct tifm_dev *sock)
	294	{
	295	return 0;
	296	}
	297
	298	static int tifm_7xx1_has_ms_pif(struct tifm_adapter fm, struct tifm_dev sock)
	299	{
	300	if (((fm->num_sockets == 4) && (sock->socket_id == 2))
	301	\|\| ((fm->num_sockets == 2) && (sock->socket_id == 0)))
	302	return 1;
	303
	304	return 0;
	305	}
	306
4020f2d7	307	static int tifm_7xx1_probe(struct pci_dev *dev,
8b40adab	308	const struct pci_device_id *dev_id)
4020f2d7 AD	309	{
	310	struct tifm_adapter *fm;
	311	int pci_dev_busy = 0;
	312	int rc;
	313
284901a9	314	rc = pci_set_dma_mask(dev, DMA_BIT_MASK(32));
4020f2d7 AD	315	if (rc)
	316	return rc;
	317
	318	rc = pci_enable_device(dev);
	319	if (rc)
	320	return rc;
	321
	322	pci_set_master(dev);
	323
	324	rc = pci_request_regions(dev, DRIVER_NAME);
	325	if (rc) {
	326	pci_dev_busy = 1;
	327	goto err_out;
	328	}
	329
	330	pci_intx(dev, 1);
	331
6113ed73 AD	332	fm = tifm_alloc_adapter(dev->device == PCI_DEVICE_ID_TI_XX21_XX11_FM
6113ed73 AD	333	? 4 : 2, &dev->dev);
4020f2d7 AD	334	if (!fm) {
	335	rc = -ENOMEM;
	336	goto err_out_int;
	337	}
	338
3540af8f	339	INIT_WORK(&fm->media_switcher, tifm_7xx1_switch_media);
4020f2d7	340	fm->eject = tifm_7xx1_eject;
baf8532a	341	fm->has_ms_pif = tifm_7xx1_has_ms_pif;
4020f2d7 AD	342	pci_set_drvdata(dev, fm);
4020f2d7 AD	343
bdbeed75	344	fm->addr = pci_ioremap_bar(dev, 0);
86d6275a WY	345	if (!fm->addr) {
86d6275a WY	346	rc = -ENODEV;
4020f2d7	347	goto err_out_free;
86d6275a	348	}
4020f2d7	349
bc913b18	350	rc = request_irq(dev->irq, tifm_7xx1_isr, IRQF_SHARED, DRIVER_NAME, fm);
4020f2d7 AD	351	if (rc)
	352	goto err_out_unmap;
	353
3540af8f	354	rc = tifm_add_adapter(fm);
4020f2d7 AD	355	if (rc)
	356	goto err_out_irq;
	357
e4c70e85 AD	358	writel(TIFM_IRQ_ENABLE \| TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
e4c70e85 AD	359	fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
6412d927	360	writel(TIFM_IRQ_ENABLE \| TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
8b40adab	361	fm->addr + FM_SET_INTERRUPT_ENABLE);
4020f2d7 AD	362	return 0;
	363
	364	err_out_irq:
	365	free_irq(dev->irq, fm);
	366	err_out_unmap:
	367	iounmap(fm->addr);
	368	err_out_free:
4020f2d7 AD	369	tifm_free_adapter(fm);
	370	err_out_int:
	371	pci_intx(dev, 0);
	372	pci_release_regions(dev);
	373	err_out:
	374	if (!pci_dev_busy)
	375	pci_disable_device(dev);
	376	return rc;
	377	}
	378
	379	static void tifm_7xx1_remove(struct pci_dev *dev)
	380	{
	381	struct tifm_adapter *fm = pci_get_drvdata(dev);
055b8224	382	int cnt;
4020f2d7	383
6113ed73	384	fm->eject = tifm_7xx1_dummy_eject;
baf8532a	385	fm->has_ms_pif = tifm_7xx1_dummy_has_ms_pif;
7146f0d3	386	writel(TIFM_IRQ_SETALL, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
7146f0d3 AD	387	free_irq(dev->irq, fm);
7146f0d3 AD	388
4020f2d7 AD	389	tifm_remove_adapter(fm);
4020f2d7 AD	390
055b8224 AD	391	for (cnt = 0; cnt < fm->num_sockets; cnt++)
	392	tifm_7xx1_sock_power_off(tifm_7xx1_sock_addr(fm->addr, cnt));
	393
4020f2d7 AD	394	iounmap(fm->addr);
	395	pci_intx(dev, 0);
	396	pci_release_regions(dev);
	397
	398	pci_disable_device(dev);
	399	tifm_free_adapter(fm);
	400	}
	401
404147ba	402	static const struct pci_device_id tifm_7xx1_pci_tbl[] = {
b5ad6761 AD	403	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX21_XX11_FM, PCI_ANY_ID,
	404	PCI_ANY_ID, 0, 0, 0 }, /* xx21 - the one I have */
	405	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX12_FM, PCI_ANY_ID,
	406	PCI_ANY_ID, 0, 0, 0 },
	407	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX20_FM, PCI_ANY_ID,
	408	PCI_ANY_ID, 0, 0, 0 },
4020f2d7 AD	409	{ }
	410	};
	411
ff249c1c VG	412	static SIMPLE_DEV_PM_OPS(tifm_7xx1_pm_ops, tifm_7xx1_suspend, tifm_7xx1_resume);
ff249c1c VG	413
4020f2d7 AD	414	static struct pci_driver tifm_7xx1_driver = {
	415	.name = DRIVER_NAME,
	416	.id_table = tifm_7xx1_pci_tbl,
	417	.probe = tifm_7xx1_probe,
	418	.remove = tifm_7xx1_remove,
ff249c1c	419	.driver.pm = &tifm_7xx1_pm_ops,
4020f2d7 AD	420	};
4020f2d7 AD	421
7e0b2cde	422	module_pci_driver(tifm_7xx1_driver);
4020f2d7 AD	423	MODULE_AUTHOR("Alex Dubov");
	424	MODULE_DESCRIPTION("TI FlashMedia host driver");
	425	MODULE_LICENSE("GPL");
	426	MODULE_DEVICE_TABLE(pci, tifm_7xx1_pci_tbl);
	427	MODULE_VERSION(DRIVER_VERSION);