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

/*
 *  tifm_7xx1.c - TI FlashMedia driver
 *
 *  Copyright (C) 2006 Alex Dubov <oakad@yahoo.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 */

#include <linux/tifm.h>
#include <linux/dma-mapping.h>
#include <linux/freezer.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_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;
	wake_up_all(&fm->change_set_notify);
	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;
	unsigned int 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->socket_change_set)
		writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
	else
		wake_up_all(&fm->change_set_notify);

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

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

	writel(0x0e00, sock_addr + SOCK_CONTROL);

	for (cnt = 0; cnt < 100; cnt++) {
		if (!(TIFM_SOCK_STATE_POWERED
		      & readl(sock_addr + SOCK_PRESENT_STATE)))
			break;
		msleep(10);
	}

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

	if (is_x2) {
		writel((s_state & 7) | 0x0c00, sock_addr + SOCK_CONTROL);
	} else {
		// SmartMedia cards need extra 40 msec
		if (((readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7) == 1)
			msleep(40);
		writel(readl(sock_addr + SOCK_CONTROL) | TIFM_CTRL_LED,
		       sock_addr + SOCK_CONTROL);
		msleep(10);
		writel((s_state & 0x7) | 0x0c00 | TIFM_CTRL_LED,
			sock_addr + SOCK_CONTROL);
	}

	for (cnt = 0; cnt < 100; cnt++) {
		if ((TIFM_SOCK_STATE_POWERED
		     & readl(sock_addr + SOCK_PRESENT_STATE)))
			break;
		msleep(10);
	}

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

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

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

static int tifm_7xx1_switch_media(void *data)
{
	struct tifm_adapter *fm = data;
	unsigned long flags;
	tifm_media_id media_id;
	char *card_name = "xx";
	int cnt, rc;
	struct tifm_dev *sock;
	unsigned int socket_change_set;

	while (1) {
		rc = wait_event_interruptible(fm->change_set_notify,
					      fm->socket_change_set);
		if (rc == -ERESTARTSYS)
			try_to_freeze();

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

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

		if (kthread_should_stop())
			socket_change_set = (1 << fm->num_sockets) - 1;
		spin_unlock_irqrestore(&fm->lock, flags);

		if (!socket_change_set)
			continue;

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

			spin_unlock_irqrestore(&fm->lock, flags);
			media_id = tifm_7xx1_toggle_sock_power(
					tifm_7xx1_sock_addr(fm->addr, cnt),
					fm->num_sockets == 2);
			if (media_id) {
				sock = tifm_alloc_device(fm);
				if (sock) {
					sock->addr = tifm_7xx1_sock_addr(fm->addr,
									 cnt);
					sock->media_id = media_id;
					sock->socket_id = cnt;
					switch (media_id) {
					case 1:
						card_name = "xd";
						break;
					case 2:
						card_name = "ms";
						break;
					case 3:
						card_name = "sd";
						break;
					default:
						tifm_free_device(&sock->dev);
						spin_lock_irqsave(&fm->lock, flags);
						continue;
					}
					snprintf(sock->dev.bus_id, BUS_ID_SIZE,
						 "tifm_%s%u:%u", card_name,
						 fm->id, cnt);
					printk(KERN_INFO DRIVER_NAME
					       ": %s card detected in socket %d\n",
					       card_name, 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);
			}
		}

		if (!kthread_should_stop()) {
			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);
		} else {
			for (cnt = 0; cnt < fm->num_sockets; cnt++) {
				if (fm->sockets[cnt])
					fm->socket_change_set |= 1 << cnt;
			}
			if (!fm->socket_change_set) {
				spin_unlock_irqrestore(&fm->lock, flags);
				return 0;
			} else {
				spin_unlock_irqrestore(&fm->lock, flags);
			}
		}
	}
	return 0;
}

#ifdef CONFIG_PM

static int tifm_7xx1_suspend(struct pci_dev *dev, pm_message_t state)
{
	dev_dbg(&dev->dev, "suspending host\n");

	pci_save_state(dev);
	pci_enable_wake(dev, pci_choose_state(dev, state), 0);
	pci_disable_device(dev);
	pci_set_power_state(dev, pci_choose_state(dev, state));
	return 0;
}

