[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>

#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 & 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);
	struct tifm_dev *sock;
	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->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
			       "%s : demand removing card from socket %u:%u\n",
			       fm->cdev.class_id, fm->id, 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));

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

#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 rc;
	unsigned int good_sockets = 0, bad_sockets = 0;
	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 (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);
		rc = wait_for_completion_timeout(&finish_resume, HZ);
		dev_dbg(&dev->dev, "wait returned %d\n", rc);
		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;
}

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