[net-next-2.6.git] / drivers / misc / cb710 / core.c

/*
 *  cb710/core.c
 *
 *  Copyright by Michał Mirosław, 2008-2009
 *
 * 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/kernel.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/spinlock.h>
#include <linux/idr.h>
#include <linux/cb710.h>
#include <linux/gfp.h>

static DEFINE_IDA(cb710_ida);
static DEFINE_SPINLOCK(cb710_ida_lock);

void cb710_pci_update_config_reg(struct pci_dev *pdev,
	int reg, uint32_t mask, uint32_t xor)
{
	u32 rval;

	pci_read_config_dword(pdev, reg, &rval);
	rval = (rval & mask) ^ xor;
	pci_write_config_dword(pdev, reg, rval);
}
EXPORT_SYMBOL_GPL(cb710_pci_update_config_reg);

/* Some magic writes based on Windows driver init code */
static int __devinit cb710_pci_configure(struct pci_dev *pdev)
{
	unsigned int devfn = PCI_DEVFN(PCI_SLOT(pdev->devfn), 0);
	struct pci_dev *pdev0 = pci_get_slot(pdev->bus, devfn);
	u32 val;

	cb710_pci_update_config_reg(pdev, 0x48,
		~0x000000FF, 0x0000003F);

	pci_read_config_dword(pdev, 0x48, &val);
	if (val & 0x80000000)
		return 0;

	if (!pdev0)
		return -ENODEV;

	if (pdev0->vendor == PCI_VENDOR_ID_ENE
	    && pdev0->device == PCI_DEVICE_ID_ENE_720) {
		cb710_pci_update_config_reg(pdev0, 0x8C,
			~0x00F00000, 0x00100000);
		cb710_pci_update_config_reg(pdev0, 0xB0,
			~0x08000000, 0x08000000);
	}

	cb710_pci_update_config_reg(pdev0, 0x8C,
		~0x00000F00, 0x00000200);
	cb710_pci_update_config_reg(pdev0, 0x90,
		~0x00060000, 0x00040000);

	pci_dev_put(pdev0);

	return 0;
}

static irqreturn_t cb710_irq_handler(int irq, void *data)
{
	struct cb710_chip *chip = data;
	struct cb710_slot *slot = &chip->slot[0];
	irqreturn_t handled = IRQ_NONE;
	unsigned nr;

	spin_lock(&chip->irq_lock); /* incl. smp_rmb() */

	for (nr = chip->slots; nr; ++slot, --nr) {
		cb710_irq_handler_t handler_func = slot->irq_handler;
		if (handler_func && handler_func(slot))
			handled = IRQ_HANDLED;
	}

	spin_unlock(&chip->irq_lock);

	return handled;
}

static void cb710_release_slot(struct device *dev)
{
#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
	struct cb710_slot *slot = cb710_pdev_to_slot(to_platform_device(dev));
	struct cb710_chip *chip = cb710_slot_to_chip(slot);

	/* slot struct can be freed now */
	atomic_dec(&chip->slot_refs_count);
#endif
}

static int __devinit cb710_register_slot(struct cb710_chip *chip,
	unsigned slot_mask, unsigned io_offset, const char *name)
{
	int nr = chip->slots;
	struct cb710_slot *slot = &chip->slot[nr];
	int err;

	dev_dbg(cb710_chip_dev(chip),
		"register: %s.%d; slot %d; mask %d; IO offset: 0x%02X\n",
		name, chip->platform_id, nr, slot_mask, io_offset);

	/* slot->irq_handler == NULL here; this needs to be
	 * seen before platform_device_register() */
	++chip->slots;
	smp_wmb();

	slot->iobase = chip->iobase + io_offset;
	slot->pdev.name = name;
	slot->pdev.id = chip->platform_id;
	slot->pdev.dev.parent = &chip->pdev->dev;
	slot->pdev.dev.release = cb710_release_slot;

	err = platform_device_register(&slot->pdev);

#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
	atomic_inc(&chip->slot_refs_count);
#endif

	if (err) {
		/* device_initialize() called from platform_device_register()
		 * wants this on error path */
		platform_device_put(&slot->pdev);

		/* slot->irq_handler == NULL here anyway, so no lock needed */
		--chip->slots;
		return err;
	}

	chip->slot_mask |= slot_mask;

	return 0;
}