static int tifm_7xx1_resume(struct pci_dev *dev)
{
	struct tifm_adapter *fm = pci_get_drvdata(dev);
	int cnt, rc;
	unsigned long flags;
	tifm_media_id new_ids[fm->num_sockets];

	pci_set_power_state(dev, PCI_D0);
	pci_restore_state(dev);
	rc = pci_enable_device(dev);
	if (rc)
		return rc;
	pci_set_master(dev);

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

	for (cnt = 0; cnt < fm->num_sockets; cnt++)
		new_ids[cnt] = tifm_7xx1_toggle_sock_power(
					tifm_7xx1_sock_addr(fm->addr, cnt),
					fm->num_sockets == 2);
	spin_lock_irqsave(&fm->lock, flags);
	fm->socket_change_set = 0;
	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
		if (fm->sockets[cnt]) {
			if (fm->sockets[cnt]->media_id == new_ids[cnt])
				fm->socket_change_set |= 1 << cnt;

			fm->sockets[cnt]->media_id = new_ids[cnt];
		}
	}

	writel(TIFM_IRQ_ENABLE | TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
	       fm->addr + FM_SET_INTERRUPT_ENABLE);
	if (!fm->socket_change_set) {
		spin_unlock_irqrestore(&fm->lock, flags);
		return 0;
	} else {
		fm->socket_change_set = 0;
		spin_unlock_irqrestore(&fm->lock, flags);
	}

	wait_event_timeout(fm->change_set_notify, fm->socket_change_set, HZ);

	spin_lock_irqsave(&fm->lock, flags);
	writel(TIFM_IRQ_FIFOMASK(fm->socket_change_set)
	       | TIFM_IRQ_CARDMASK(fm->socket_change_set),
	       fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	writel(TIFM_IRQ_FIFOMASK(fm->socket_change_set)
	       | TIFM_IRQ_CARDMASK(fm->socket_change_set),
	       fm->addr + FM_SET_INTERRUPT_ENABLE);
	writel(TIFM_IRQ_ENABLE,
	       fm->addr + FM_SET_INTERRUPT_ENABLE);
	fm->socket_change_set = 0;

	spin_unlock_irqrestore(&fm->lock, flags);
	return 0;
}

#else

#define tifm_7xx1_suspend NULL
#define tifm_7xx1_resume NULL

#endif /* CONFIG_PM */

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_32BIT_MASK);
	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();
	if (!fm) {
		rc = -ENOMEM;
		goto err_out_int;
	}

	fm->dev = &dev->dev;
	fm->num_sockets = (dev->device == PCI_DEVICE_ID_TI_XX21_XX11_FM)
			  ? 4 : 2;
	fm->sockets = kzalloc(sizeof(struct tifm_dev*) * fm->num_sockets,
			      GFP_KERNEL);
	if (!fm->sockets)
		goto err_out_free;

	fm->eject = tifm_7xx1_eject;
	pci_set_drvdata(dev, fm);

	fm->addr = ioremap(pci_resource_start(dev, 0),
			   pci_resource_len(dev, 0));
	if (!fm->addr)
		goto err_out_free;

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

	init_waitqueue_head(&fm->change_set_notify);
	rc = tifm_add_adapter(fm, tifm_7xx1_switch_media);
	if (rc)
		goto err_out_irq;

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

err_out_irq:
	free_irq(dev->irq, fm);
err_out_unmap:
	iounmap(fm->addr);
err_out_free:
	pci_set_drvdata(dev, NULL);
	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);
	unsigned long flags;

	writel(TIFM_IRQ_SETALL, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	mmiowb();
	free_irq(dev->irq, fm);

	spin_lock_irqsave(&fm->lock, flags);
	fm->socket_change_set = (1 << fm->num_sockets) - 1;
	spin_unlock_irqrestore(&fm->lock, flags);

	kthread_stop(fm->media_switcher);

	tifm_remove_adapter(fm);

	pci_set_drvdata(dev, NULL);

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

	pci_disable_device(dev);
	tifm_free_adapter(fm);
}

