[linux-2.6-block.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_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;
	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->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 & 7) | 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 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);
	unsigned long flags;
	unsigned char media_id;
	char *card_name = "xx";
	int cnt;
	struct tifm_dev *sock;
	unsigned int socket_change_set;

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

	dev_dbg(fm->cdev.dev, "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 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);
			}

			spin_unlock_irqrestore(&fm->lock, flags);
			media_id = tifm_7xx1_toggle_sock_power(
					tifm_7xx1_sock_addr(fm->addr, cnt));
			if (media_id) {
				sock = tifm_alloc_device(fm);
				if (sock) {
					sock->addr = tifm_7xx1_sock_addr(fm->addr,
									 cnt);
					sock->type = 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);
			}
		}

	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);
}

#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;
	unsigned char new_ids[fm->num_sockets];
	DECLARE_COMPLETION_ONSTACK(finish_resume);

	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));
	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]->type == new_ids[cnt])
				fm->socket_change_set |= 1 << cnt;

			fm->sockets[cnt]->type = 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;
		fm->finish_me = &finish_resume;
		spin_unlock_irqrestore(&fm->lock, flags);
	}

	wait_for_completion_timeout(&finish_resume, HZ);

	spin_lock_irqsave(&fm->lock, flags);
	fm->finish_me = NULL;
	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(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;
	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, SA_SHIRQ, 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_SET_INTERRUPT_ENABLE);
	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);

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

	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	24
6113ed73 AD	25	static void tifm_7xx1_dummy_eject(struct tifm_adapter *fm,
	26	struct tifm_dev *sock)
	27	{
	28	}
	29
4020f2d7 AD	30	static void tifm_7xx1_eject(struct tifm_adapter fm, struct tifm_dev sock)
4020f2d7 AD	31	{
4020f2d7 AD	32	unsigned long flags;
	33
	34	spin_lock_irqsave(&fm->lock, flags);
7146f0d3	35	fm->socket_change_set \|= 1 << sock->socket_id;
3540af8f	36	tifm_queue_work(&fm->media_switcher);
4020f2d7 AD	37	spin_unlock_irqrestore(&fm->lock, flags);
	38	}
	39
7d12e780	40	static irqreturn_t tifm_7xx1_isr(int irq, void *dev_id)
4020f2d7 AD	41	{
4020f2d7 AD	42	struct tifm_adapter *fm = dev_id;
217334d1	43	struct tifm_dev *sock;
4020f2d7	44	unsigned int irq_status;
4552f0cb	45	unsigned int cnt;
4020f2d7 AD	46
	47	spin_lock(&fm->lock);
	48	irq_status = readl(fm->addr + FM_INTERRUPT_STATUS);
	49	if (irq_status == 0 \|\| irq_status == (~0)) {
	50	spin_unlock(&fm->lock);
	51	return IRQ_NONE;
	52	}
	53
	54	if (irq_status & TIFM_IRQ_ENABLE) {
	55	writel(TIFM_IRQ_ENABLE, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	56
8b40adab	57	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
217334d1	58	sock = fm->sockets[cnt];
4552f0cb AD	59	if (sock) {
	60	if ((irq_status >> cnt) & TIFM_IRQ_FIFOMASK(1))
	61	sock->data_event(sock);
	62	if ((irq_status >> cnt) & TIFM_IRQ_CARDMASK(1))
	63	sock->card_event(sock);
	64	}
4020f2d7	65	}
6412d927	66
8b40adab AD	67	fm->socket_change_set \|= irq_status
8b40adab AD	68	& ((1 << fm->num_sockets) - 1);
4020f2d7 AD	69	}
	70	writel(irq_status, fm->addr + FM_INTERRUPT_STATUS);
	71
3540af8f AD	72	if (fm->finish_me)
	73	complete_all(fm->finish_me);
	74	else if (!fm->socket_change_set)
7146f0d3 AD	75	writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
7146f0d3 AD	76	else
3540af8f	77	tifm_queue_work(&fm->media_switcher);
4020f2d7 AD	78
	79	spin_unlock(&fm->lock);
	80	return IRQ_HANDLED;
	81	}
	82