static void cb710_unregister_slot(struct cb710_chip *chip,
	unsigned slot_mask)
{
	int nr = chip->slots - 1;

	if (!(chip->slot_mask & slot_mask))
		return;

	platform_device_unregister(&chip->slot[nr].pdev);

	/* complementary to spin_unlock() in cb710_set_irq_handler() */
	smp_rmb();
	BUG_ON(chip->slot[nr].irq_handler != NULL);

	/* slot->irq_handler == NULL here, so no lock needed */
	--chip->slots;
	chip->slot_mask &= ~slot_mask;
}

void cb710_set_irq_handler(struct cb710_slot *slot,
	cb710_irq_handler_t handler)
{
	struct cb710_chip *chip = cb710_slot_to_chip(slot);
	unsigned long flags;

	spin_lock_irqsave(&chip->irq_lock, flags);
	slot->irq_handler = handler;
	spin_unlock_irqrestore(&chip->irq_lock, flags);
}
EXPORT_SYMBOL_GPL(cb710_set_irq_handler);

#ifdef CONFIG_PM

static int cb710_suspend(struct pci_dev *pdev, pm_message_t state)
{
	struct cb710_chip *chip = pci_get_drvdata(pdev);

	free_irq(pdev->irq, chip);
	pci_save_state(pdev);
	pci_disable_device(pdev);
	if (state.event & PM_EVENT_SLEEP)
		pci_set_power_state(pdev, PCI_D3cold);
	return 0;
}

static int cb710_resume(struct pci_dev *pdev)
{
	struct cb710_chip *chip = pci_get_drvdata(pdev);
	int err;

	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
	err = pcim_enable_device(pdev);
	if (err)
		return err;

	return devm_request_irq(&pdev->dev, pdev->irq,
		cb710_irq_handler, IRQF_SHARED, KBUILD_MODNAME, chip);
}

#endif /* CONFIG_PM */

static int __devinit cb710_probe(struct pci_dev *pdev,
	const struct pci_device_id *ent)
{
	struct cb710_chip *chip;
	unsigned long flags;
	u32 val;
	int err;
	int n = 0;

	err = cb710_pci_configure(pdev);
	if (err)
		return err;

	/* this is actually magic... */
	pci_read_config_dword(pdev, 0x48, &val);
	if (!(val & 0x80000000)) {
		pci_write_config_dword(pdev, 0x48, val|0x71000000);
		pci_read_config_dword(pdev, 0x48, &val);
	}

	dev_dbg(&pdev->dev, "PCI config[0x48] = 0x%08X\n", val);
	if (!(val & 0x70000000))
		return -ENODEV;
	val = (val >> 28) & 7;
	if (val & CB710_SLOT_MMC)
		++n;
	if (val & CB710_SLOT_MS)
		++n;
	if (val & CB710_SLOT_SM)
		++n;

	chip = devm_kzalloc(&pdev->dev,
		sizeof(*chip) + n * sizeof(*chip->slot), GFP_KERNEL);
	if (!chip)
		return -ENOMEM;

	err = pcim_enable_device(pdev);
	if (err)
		return err;

	err = pcim_iomap_regions(pdev, 0x0001, KBUILD_MODNAME);
	if (err)
		return err;

	chip->pdev = pdev;
	chip->iobase = pcim_iomap_table(pdev)[0];

	pci_set_drvdata(pdev, chip);

	err = devm_request_irq(&pdev->dev, pdev->irq,
		cb710_irq_handler, IRQF_SHARED, KBUILD_MODNAME, chip);
	if (err)
		return err;

	do {
		if (!ida_pre_get(&cb710_ida, GFP_KERNEL))
			return -ENOMEM;

		spin_lock_irqsave(&cb710_ida_lock, flags);
		err = ida_get_new(&cb710_ida, &chip->platform_id);
		spin_unlock_irqrestore(&cb710_ida_lock, flags);

		if (err && err != -EAGAIN)
			return err;
	} while (err);


	dev_info(&pdev->dev, "id %d, IO 0x%p, IRQ %d\n",
		chip->platform_id, chip->iobase, pdev->irq);

	if (val & CB710_SLOT_MMC) {	/* MMC/SD slot */
		err = cb710_register_slot(chip,
			CB710_SLOT_MMC, 0x00, "cb710-mmc");
		if (err)
			return err;
	}

	if (val & CB710_SLOT_MS) {	/* MemoryStick slot */
		err = cb710_register_slot(chip,
			CB710_SLOT_MS, 0x40, "cb710-ms");
		if (err)
			goto unreg_mmc;
	}

	if (val & CB710_SLOT_SM) {	/* SmartMedia slot */
		err = cb710_register_slot(chip,
			CB710_SLOT_SM, 0x60, "cb710-sm");
		if (err)
			goto unreg_ms;
	}

	return 0;
unreg_ms:
	cb710_unregister_slot(chip, CB710_SLOT_MS);
unreg_mmc:
	cb710_unregister_slot(chip, CB710_SLOT_MMC);

#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
	BUG_ON(atomic_read(&chip->slot_refs_count) != 0);
#endif
	return err;
}