static 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 struct pci_driver tifm_7xx1_driver = {
	.name = DRIVER_NAME,
	.id_table = tifm_7xx1_pci_tbl,
	.probe = tifm_7xx1_probe,
	.remove = tifm_7xx1_remove,
	.suspend = tifm_7xx1_suspend,
	.resume = tifm_7xx1_resume,
};

static int __init tifm_7xx1_init(void)
{
	return pci_register_driver(&tifm_7xx1_driver);
}

static void __exit tifm_7xx1_exit(void)
{
	pci_unregister_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);

module_init(tifm_7xx1_init);
module_exit(tifm_7xx1_exit);
Commit	Line	Data
4020f2d7 AD	1	/*
	2	* tifm_7xx1.c - TI FlashMedia driver
	3	*
	4	* Copyright (C) 2006 Alex Dubov <oakad@yahoo.com>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*
	10	*/
	11
	12	#include <linux/tifm.h>
	13	#include <linux/dma-mapping.h>
7146f0d3	14	#include <linux/freezer.h>
4020f2d7 AD	15
4020f2d7 AD	16	#define DRIVER_NAME "tifm_7xx1"
4552f0cb AD	17	#define DRIVER_VERSION "0.8"
	18
	19	#define TIFM_IRQ_ENABLE 0x80000000
	20	#define TIFM_IRQ_SOCKMASK(x) (x)
	21	#define TIFM_IRQ_CARDMASK(x) ((x) << 8)
	22	#define TIFM_IRQ_FIFOMASK(x) ((x) << 16)
	23	#define TIFM_IRQ_SETALL 0xffffffff
4020f2d7 AD	24
	25	static void tifm_7xx1_eject(struct tifm_adapter fm, struct tifm_dev sock)
	26	{
4020f2d7 AD	27	unsigned long flags;
	28
	29	spin_lock_irqsave(&fm->lock, flags);
7146f0d3 AD	30	fm->socket_change_set \|= 1 << sock->socket_id;
7146f0d3 AD	31	wake_up_all(&fm->change_set_notify);
4020f2d7 AD	32	spin_unlock_irqrestore(&fm->lock, flags);
	33	}
	34
7d12e780	35	static irqreturn_t tifm_7xx1_isr(int irq, void *dev_id)
4020f2d7 AD	36	{
4020f2d7 AD	37	struct tifm_adapter *fm = dev_id;
217334d1	38	struct tifm_dev *sock;
4020f2d7	39	unsigned int irq_status;
4552f0cb	40	unsigned int 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
7146f0d3 AD	67	if (!fm->socket_change_set)
	68	writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
	69	else
	70	wake_up_all(&fm->change_set_notify);
4020f2d7 AD	71
	72	spin_unlock(&fm->lock);
	73	return IRQ_HANDLED;
	74	}
	75