342c0ec4	83	static unsigned char tifm_7xx1_toggle_sock_power(char __iomem *sock_addr)
4020f2d7 AD	84	{
	85	unsigned int s_state;
	86	int cnt;
	87
	88	writel(0x0e00, sock_addr + SOCK_CONTROL);
	89
342c0ec4	90	for (cnt = 16; cnt <= 256; cnt <<= 1) {
8b40adab AD	91	if (!(TIFM_SOCK_STATE_POWERED
8b40adab AD	92	& readl(sock_addr + SOCK_PRESENT_STATE)))
4020f2d7	93	break;
342c0ec4 AD	94
342c0ec4 AD	95	msleep(cnt);
4020f2d7 AD	96	}
	97
	98	s_state = readl(sock_addr + SOCK_PRESENT_STATE);
	99	if (!(TIFM_SOCK_STATE_OCCUPIED & s_state))
e23f2b8a	100	return 0;
4020f2d7	101
342c0ec4 AD	102	writel(readl(sock_addr + SOCK_CONTROL) \| TIFM_CTRL_LED,
342c0ec4 AD	103	sock_addr + SOCK_CONTROL);
4020f2d7	104
342c0ec4 AD	105	/* xd needs some extra time before power on */
	106	if (((readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7)
	107	== TIFM_TYPE_XD)
	108	msleep(40);
	109
	110	writel((s_state & 7) \| 0x0c00, sock_addr + SOCK_CONTROL);
	111	/* wait for power to stabilize */
	112	msleep(20);
	113	for (cnt = 16; cnt <= 256; cnt <<= 1) {
8b40adab AD	114	if ((TIFM_SOCK_STATE_POWERED
8b40adab AD	115	& readl(sock_addr + SOCK_PRESENT_STATE)))
4020f2d7	116	break;
342c0ec4 AD	117
342c0ec4 AD	118	msleep(cnt);
4020f2d7 AD	119	}
4020f2d7 AD	120
342c0ec4 AD	121	writel(readl(sock_addr + SOCK_CONTROL) & (~TIFM_CTRL_LED),
342c0ec4 AD	122	sock_addr + SOCK_CONTROL);
4020f2d7 AD	123
	124	return (readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7;
	125	}
	126
e069d79d AV	127	inline static char __iomem *
e069d79d AV	128	tifm_7xx1_sock_addr(char __iomem *base_addr, unsigned int sock_num)
4020f2d7 AD	129	{
	130	return base_addr + ((sock_num + 1) << 10);
	131	}
	132
3540af8f	133	static void tifm_7xx1_switch_media(struct work_struct *work)
4020f2d7	134	{
3540af8f AD	135	struct tifm_adapter *fm = container_of(work, struct tifm_adapter,
3540af8f AD	136	media_switcher);
4020f2d7	137	unsigned long flags;
e23f2b8a	138	unsigned char media_id;
4020f2d7	139	char *card_name = "xx";
3540af8f	140	int cnt;
6412d927 AD	141	struct tifm_dev *sock;
6412d927 AD	142	unsigned int socket_change_set;
4020f2d7	143
3540af8f AD	144	spin_lock_irqsave(&fm->lock, flags);
	145	socket_change_set = fm->socket_change_set;
	146	fm->socket_change_set = 0;
6412d927	147
6113ed73	148	dev_dbg(fm->cdev.dev, "checking media set %x\n",
3540af8f	149	socket_change_set);
6412d927	150
3540af8f	151	if (!socket_change_set) {
4020f2d7	152	spin_unlock_irqrestore(&fm->lock, flags);
3540af8f AD	153	return;
3540af8f AD	154	}
4020f2d7	155
6412d927 AD	156	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
	157	if (!(socket_change_set & (1 << cnt)))
	158	continue;
	159	sock = fm->sockets[cnt];
	160	if (sock) {
4020f2d7	161	printk(KERN_INFO DRIVER_NAME
6412d927 AD	162	": demand removing card from socket %d\n",
	163	cnt);
	164	fm->sockets[cnt] = NULL;
	165	spin_unlock_irqrestore(&fm->lock, flags);
	166	device_unregister(&sock->dev);
4020f2d7	167	spin_lock_irqsave(&fm->lock, flags);
6412d927 AD	168	writel(0x0e00,
	169	tifm_7xx1_sock_addr(fm->addr, cnt)
	170	+ SOCK_CONTROL);
	171	}
6412d927 AD	172
	173	spin_unlock_irqrestore(&fm->lock, flags);
	174	media_id = tifm_7xx1_toggle_sock_power(
342c0ec4	175	tifm_7xx1_sock_addr(fm->addr, cnt));
6412d927 AD	176	if (media_id) {
	177	sock = tifm_alloc_device(fm);
	178	if (sock) {
	179	sock->addr = tifm_7xx1_sock_addr(fm->addr,
8b40adab	180	cnt);
e23f2b8a	181	sock->type = media_id;
6412d927 AD	182	sock->socket_id = cnt;
	183	switch (media_id) {
	184	case 1:
	185	card_name = "xd";
	186	break;
	187	case 2:
	188	card_name = "ms";
	189	break;
	190	case 3:
	191	card_name = "sd";
	192	break;
	193	default:
	194	tifm_free_device(&sock->dev);
	195	spin_lock_irqsave(&fm->lock, flags);
	196	continue;
	197	}
	198	snprintf(sock->dev.bus_id, BUS_ID_SIZE,
8b40adab AD	199	"tifm_%s%u:%u", card_name,
8b40adab AD	200	fm->id, cnt);
6412d927	201	printk(KERN_INFO DRIVER_NAME
8b40adab AD	202	": %s card detected in socket %d\n",
8b40adab AD	203	card_name, cnt);
6412d927 AD	204	if (!device_register(&sock->dev)) {
	205	spin_lock_irqsave(&fm->lock, flags);
	206	if (!fm->sockets[cnt]) {
	207	fm->sockets[cnt] = sock;
	208	sock = NULL;
	209	}
	210	spin_unlock_irqrestore(&fm->lock, flags);
	211	}
	212	if (sock)
	213	tifm_free_device(&sock->dev);
4020f2d7	214	}
6412d927 AD	215	spin_lock_irqsave(&fm->lock, flags);
	216	}
	217	}
	218
3540af8f AD	219	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	220	\| TIFM_IRQ_CARDMASK(socket_change_set),
	221	fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	222
	223	writel(TIFM_IRQ_FIFOMASK(socket_change_set)
	224	\| TIFM_IRQ_CARDMASK(socket_change_set),
	225	fm->addr + FM_SET_INTERRUPT_ENABLE);
	226
	227	writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
	228	spin_unlock_irqrestore(&fm->lock, flags);
4020f2d7 AD	229	}
4020f2d7 AD	230
7146f0d3 AD	231	#ifdef CONFIG_PM
7146f0d3 AD	232
4020f2d7 AD	233	static int tifm_7xx1_suspend(struct pci_dev *dev, pm_message_t state)
4020f2d7 AD	234	{
7146f0d3	235	dev_dbg(&dev->dev, "suspending host\n");
4020f2d7	236
7146f0d3 AD	237	pci_save_state(dev);
	238	pci_enable_wake(dev, pci_choose_state(dev, state), 0);
	239	pci_disable_device(dev);
	240	pci_set_power_state(dev, pci_choose_state(dev, state));
4020f2d7 AD	241	return 0;
	242	}
	243
	244	static int tifm_7xx1_resume(struct pci_dev *dev)
	245	{
	246	struct tifm_adapter *fm = pci_get_drvdata(dev);
7146f0d3	247	int cnt, rc;
4020f2d7	248	unsigned long flags;
e23f2b8a	249	unsigned char new_ids[fm->num_sockets];
3540af8f	250	DECLARE_COMPLETION_ONSTACK(finish_resume);
4020f2d7	251
7146f0d3	252	pci_set_power_state(dev, PCI_D0);
4020f2d7	253	pci_restore_state(dev);
7146f0d3 AD	254	rc = pci_enable_device(dev);
	255	if (rc)
	256	return rc;
	257	pci_set_master(dev);
	258
	259	dev_dbg(&dev->dev, "resuming host\n");
4020f2d7	260
7146f0d3 AD	261	for (cnt = 0; cnt < fm->num_sockets; cnt++)
7146f0d3 AD	262	new_ids[cnt] = tifm_7xx1_toggle_sock_power(
342c0ec4	263	tifm_7xx1_sock_addr(fm->addr, cnt));
4020f2d7	264	spin_lock_irqsave(&fm->lock, flags);
7146f0d3 AD	265	fm->socket_change_set = 0;
	266	for (cnt = 0; cnt < fm->num_sockets; cnt++) {
	267	if (fm->sockets[cnt]) {
e23f2b8a	268	if (fm->sockets[cnt]->type == new_ids[cnt])
7146f0d3 AD	269	fm->socket_change_set \|= 1 << cnt;
7146f0d3 AD	270
e23f2b8a	271	fm->sockets[cnt]->type = new_ids[cnt];
7146f0d3 AD	272	}
	273	}
	274
6412d927	275	writel(TIFM_IRQ_ENABLE \| TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
7146f0d3 AD	276	fm->addr + FM_SET_INTERRUPT_ENABLE);
	277	if (!fm->socket_change_set) {
	278	spin_unlock_irqrestore(&fm->lock, flags);
	279	return 0;
	280	} else {
	281	fm->socket_change_set = 0;
3540af8f	282	fm->finish_me = &finish_resume;
7146f0d3 AD	283	spin_unlock_irqrestore(&fm->lock, flags);
	284	}
	285
3540af8f	286	wait_for_completion_timeout(&finish_resume, HZ);
7146f0d3 AD	287
7146f0d3 AD	288	spin_lock_irqsave(&fm->lock, flags);
3540af8f	289	fm->finish_me = NULL;
7146f0d3 AD	290	writel(TIFM_IRQ_FIFOMASK(fm->socket_change_set)
	291	\| TIFM_IRQ_CARDMASK(fm->socket_change_set),
	292	fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	293	writel(TIFM_IRQ_FIFOMASK(fm->socket_change_set)
	294	\| TIFM_IRQ_CARDMASK(fm->socket_change_set),
	295	fm->addr + FM_SET_INTERRUPT_ENABLE);
	296	writel(TIFM_IRQ_ENABLE,
	297	fm->addr + FM_SET_INTERRUPT_ENABLE);
	298	fm->socket_change_set = 0;
	299
4020f2d7 AD	300	spin_unlock_irqrestore(&fm->lock, flags);
	301	return 0;
	302	}
	303
7146f0d3 AD	304	#else
	305
	306	#define tifm_7xx1_suspend NULL
	307	#define tifm_7xx1_resume NULL
	308
	309	#endif /* CONFIG_PM */
	310
4020f2d7	311	static int tifm_7xx1_probe(struct pci_dev *dev,
8b40adab	312	const struct pci_device_id *dev_id)
4020f2d7 AD	313	{
	314	struct tifm_adapter *fm;
	315	int pci_dev_busy = 0;
	316	int rc;
	317
	318	rc = pci_set_dma_mask(dev, DMA_32BIT_MASK);
	319	if (rc)
	320	return rc;
	321
	322	rc = pci_enable_device(dev);
	323	if (rc)
	324	return rc;
	325
	326	pci_set_master(dev);
	327
	328	rc = pci_request_regions(dev, DRIVER_NAME);
	329	if (rc) {
	330	pci_dev_busy = 1;
	331	goto err_out;
	332	}
	333
	334	pci_intx(dev, 1);
	335
6113ed73 AD	336	fm = tifm_alloc_adapter(dev->device == PCI_DEVICE_ID_TI_XX21_XX11_FM
6113ed73 AD	337	? 4 : 2, &dev->dev);
4020f2d7 AD	338	if (!fm) {
	339	rc = -ENOMEM;
	340	goto err_out_int;
	341	}
	342
3540af8f	343	INIT_WORK(&fm->media_switcher, tifm_7xx1_switch_media);
4020f2d7 AD	344	fm->eject = tifm_7xx1_eject;
	345	pci_set_drvdata(dev, fm);
	346
	347	fm->addr = ioremap(pci_resource_start(dev, 0),
8b40adab	348	pci_resource_len(dev, 0));
4020f2d7 AD	349	if (!fm->addr)
	350	goto err_out_free;
	351
6113ed73	352	rc = request_irq(dev->irq, tifm_7xx1_isr, SA_SHIRQ, DRIVER_NAME, fm);
4020f2d7 AD	353	if (rc)
	354	goto err_out_unmap;
	355
3540af8f	356	rc = tifm_add_adapter(fm);
4020f2d7 AD	357	if (rc)
	358	goto err_out_irq;
	359
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:
	369	pci_set_drvdata(dev, NULL);
	370	tifm_free_adapter(fm);
	371	err_out_int:
	372	pci_intx(dev, 0);
	373	pci_release_regions(dev);
	374	err_out:
	375	if (!pci_dev_busy)
	376	pci_disable_device(dev);
	377	return rc;
	378	}
	379
	380	static void tifm_7xx1_remove(struct pci_dev *dev)
	381	{
	382	struct tifm_adapter *fm = pci_get_drvdata(dev);
4020f2d7	383
6113ed73	384	fm->eject = tifm_7xx1_dummy_eject;
7146f0d3 AD	385	writel(TIFM_IRQ_SETALL, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
	386	mmiowb();
	387	free_irq(dev->irq, fm);
	388
4020f2d7 AD	389	tifm_remove_adapter(fm);
4020f2d7 AD	390
e069d79d	391	pci_set_drvdata(dev, NULL);
4020f2d7 AD	392
	393	iounmap(fm->addr);
	394	pci_intx(dev, 0);
	395	pci_release_regions(dev);
	396
	397	pci_disable_device(dev);
	398	tifm_free_adapter(fm);
	399	}
	400
	401	static struct pci_device_id tifm_7xx1_pci_tbl [] = {
b5ad6761 AD	402	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX21_XX11_FM, PCI_ANY_ID,
	403	PCI_ANY_ID, 0, 0, 0 }, /* xx21 - the one I have */
	404	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX12_FM, PCI_ANY_ID,
	405	PCI_ANY_ID, 0, 0, 0 },
	406	{ PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX20_FM, PCI_ANY_ID,
	407	PCI_ANY_ID, 0, 0, 0 },
4020f2d7 AD	408	{ }
	409	};
	410
	411	static struct pci_driver tifm_7xx1_driver = {
	412	.name = DRIVER_NAME,
	413	.id_table = tifm_7xx1_pci_tbl,
	414	.probe = tifm_7xx1_probe,
	415	.remove = tifm_7xx1_remove,
	416	.suspend = tifm_7xx1_suspend,
	417	.resume = tifm_7xx1_resume,
	418	};
	419
	420	static int __init tifm_7xx1_init(void)
	421	{
	422	return pci_register_driver(&tifm_7xx1_driver);
	423	}
	424
	425	static void __exit tifm_7xx1_exit(void)
	426	{
	427	pci_unregister_driver(&tifm_7xx1_driver);
	428	}
	429
	430	MODULE_AUTHOR("Alex Dubov");
	431	MODULE_DESCRIPTION("TI FlashMedia host driver");
	432	MODULE_LICENSE("GPL");
	433	MODULE_DEVICE_TABLE(pci, tifm_7xx1_pci_tbl);
	434	MODULE_VERSION(DRIVER_VERSION);
	435
	436	module_init(tifm_7xx1_init);
	437	module_exit(tifm_7xx1_exit);