static void __devexit cb710_remove_one(struct pci_dev *pdev)
{
	struct cb710_chip *chip = pci_get_drvdata(pdev);
	unsigned long flags;

	cb710_unregister_slot(chip, CB710_SLOT_SM);
	cb710_unregister_slot(chip, CB710_SLOT_MS);
	cb710_unregister_slot(chip, CB710_SLOT_MMC);
#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
	BUG_ON(atomic_read(&chip->slot_refs_count) != 0);
#endif

	spin_lock_irqsave(&cb710_ida_lock, flags);
	ida_remove(&cb710_ida, chip->platform_id);
	spin_unlock_irqrestore(&cb710_ida_lock, flags);
}

static const struct pci_device_id cb710_pci_tbl[] = {
	{ PCI_VENDOR_ID_ENE, PCI_DEVICE_ID_ENE_CB710_FLASH,
		PCI_ANY_ID, PCI_ANY_ID, },
	{ 0, }
};

static struct pci_driver cb710_driver = {
	.name = KBUILD_MODNAME,
	.id_table = cb710_pci_tbl,
	.probe = cb710_probe,
	.remove = __devexit_p(cb710_remove_one),
#ifdef CONFIG_PM
	.suspend = cb710_suspend,
	.resume = cb710_resume,
#endif
};

static int __init cb710_init_module(void)
{
	return pci_register_driver(&cb710_driver);
}

static void __exit cb710_cleanup_module(void)
{
	pci_unregister_driver(&cb710_driver);
	ida_destroy(&cb710_ida);
}

module_init(cb710_init_module);
module_exit(cb710_cleanup_module);