8b40adab AD	76	static tifm_media_id tifm_7xx1_toggle_sock_power(char __iomem *sock_addr,
8b40adab AD	77	int is_x2)
4020f2d7 AD	78	{
	79	unsigned int s_state;
	80	int cnt;
	81
	82	writel(0x0e00, sock_addr + SOCK_CONTROL);
	83
	84	for (cnt = 0; cnt < 100; cnt++) {
8b40adab AD	85	if (!(TIFM_SOCK_STATE_POWERED
8b40adab AD	86	& readl(sock_addr + SOCK_PRESENT_STATE)))
4020f2d7 AD	87	break;
	88	msleep(10);
	89	}
	90
	91	s_state = readl(sock_addr + SOCK_PRESENT_STATE);
	92	if (!(TIFM_SOCK_STATE_OCCUPIED & s_state))
	93	return FM_NULL;
	94
	95	if (is_x2) {
	96	writel((s_state & 7) \| 0x0c00, sock_addr + SOCK_CONTROL);
	97	} else {
	98	// SmartMedia cards need extra 40 msec
	99	if (((readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7) == 1)
	100	msleep(40);
	101	writel(readl(sock_addr + SOCK_CONTROL) \| TIFM_CTRL_LED,
	102	sock_addr + SOCK_CONTROL);
	103	msleep(10);
	104	writel((s_state & 0x7) \| 0x0c00 \| TIFM_CTRL_LED,
	105	sock_addr + SOCK_CONTROL);
	106	}
	107
	108	for (cnt = 0; cnt < 100; cnt++) {
8b40adab AD	109	if ((TIFM_SOCK_STATE_POWERED
8b40adab AD	110	& readl(sock_addr + SOCK_PRESENT_STATE)))
4020f2d7 AD	111	break;
	112	msleep(10);
	113	}
	114
	115	if (!is_x2)
	116	writel(readl(sock_addr + SOCK_CONTROL) & (~TIFM_CTRL_LED),
	117	sock_addr + SOCK_CONTROL);
	118
	119	return (readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7;
	120	}
	121
e069d79d AV	122	inline static char __iomem *
e069d79d AV	123	tifm_7xx1_sock_addr(char __iomem *base_addr, unsigned int sock_num)
4020f2d7 AD	124	{
	125	return base_addr + ((sock_num + 1) << 10);
	126	}
	127
7146f0d3	128	static int tifm_7xx1_switch_media(void *data)
4020f2d7	129	{
7146f0d3	130	struct tifm_adapter *fm = data;
4020f2d7 AD	131	unsigned long flags;
	132	tifm_media_id media_id;
	133	char *card_name = "xx";
7146f0d3	134	int cnt, rc;
6412d927 AD	135	struct tifm_dev *sock;
6412d927 AD	136	unsigned int socket_change_set;
4020f2d7	137
6412d927	138	while (1) {
7146f0d3 AD	139	rc = wait_event_interruptible(fm->change_set_notify,
	140	fm->socket_change_set);
	141	if (rc == -ERESTARTSYS)
	142	try_to_freeze();
	143
6412d927 AD	144	spin_lock_irqsave(&fm->lock, flags);
	145	socket_change_set = fm->socket_change_set;
	146	fm->socket_change_set = 0;
	147
	148	dev_dbg(fm->dev, "checking media set %x\n",
	149	socket_change_set);
	150
7146f0d3	151	if (kthread_should_stop())
6412d927	152	socket_change_set = (1 << fm->num_sockets) - 1;
4020f2d7	153	spin_unlock_irqrestore(&fm->lock, flags);
4020f2d7	154
6412d927	155	if (!socket_change_set)
7146f0d3	156	continue;
6412d927 AD	157
	158	spin_lock_irqsave(&fm->lock, flags);
	159	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
	160	if (!(socket_change_set & (1 << cnt)))
	161	continue;
	162	sock = fm->sockets[cnt];
	163	if (sock) {
4020f2d7	164	printk(KERN_INFO DRIVER_NAME
6412d927 AD	165	": demand removing card from socket %d\n",
	166	cnt);
	167	fm->sockets[cnt] = NULL;
	168	spin_unlock_irqrestore(&fm->lock, flags);
	169	device_unregister(&sock->dev);
4020f2d7	170	spin_lock_irqsave(&fm->lock, flags);
6412d927 AD	171	writel(0x0e00,
	172	tifm_7xx1_sock_addr(fm->addr, cnt)
	173	+ SOCK_CONTROL);
	174	}
7146f0d3	175	if (kthread_should_stop())
6412d927 AD	176	continue;
	177
	178	spin_unlock_irqrestore(&fm->lock, flags);
	179	media_id = tifm_7xx1_toggle_sock_power(
	180	tifm_7xx1_sock_addr(fm->addr, cnt),
	181	fm->num_sockets == 2);
	182	if (media_id) {
	183	sock = tifm_alloc_device(fm);
	184	if (sock) {
	185	sock->addr = tifm_7xx1_sock_addr(fm->addr,
8b40adab	186	cnt);
6412d927 AD	187	sock->media_id = media_id;
	188	sock->socket_id = cnt;
	189	switch (media_id) {
	190	case 1:
	191	card_name = "xd";
	192	break;
	193	case 2:
	194	card_name = "ms";
	195	break;
	196	case 3:
	197	card_name = "sd";
	198	break;
	199	default:
	200	tifm_free_device(&sock->dev);
	201	spin_lock_irqsave(&fm->lock, flags);
	202	continue;
	203	}
	204	snprintf(sock->dev.bus_id, BUS_ID_SIZE,
8b40adab AD	205	"tifm_%s%u:%u", card_name,
8b40adab AD	206	fm->id, cnt);
6412d927	207	printk(KERN_INFO DRIVER_NAME
8b40adab AD	208	": %s card detected in socket %d\n",
8b40adab AD	209	card_name, cnt);
6412d927 AD	210	if (!device_register(&sock->dev)) {
	211	spin_lock_irqsave(&fm->lock, flags);
	212	if (!fm->sockets[cnt]) {
	213	fm->sockets[cnt] = sock;
	214	sock = NULL;
	215	}
	216	spin_unlock_irqrestore(&fm->lock, flags);
	217	}
	218	if (sock)
	219	tifm_free_device(&sock->dev);
4020f2d7	220	}
6412d927 AD	221	spin_lock_irqsave(&fm->lock, flags);
	222	}
	223	}
	224
7146f0d3	225	if (!kthread_should_stop()) {
6412d927 AD	226	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	227	\| TIFM_IRQ_CARDMASK(socket_change_set),
	228	fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	229	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	230	\| TIFM_IRQ_CARDMASK(socket_change_set),
	231	fm->addr + FM_SET_INTERRUPT_ENABLE);
	232	writel(TIFM_IRQ_ENABLE,
	233	fm->addr + FM_SET_INTERRUPT_ENABLE);
	234	spin_unlock_irqrestore(&fm->lock, flags);
6412d927 AD	235	} else {
	236	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
	237	if (fm->sockets[cnt])
	238	fm->socket_change_set \|= 1 << cnt;
	239	}
	240	if (!fm->socket_change_set) {
	241	spin_unlock_irqrestore(&fm->lock, flags);
7146f0d3	242	return 0;
6412d927	243	} else {
4020f2d7	244	spin_unlock_irqrestore(&fm->lock, flags);
4020f2d7 AD	245	}
4020f2d7 AD	246	}
4020f2d7	247	}
7146f0d3	248	return 0;
4020f2d7 AD	249	}
4020f2d7 AD	250
7146f0d3 AD	251	#ifdef CONFIG_PM
7146f0d3 AD	252
4020f2d7 AD	253	static int tifm_7xx1_suspend(struct pci_dev *dev, pm_message_t state)
4020f2d7 AD	254	{
7146f0d3	255	dev_dbg(&dev->dev, "suspending host\n");
4020f2d7	256
7146f0d3 AD	257	pci_save_state(dev);
	258	pci_enable_wake(dev, pci_choose_state(dev, state), 0);
	259	pci_disable_device(dev);
	260	pci_set_power_state(dev, pci_choose_state(dev, state));
4020f2d7 AD	261	return 0;
	262	}
	263
	264	static int tifm_7xx1_resume(struct pci_dev *dev)
	265	{
	266	struct tifm_adapter *fm = pci_get_drvdata(dev);
7146f0d3	267	int cnt, rc;
4020f2d7	268	unsigned long flags;
7146f0d3	269	tifm_media_id new_ids[fm->num_sockets];
4020f2d7	270
7146f0d3	271	pci_set_power_state(dev, PCI_D0);
4020f2d7	272	pci_restore_state(dev);
7146f0d3 AD	273	rc = pci_enable_device(dev);
	274	if (rc)
	275	return rc;
	276	pci_set_master(dev);
	277
	278	dev_dbg(&dev->dev, "resuming host\n");
4020f2d7	279
7146f0d3 AD	280	for (cnt = 0; cnt < fm->num_sockets; cnt++)
	281	new_ids[cnt] = tifm_7xx1_toggle_sock_power(
	282	tifm_7xx1_sock_addr(fm->addr, cnt),
	283	fm->num_sockets == 2);
4020f2d7	284	spin_lock_irqsave(&fm->lock, flags);
7146f0d3 AD	285	fm->socket_change_set = 0;
	286	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
	287	if (fm->sockets[cnt]) {
	288	if (fm->sockets[cnt]->media_id == new_ids[cnt])
	289	fm->socket_change_set \|= 1 << cnt;
	290
	291	fm->sockets[cnt]->media_id = new_ids[cnt];
	292	}
	293	}
	294
6412d927	295	writel(TIFM_IRQ_ENABLE \| TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
7146f0d3 AD	296	fm->addr + FM_SET_INTERRUPT_ENABLE);
	297	if (!fm->socket_change_set) {
	298	spin_unlock_irqrestore(&fm->lock, flags);
	299	return 0;
	300	} else {
	301	fm->socket_change_set = 0;
	302	spin_unlock_irqrestore(&fm->lock, flags);
	303	}
	304
	305	wait_event_timeout(fm->change_set_notify, fm->socket_change_set, HZ);
	306
	307	spin_lock_irqsave(&fm->lock, flags);
	308	writel(TIFM_IRQ_FIFOMASK(fm->socket_change_set)
	309	\| TIFM_IRQ_CARDMASK(fm->socket_change_set),
	310	fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	311	writel(TIFM_IRQ_FIFOMASK(fm->socket_change_set)
	312	\| TIFM_IRQ_CARDMASK(fm->socket_change_set),
	313	fm->addr + FM_SET_INTERRUPT_ENABLE);
	314	writel(TIFM_IRQ_ENABLE,
	315	fm->addr + FM_SET_INTERRUPT_ENABLE);
	316	fm->socket_change_set = 0;
	317
4020f2d7 AD	318	spin_unlock_irqrestore(&fm->lock, flags);
	319	return 0;
	320	}
	321