MODULE_AUTHOR("Michał Mirosław <mirq-linux@rere.qmqm.pl>");
MODULE_DESCRIPTION("ENE CB710 memory card reader driver");
MODULE_LICENSE("GPL");
MODULE_DEVICE_TABLE(pci, cb710_pci_tbl);
Commit	Line	Data
5f5bac82 MM	1	/*
	2	* cb710/core.c
	3	*
	4	* Copyright by Michał Mirosław, 2008-2009
	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	#include <linux/kernel.h>
	11	#include <linux/module.h>
5f5bac82 MM	12	#include <linux/pci.h>
	13	#include <linux/spinlock.h>
	14	#include <linux/idr.h>
	15	#include <linux/cb710.h>
5a0e3ad6	16	#include <linux/gfp.h>
5f5bac82 MM	17
	18	static DEFINE_IDA(cb710_ida);
	19	static DEFINE_SPINLOCK(cb710_ida_lock);
	20
	21	void cb710_pci_update_config_reg(struct pci_dev *pdev,
	22	int reg, uint32_t mask, uint32_t xor)
	23	{
	24	u32 rval;
	25
	26	pci_read_config_dword(pdev, reg, &rval);
	27	rval = (rval & mask) ^ xor;
	28	pci_write_config_dword(pdev, reg, rval);
	29	}
	30	EXPORT_SYMBOL_GPL(cb710_pci_update_config_reg);
	31
	32	/* Some magic writes based on Windows driver init code */
	33	static int __devinit cb710_pci_configure(struct pci_dev *pdev)
	34	{
	35	unsigned int devfn = PCI_DEVFN(PCI_SLOT(pdev->devfn), 0);
	36	struct pci_dev *pdev0 = pci_get_slot(pdev->bus, devfn);
	37	u32 val;
	38
	39	cb710_pci_update_config_reg(pdev, 0x48,
	40	~0x000000FF, 0x0000003F);
	41
	42	pci_read_config_dword(pdev, 0x48, &val);
	43	if (val & 0x80000000)
	44	return 0;
	45
	46	if (!pdev0)
	47	return -ENODEV;
	48
	49	if (pdev0->vendor == PCI_VENDOR_ID_ENE
	50	&& pdev0->device == PCI_DEVICE_ID_ENE_720) {
	51	cb710_pci_update_config_reg(pdev0, 0x8C,
	52	~0x00F00000, 0x00100000);
	53	cb710_pci_update_config_reg(pdev0, 0xB0,
	54	~0x08000000, 0x08000000);
	55	}
	56
	57	cb710_pci_update_config_reg(pdev0, 0x8C,
	58	~0x00000F00, 0x00000200);
	59	cb710_pci_update_config_reg(pdev0, 0x90,
	60	~0x00060000, 0x00040000);
	61
	62	pci_dev_put(pdev0);
	63
	64	return 0;
	65	}
	66
	67	static irqreturn_t cb710_irq_handler(int irq, void *data)
	68	{
	69	struct cb710_chip *chip = data;
	70	struct cb710_slot *slot = &chip->slot[0];
	71	irqreturn_t handled = IRQ_NONE;
	72	unsigned nr;
	73
	74	spin_lock(&chip->irq_lock); /* incl. smp_rmb() */
	75
	76	for (nr = chip->slots; nr; ++slot, --nr) {
	77	cb710_irq_handler_t handler_func = slot->irq_handler;
	78	if (handler_func && handler_func(slot))
	79	handled = IRQ_HANDLED;
	80	}
81
82	spin_unlock(&chip->irq_lock);
83
84	return handled;
85	}
86
87	static void cb710_release_slot(struct device *dev)
88	{
89	#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
90	struct cb710_slot *slot = cb710_pdev_to_slot(to_platform_device(dev));
91	struct cb710_chip *chip = cb710_slot_to_chip(slot);
92
93	/* slot struct can be freed now */
94	atomic_dec(&chip->slot_refs_count);
95	#endif
96	}
97
98	static int __devinit cb710_register_slot(struct cb710_chip *chip,
99	unsigned slot_mask, unsigned io_offset, const char *name)
100	{
101	int nr = chip->slots;
102	struct cb710_slot *slot = &chip->slot[nr];
103	int err;
104
105	dev_dbg(cb710_chip_dev(chip),
106	"register: %s.%d; slot %d; mask %d; IO offset: 0x%02X\n",
107	name, chip->platform_id, nr, slot_mask, io_offset);
108
109	/* slot->irq_handler == NULL here; this needs to be
110	* seen before platform_device_register() */
111	++chip->slots;
112	smp_wmb();
113
114	slot->iobase = chip->iobase + io_offset;
115	slot->pdev.name = name;
116	slot->pdev.id = chip->platform_id;
117	slot->pdev.dev.parent = &chip->pdev->dev;
118	slot->pdev.dev.release = cb710_release_slot;
119
120	err = platform_device_register(&slot->pdev);
121
122	#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
123	atomic_inc(&chip->slot_refs_count);
124	#endif
125
126	if (err) {
127	/* device_initialize() called from platform_device_register()
128	* wants this on error path */
129	platform_device_put(&slot->pdev);
130
131	/* slot->irq_handler == NULL here anyway, so no lock needed */
132	--chip->slots;
133	return err;
134	}
135
136	chip->slot_mask \|= slot_mask;
137
138	return 0;
139	}
140
141	static void cb710_unregister_slot(struct cb710_chip *chip,
142	unsigned slot_mask)
143	{
144	int nr = chip->slots - 1;
145
146	if (!(chip->slot_mask & slot_mask))
147	return;
148
149	platform_device_unregister(&chip->slot[nr].pdev);
150
151	/* complementary to spin_unlock() in cb710_set_irq_handler() */
152	smp_rmb();
153	BUG_ON(chip->slot[nr].irq_handler != NULL);
154
155	/* slot->irq_handler == NULL here, so no lock needed */
156	--chip->slots;
157	chip->slot_mask &= ~slot_mask;
158	}
159
160	void cb710_set_irq_handler(struct cb710_slot *slot,
161	cb710_irq_handler_t handler)
162	{
163	struct cb710_chip *chip = cb710_slot_to_chip(slot);
164	unsigned long flags;
165
166	spin_lock_irqsave(&chip->irq_lock, flags);
167	slot->irq_handler = handler;
168	spin_unlock_irqrestore(&chip->irq_lock, flags);
169	}
170	EXPORT_SYMBOL_GPL(cb710_set_irq_handler);
171
172	#ifdef CONFIG_PM
173
174	static int cb710_suspend(struct pci_dev *pdev, pm_message_t state)
175	{
176	struct cb710_chip *chip = pci_get_drvdata(pdev);
177
178	free_irq(pdev->irq, chip);
179	pci_save_state(pdev);
180	pci_disable_device(pdev);
181	if (state.event & PM_EVENT_SLEEP)
182	pci_set_power_state(pdev, PCI_D3cold);
183	return 0;
184	}
185
186	static int cb710_resume(struct pci_dev *pdev)
187	{
188	struct cb710_chip *chip = pci_get_drvdata(pdev);
189	int err;
190
191	pci_set_power_state(pdev, PCI_D0);
192	pci_restore_state(pdev);
193	err = pcim_enable_device(pdev);
194	if (err)
195	return err;
196
197	return devm_request_irq(&pdev->dev, pdev->irq,
198	cb710_irq_handler, IRQF_SHARED, KBUILD_MODNAME, chip);
199	}
200
201	#endif /* CONFIG_PM */
202
203	static int __devinit cb710_probe(struct pci_dev *pdev,
204	const struct pci_device_id *ent)
205	{
206	struct cb710_chip *chip;
207	unsigned long flags;
208	u32 val;
209	int err;
210	int n = 0;
211
212	err = cb710_pci_configure(pdev);
213	if (err)
214	return err;
215
216	/* this is actually magic... */
217	pci_read_config_dword(pdev, 0x48, &val);
218	if (!(val & 0x80000000)) {
219	pci_write_config_dword(pdev, 0x48, val\|0x71000000);
220	pci_read_config_dword(pdev, 0x48, &val);
221	}
222
223	dev_dbg(&pdev->dev, "PCI config[0x48] = 0x%08X\n", val);
224	if (!(val & 0x70000000))
225	return -ENODEV;
226	val = (val >> 28) & 7;
227	if (val & CB710_SLOT_MMC)
228	++n;
229	if (val & CB710_SLOT_MS)
230	++n;
231	if (val & CB710_SLOT_SM)
232	++n;
233
234	chip = devm_kzalloc(&pdev->dev,
235	sizeof(chip) + n sizeof(*chip->slot), GFP_KERNEL);
236	if (!chip)
237	return -ENOMEM;
238
239	err = pcim_enable_device(pdev);
240	if (err)
241	return err;
242
243	err = pcim_iomap_regions(pdev, 0x0001, KBUILD_MODNAME);
244	if (err)
245	return err;
246
247	chip->pdev = pdev;
248	chip->iobase = pcim_iomap_table(pdev)[0];
249
250	pci_set_drvdata(pdev, chip);
251
252	err = devm_request_irq(&pdev->dev, pdev->irq,
253	cb710_irq_handler, IRQF_SHARED, KBUILD_MODNAME, chip);
254	if (err)
255	return err;
256
257	do {
258	if (!ida_pre_get(&cb710_ida, GFP_KERNEL))
259	return -ENOMEM;
260
261	spin_lock_irqsave(&cb710_ida_lock, flags);
262	err = ida_get_new(&cb710_ida, &chip->platform_id);
263	spin_unlock_irqrestore(&cb710_ida_lock, flags);
264
265	if (err && err != -EAGAIN)
266	return err;
267	} while (err);
268
269
270	dev_info(&pdev->dev, "id %d, IO 0x%p, IRQ %d\n",
271	chip->platform_id, chip->iobase, pdev->irq);
272
273	if (val & CB710_SLOT_MMC) { /* MMC/SD slot */
274	err = cb710_register_slot(chip,
275	CB710_SLOT_MMC, 0x00, "cb710-mmc");
276	if (err)
277	return err;
278	}
279
280	if (val & CB710_SLOT_MS) { /* MemoryStick slot */
281	err = cb710_register_slot(chip,
282	CB710_SLOT_MS, 0x40, "cb710-ms");
283	if (err)
284	goto unreg_mmc;
285	}
286
287	if (val & CB710_SLOT_SM) { /* SmartMedia slot */
288	err = cb710_register_slot(chip,
289	CB710_SLOT_SM, 0x60, "cb710-sm");
290	if (err)
291	goto unreg_ms;
292	}
293
294	return 0;
295	unreg_ms:
296	cb710_unregister_slot(chip, CB710_SLOT_MS);
297	unreg_mmc:
298	cb710_unregister_slot(chip, CB710_SLOT_MMC);
299
300	#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
301	BUG_ON(atomic_read(&chip->slot_refs_count) != 0);
302	#endif
303	return err;
304	}
305
306	static void __devexit cb710_remove_one(struct pci_dev *pdev)
307	{
308	struct cb710_chip *chip = pci_get_drvdata(pdev);
309	unsigned long flags;
310
311	cb710_unregister_slot(chip, CB710_SLOT_SM);
312	cb710_unregister_slot(chip, CB710_SLOT_MS);
313	cb710_unregister_slot(chip, CB710_SLOT_MMC);
314	#ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
315	BUG_ON(atomic_read(&chip->slot_refs_count) != 0);
316	#endif
317
318	spin_lock_irqsave(&cb710_ida_lock, flags);
319	ida_remove(&cb710_ida, chip->platform_id);
320	spin_unlock_irqrestore(&cb710_ida_lock, flags);
321	}
322
323	static const struct pci_device_id cb710_pci_tbl[] = {
324	{ PCI_VENDOR_ID_ENE, PCI_DEVICE_ID_ENE_CB710_FLASH,
325	PCI_ANY_ID, PCI_ANY_ID, },
326	{ 0, }
327	};
328
329	static struct pci_driver cb710_driver = {
330	.name = KBUILD_MODNAME,
331	.id_table = cb710_pci_tbl,
332	.probe = cb710_probe,
333	.remove = __devexit_p(cb710_remove_one),
334	#ifdef CONFIG_PM
335	.suspend = cb710_suspend,
336	.resume = cb710_resume,
337	#endif
338	};
339
340	static int __init cb710_init_module(void)
341	{
342	return pci_register_driver(&cb710_driver);
343	}
344
345	static void __exit cb710_cleanup_module(void)
346	{
347	pci_unregister_driver(&cb710_driver);
348	ida_destroy(&cb710_ida);
349	}
350
351	module_init(cb710_init_module);
352	module_exit(cb710_cleanup_module);
353
354	MODULE_AUTHOR("Michał Mirosław <mirq-linux@rere.qmqm.pl>");
355	MODULE_DESCRIPTION("ENE CB710 memory card reader driver");
356	MODULE_LICENSE("GPL");
357	MODULE_DEVICE_TABLE(pci, cb710_pci_tbl);