7146f0d3 AD	322	#else
	323
	324	#define tifm_7xx1_suspend NULL
	325	#define tifm_7xx1_resume NULL
	326
	327	#endif /* CONFIG_PM */
	328
4020f2d7	329	static int tifm_7xx1_probe(struct pci_dev *dev,
8b40adab	330	const struct pci_device_id *dev_id)
4020f2d7 AD	331	{
	332	struct tifm_adapter *fm;
	333	int pci_dev_busy = 0;
	334	int rc;
	335
	336	rc = pci_set_dma_mask(dev, DMA_32BIT_MASK);
	337	if (rc)
	338	return rc;
	339
	340	rc = pci_enable_device(dev);
	341	if (rc)
	342	return rc;
	343
	344	pci_set_master(dev);
	345
	346	rc = pci_request_regions(dev, DRIVER_NAME);
	347	if (rc) {
	348	pci_dev_busy = 1;
	349	goto err_out;
	350	}
	351
	352	pci_intx(dev, 1);
	353
	354	fm = tifm_alloc_adapter();
	355	if (!fm) {
	356	rc = -ENOMEM;
	357	goto err_out_int;
	358	}
	359
	360	fm->dev = &dev->dev;
b5ad6761 AD	361	fm->num_sockets = (dev->device == PCI_DEVICE_ID_TI_XX21_XX11_FM)
b5ad6761 AD	362	? 4 : 2;
6412d927	363	fm->sockets = kzalloc(sizeof(struct tifm_dev) fm->num_sockets,
8b40adab	364	GFP_KERNEL);
4020f2d7 AD	365	if (!fm->sockets)
	366	goto err_out_free;
	367
4020f2d7 AD	368	fm->eject = tifm_7xx1_eject;
	369	pci_set_drvdata(dev, fm);
	370
	371	fm->addr = ioremap(pci_resource_start(dev, 0),
8b40adab	372	pci_resource_len(dev, 0));
4020f2d7 AD	373	if (!fm->addr)
	374	goto err_out_free;
	375
38515e90	376	rc = request_irq(dev->irq, tifm_7xx1_isr, IRQF_SHARED, DRIVER_NAME, fm);
4020f2d7 AD	377	if (rc)
	378	goto err_out_unmap;
	379
7146f0d3 AD	380	init_waitqueue_head(&fm->change_set_notify);
7146f0d3 AD	381	rc = tifm_add_adapter(fm, tifm_7xx1_switch_media);
4020f2d7 AD	382	if (rc)
	383	goto err_out_irq;
	384
	385	writel(TIFM_IRQ_SETALL, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
6412d927	386	writel(TIFM_IRQ_ENABLE \| TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
8b40adab	387	fm->addr + FM_SET_INTERRUPT_ENABLE);
7146f0d3	388	wake_up_process(fm->media_switcher);
4020f2d7 AD	389	return 0;
	390
	391	err_out_irq:
	392	free_irq(dev->irq, fm);
	393	err_out_unmap:
	394	iounmap(fm->addr);
	395	err_out_free:
	396	pci_set_drvdata(dev, NULL);
	397	tifm_free_adapter(fm);
	398	err_out_int:
	399	pci_intx(dev, 0);
	400	pci_release_regions(dev);
	401	err_out:
	402	if (!pci_dev_busy)
	403	pci_disable_device(dev);
	404	return rc;
	405	}
	406
	407	static void tifm_7xx1_remove(struct pci_dev *dev)
	408	{
	409	struct tifm_adapter *fm = pci_get_drvdata(dev);
	410	unsigned long flags;
	411
7146f0d3 AD	412	writel(TIFM_IRQ_SETALL, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	413	mmiowb();
	414	free_irq(dev->irq, fm);
	415
4020f2d7	416	spin_lock_irqsave(&fm->lock, flags);
7146f0d3	417	fm->socket_change_set = (1 << fm->num_sockets) - 1;
4020f2d7 AD	418	spin_unlock_irqrestore(&fm->lock, flags);
4020f2d7 AD	419
7146f0d3	420	kthread_stop(fm->media_switcher);
4020f2d7 AD	421
	422	tifm_remove_adapter(fm);
	423
e069d79d	424	pci_set_drvdata(dev, NULL);
4020f2d7 AD	425
	426	iounmap(fm->addr);
	427	pci_intx(dev, 0);
	428	pci_release_regions(dev);
	429
	430	pci_disable_device(dev);
	431	tifm_free_adapter(fm);
	432	}
	433
	434	static struct pci_device_id tifm_7xx1_pci_tbl [] = {
b5ad6761 AD	435	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX21_XX11_FM, PCI_ANY_ID,
	436	PCI_ANY_ID, 0, 0, 0 }, /* xx21 - the one I have */
	437	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX12_FM, PCI_ANY_ID,
	438	PCI_ANY_ID, 0, 0, 0 },
	439	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX20_FM, PCI_ANY_ID,
	440	PCI_ANY_ID, 0, 0, 0 },
4020f2d7 AD	441	{ }
	442	};
	443
	444	static struct pci_driver tifm_7xx1_driver = {
	445	.name = DRIVER_NAME,
	446	.id_table = tifm_7xx1_pci_tbl,
	447	.probe = tifm_7xx1_probe,
	448	.remove = tifm_7xx1_remove,
	449	.suspend = tifm_7xx1_suspend,
	450	.resume = tifm_7xx1_resume,
	451	};
	452
	453	static int __init tifm_7xx1_init(void)
	454	{
	455	return pci_register_driver(&tifm_7xx1_driver);
	456	}
	457
	458	static void __exit tifm_7xx1_exit(void)
	459	{
	460	pci_unregister_driver(&tifm_7xx1_driver);
	461	}
	462
	463	MODULE_AUTHOR("Alex Dubov");
	464	MODULE_DESCRIPTION("TI FlashMedia host driver");
	465	MODULE_LICENSE("GPL");
	466	MODULE_DEVICE_TABLE(pci, tifm_7xx1_pci_tbl);
	467	MODULE_VERSION(DRIVER_VERSION);
	468
	469	module_init(tifm_7xx1_init);
	470	module_exit(tifm_7xx1_exit);