[deliverable/linux.git] / drivers / misc / tifm_core.c

/*
 *  tifm_core.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/slab.h>
#include <linux/init.h>
#include <linux/idr.h>
#include <linux/module.h>

#define DRIVER_NAME "tifm_core"
#define DRIVER_VERSION "0.8"

static struct workqueue_struct *workqueue;
static DEFINE_IDR(tifm_adapter_idr);
static DEFINE_SPINLOCK(tifm_adapter_lock);

static const char *tifm_media_type_name(unsigned char type, unsigned char nt)
{
	const char *card_type_name[3][3] = {
		{ "SmartMedia/xD", "MemoryStick", "MMC/SD" },
		{ "XD", "MS", "SD"},
		{ "xd", "ms", "sd"}
	};

	if (nt > 2 || type < 1 || type > 3)
		return NULL;
	return card_type_name[nt][type - 1];
}

static int tifm_dev_match(struct tifm_dev *sock, struct tifm_device_id *id)
{
	if (sock->type == id->type)
		return 1;
	return 0;
}

static int tifm_bus_match(struct device *dev, struct device_driver *drv)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	struct tifm_driver *fm_drv = container_of(drv, struct tifm_driver,
						  driver);
	struct tifm_device_id *ids = fm_drv->id_table;

	if (ids) {
		while (ids->type) {
			if (tifm_dev_match(sock, ids))
				return 1;
			++ids;
		}
	}
	return 0;
}

static int tifm_uevent(struct device *dev, struct kobj_uevent_env *env)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);

	if (add_uevent_var(env, "TIFM_CARD_TYPE=%s", tifm_media_type_name(sock->type, 1)))
		return -ENOMEM;

	return 0;
}

static int tifm_device_probe(struct device *dev)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
					       driver);
	int rc = -ENODEV;

	get_device(dev);
	if (dev->driver && drv->probe) {
		rc = drv->probe(sock);
		if (!rc)
			return 0;
	}
	put_device(dev);
	return rc;
}

static void tifm_dummy_event(struct tifm_dev *sock)
{
	return;
}

static int tifm_device_remove(struct device *dev)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
					       driver);

	if (dev->driver && drv->remove) {
		sock->card_event = tifm_dummy_event;
		sock->data_event = tifm_dummy_event;
		drv->remove(sock);
		sock->dev.driver = NULL;
	}

	put_device(dev);
	return 0;
}

#ifdef CONFIG_PM

static int tifm_device_suspend(struct device *dev, pm_message_t state)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
					       driver);

	if (dev->driver && drv->suspend)
		return drv->suspend(sock, state);
	return 0;
}

static int tifm_device_resume(struct device *dev)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
					       driver);

	if (dev->driver && drv->resume)
		return drv->resume(sock);
	return 0;
}

#else

#define tifm_device_suspend NULL
#define tifm_device_resume NULL

#endif /* CONFIG_PM */

static ssize_t type_show(struct device *dev, struct device_attribute *attr,
			 char *buf)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	return sprintf(buf, "%x", sock->type);
}
static DEVICE_ATTR_RO(type);

static struct attribute *tifm_dev_attrs[] = {
	&dev_attr_type.attr,
	NULL,
};
ATTRIBUTE_GROUPS(tifm_dev);

static struct bus_type tifm_bus_type = {
	.name      = "tifm",
	.dev_groups = tifm_dev_groups,
	.match     = tifm_bus_match,
	.uevent    = tifm_uevent,
	.probe     = tifm_device_probe,
	.remove    = tifm_device_remove,
	.suspend   = tifm_device_suspend,
	.resume    = tifm_device_resume
};

static void tifm_free(struct device *dev)
{
	struct tifm_adapter *fm = container_of(dev, struct tifm_adapter, dev);

	kfree(fm);
}

static struct class tifm_adapter_class = {
	.name    = "tifm_adapter",
	.dev_release = tifm_free
};

struct tifm_adapter *tifm_alloc_adapter(unsigned int num_sockets,
					struct device *dev)
{
	struct tifm_adapter *fm;

	fm = kzalloc(sizeof(struct tifm_adapter)
		     + sizeof(struct tifm_dev*) * num_sockets, GFP_KERNEL);
	if (fm) {
		fm->dev.class = &tifm_adapter_class;
		fm->dev.parent = dev;
		device_initialize(&fm->dev);
		spin_lock_init(&fm->lock);
		fm->num_sockets = num_sockets;
	}
	return fm;
}
EXPORT_SYMBOL(tifm_alloc_adapter);

int tifm_add_adapter(struct tifm_adapter *fm)
{
	int rc;

	idr_preload(GFP_KERNEL);
	spin_lock(&tifm_adapter_lock);
	rc = idr_alloc(&tifm_adapter_idr, fm, 0, 0, GFP_NOWAIT);
	if (rc >= 0)
		fm->id = rc;
	spin_unlock(&tifm_adapter_lock);
	idr_preload_end();
	if (rc < 0)
		return rc;

	dev_set_name(&fm->dev, "tifm%u", fm->id);
	rc = device_add(&fm->dev);
	if (rc) {
		spin_lock(&tifm_adapter_lock);
		idr_remove(&tifm_adapter_idr, fm->id);
		spin_unlock(&tifm_adapter_lock);
	}

	return rc;
}
EXPORT_SYMBOL(tifm_add_adapter);

void tifm_remove_adapter(struct tifm_adapter *fm)
{
	unsigned int cnt;

	flush_workqueue(workqueue);
	for (cnt = 0; cnt < fm->num_sockets; ++cnt) {
		if (fm->sockets[cnt])
			device_unregister(&fm->sockets[cnt]->dev);
	}

	spin_lock(&tifm_adapter_lock);
	idr_remove(&tifm_adapter_idr, fm->id);
	spin_unlock(&tifm_adapter_lock);
	device_del(&fm->dev);
}
EXPORT_SYMBOL(tifm_remove_adapter);

void tifm_free_adapter(struct tifm_adapter *fm)
{
	put_device(&fm->dev);
}
EXPORT_SYMBOL(tifm_free_adapter);

void tifm_free_device(struct device *dev)
{
	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	kfree(sock);
}
EXPORT_SYMBOL(tifm_free_device);

struct tifm_dev *tifm_alloc_device(struct tifm_adapter *fm, unsigned int id,
				   unsigned char type)
{
	struct tifm_dev *sock = NULL;

	if (!tifm_media_type_name(type, 0))
		return sock;

	sock = kzalloc(sizeof(struct tifm_dev), GFP_KERNEL);
	if (sock) {
		spin_lock_init(&sock->lock);
		sock->type = type;
		sock->socket_id = id;
		sock->card_event = tifm_dummy_event;
		sock->data_event = tifm_dummy_event;

		sock->dev.parent = fm->dev.parent;
		sock->dev.bus = &tifm_bus_type;
		sock->dev.dma_mask = fm->dev.parent->dma_mask;
		sock->dev.release = tifm_free_device;

		dev_set_name(&sock->dev, "tifm_%s%u:%u",
			     tifm_media_type_name(type, 2), fm->id, id);
		printk(KERN_INFO DRIVER_NAME
		       ": %s card detected in socket %u:%u\n",
		       tifm_media_type_name(type, 0), fm->id, id);
	}
	return sock;
}
EXPORT_SYMBOL(tifm_alloc_device);

void tifm_eject(struct tifm_dev *sock)
{
	struct tifm_adapter *fm = dev_get_drvdata(sock->dev.parent);
	fm->eject(fm, sock);
}
EXPORT_SYMBOL(tifm_eject);

int tifm_has_ms_pif(struct tifm_dev *sock)
{
	struct tifm_adapter *fm = dev_get_drvdata(sock->dev.parent);
	return fm->has_ms_pif(fm, sock);
}
EXPORT_SYMBOL(tifm_has_ms_pif);

int tifm_map_sg(struct tifm_dev *sock, struct scatterlist *sg, int nents,
		int direction)
{
	return pci_map_sg(to_pci_dev(sock->dev.parent), sg, nents, direction);
}
EXPORT_SYMBOL(tifm_map_sg);

void tifm_unmap_sg(struct tifm_dev *sock, struct scatterlist *sg, int nents,
		   int direction)
{
	pci_unmap_sg(to_pci_dev(sock->dev.parent), sg, nents, direction);
}
EXPORT_SYMBOL(tifm_unmap_sg);

void tifm_queue_work(struct work_struct *work)
{
	queue_work(workqueue, work);
}
EXPORT_SYMBOL(tifm_queue_work);

int tifm_register_driver(struct tifm_driver *drv)
{
	drv->driver.bus = &tifm_bus_type;

	return driver_register(&drv->driver);
}
EXPORT_SYMBOL(tifm_register_driver);

void tifm_unregister_driver(struct tifm_driver *drv)
{
	driver_unregister(&drv->driver);
}
EXPORT_SYMBOL(tifm_unregister_driver);

static int __init tifm_init(void)
{
	int rc;

	workqueue = create_freezable_workqueue("tifm");
	if (!workqueue)
		return -ENOMEM;

	rc = bus_register(&tifm_bus_type);

	if (rc)
		goto err_out_wq;

	rc = class_register(&tifm_adapter_class);
	if (!rc)
		return 0;

	bus_unregister(&tifm_bus_type);

err_out_wq:
	destroy_workqueue(workqueue);

	return rc;
}

static void __exit tifm_exit(void)
{
	class_unregister(&tifm_adapter_class);
	bus_unregister(&tifm_bus_type);
	destroy_workqueue(workqueue);
}

subsys_initcall(tifm_init);
module_exit(tifm_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Alex Dubov");
MODULE_DESCRIPTION("TI FlashMedia core driver");
MODULE_LICENSE("GPL");
MODULE_VERSION(DRIVER_VERSION);
Commit	Line	Data
	1	/*
	2	* tifm_core.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/slab.h>
	14	#include <linux/init.h>
	15	#include <linux/idr.h>
	16	#include <linux/module.h>
	17
	18	#define DRIVER_NAME "tifm_core"
	19	#define DRIVER_VERSION "0.8"
	20
	21	static struct workqueue_struct *workqueue;
	22	static DEFINE_IDR(tifm_adapter_idr);
	23	static DEFINE_SPINLOCK(tifm_adapter_lock);
	24
	25	static const char *tifm_media_type_name(unsigned char type, unsigned char nt)
	26	{
	27	const char *card_type_name[3][3] = {
	28	{ "SmartMedia/xD", "MemoryStick", "MMC/SD" },
	29	{ "XD", "MS", "SD"},
	30	{ "xd", "ms", "sd"}
	31	};
	32
	33	if (nt > 2 \|\| type < 1 \|\| type > 3)
	34	return NULL;
	35	return card_type_name[nt][type - 1];
	36	}
	37
	38	static int tifm_dev_match(struct tifm_dev sock, struct tifm_device_id id)
	39	{
	40	if (sock->type == id->type)
	41	return 1;
	42	return 0;
	43	}
	44
	45	static int tifm_bus_match(struct device dev, struct device_driver drv)
	46	{
	47	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	48	struct tifm_driver *fm_drv = container_of(drv, struct tifm_driver,
	49	driver);
	50	struct tifm_device_id *ids = fm_drv->id_table;
	51
	52	if (ids) {
	53	while (ids->type) {
	54	if (tifm_dev_match(sock, ids))
	55	return 1;
	56	++ids;
	57	}
	58	}
	59	return 0;
	60	}
	61
	62	static int tifm_uevent(struct device dev, struct kobj_uevent_env env)
	63	{
	64	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	65
	66	if (add_uevent_var(env, "TIFM_CARD_TYPE=%s", tifm_media_type_name(sock->type, 1)))
	67	return -ENOMEM;
	68
	69	return 0;
	70	}
	71
	72	static int tifm_device_probe(struct device *dev)
	73	{
	74	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	75	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
	76	driver);
	77	int rc = -ENODEV;
	78
	79	get_device(dev);
	80	if (dev->driver && drv->probe) {
	81	rc = drv->probe(sock);
	82	if (!rc)
	83	return 0;
	84	}
	85	put_device(dev);
	86	return rc;
	87	}
	88
	89	static void tifm_dummy_event(struct tifm_dev *sock)
	90	{
	91	return;
	92	}
	93
	94	static int tifm_device_remove(struct device *dev)
	95	{
	96	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	97	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
	98	driver);
	99
	100	if (dev->driver && drv->remove) {
	101	sock->card_event = tifm_dummy_event;
	102	sock->data_event = tifm_dummy_event;
	103	drv->remove(sock);
	104	sock->dev.driver = NULL;
	105	}
	106
	107	put_device(dev);
	108	return 0;
	109	}
	110
	111	#ifdef CONFIG_PM
	112
	113	static int tifm_device_suspend(struct device *dev, pm_message_t state)
	114	{
	115	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	116	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
	117	driver);
	118
	119	if (dev->driver && drv->suspend)
	120	return drv->suspend(sock, state);
	121	return 0;
	122	}
	123
	124	static int tifm_device_resume(struct device *dev)
	125	{
	126	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	127	struct tifm_driver *drv = container_of(dev->driver, struct tifm_driver,
	128	driver);
	129
	130	if (dev->driver && drv->resume)
	131	return drv->resume(sock);
	132	return 0;
	133	}
	134
	135	#else
	136
	137	#define tifm_device_suspend NULL
	138	#define tifm_device_resume NULL
	139
	140	#endif /* CONFIG_PM */
	141
	142	static ssize_t type_show(struct device dev, struct device_attribute attr,
	143	char *buf)
	144	{
	145	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	146	return sprintf(buf, "%x", sock->type);
	147	}
	148	static DEVICE_ATTR_RO(type);
	149
	150	static struct attribute *tifm_dev_attrs[] = {
	151	&dev_attr_type.attr,
	152	NULL,
	153	};
	154	ATTRIBUTE_GROUPS(tifm_dev);
	155
	156	static struct bus_type tifm_bus_type = {
	157	.name = "tifm",
	158	.dev_groups = tifm_dev_groups,
	159	.match = tifm_bus_match,
	160	.uevent = tifm_uevent,
	161	.probe = tifm_device_probe,
	162	.remove = tifm_device_remove,
	163	.suspend = tifm_device_suspend,
	164	.resume = tifm_device_resume
	165	};
	166
	167	static void tifm_free(struct device *dev)
	168	{
	169	struct tifm_adapter *fm = container_of(dev, struct tifm_adapter, dev);
	170
	171	kfree(fm);
	172	}
	173
	174	static struct class tifm_adapter_class = {
	175	.name = "tifm_adapter",
	176	.dev_release = tifm_free
	177	};
	178
	179	struct tifm_adapter *tifm_alloc_adapter(unsigned int num_sockets,
	180	struct device *dev)
	181	{
	182	struct tifm_adapter *fm;
	183
	184	fm = kzalloc(sizeof(struct tifm_adapter)
	185	+ sizeof(struct tifm_dev) num_sockets, GFP_KERNEL);
	186	if (fm) {
	187	fm->dev.class = &tifm_adapter_class;
	188	fm->dev.parent = dev;
	189	device_initialize(&fm->dev);
	190	spin_lock_init(&fm->lock);
	191	fm->num_sockets = num_sockets;
	192	}
	193	return fm;
	194	}
	195	EXPORT_SYMBOL(tifm_alloc_adapter);
	196
	197	int tifm_add_adapter(struct tifm_adapter *fm)
	198	{
	199	int rc;
	200
	201	idr_preload(GFP_KERNEL);
	202	spin_lock(&tifm_adapter_lock);
	203	rc = idr_alloc(&tifm_adapter_idr, fm, 0, 0, GFP_NOWAIT);
	204	if (rc >= 0)
	205	fm->id = rc;
	206	spin_unlock(&tifm_adapter_lock);
	207	idr_preload_end();
	208	if (rc < 0)
	209	return rc;
	210
	211	dev_set_name(&fm->dev, "tifm%u", fm->id);
	212	rc = device_add(&fm->dev);
	213	if (rc) {
	214	spin_lock(&tifm_adapter_lock);
	215	idr_remove(&tifm_adapter_idr, fm->id);
	216	spin_unlock(&tifm_adapter_lock);
	217	}
	218
	219	return rc;
	220	}
	221	EXPORT_SYMBOL(tifm_add_adapter);
	222
	223	void tifm_remove_adapter(struct tifm_adapter *fm)
	224	{
	225	unsigned int cnt;
	226
	227	flush_workqueue(workqueue);
	228	for (cnt = 0; cnt < fm->num_sockets; ++cnt) {
	229	if (fm->sockets[cnt])
	230	device_unregister(&fm->sockets[cnt]->dev);
	231	}
	232
	233	spin_lock(&tifm_adapter_lock);
	234	idr_remove(&tifm_adapter_idr, fm->id);
	235	spin_unlock(&tifm_adapter_lock);
	236	device_del(&fm->dev);
	237	}
	238	EXPORT_SYMBOL(tifm_remove_adapter);
	239
	240	void tifm_free_adapter(struct tifm_adapter *fm)
	241	{
	242	put_device(&fm->dev);
	243	}
	244	EXPORT_SYMBOL(tifm_free_adapter);
	245
	246	void tifm_free_device(struct device *dev)
	247	{
	248	struct tifm_dev *sock = container_of(dev, struct tifm_dev, dev);
	249	kfree(sock);
	250	}
	251	EXPORT_SYMBOL(tifm_free_device);
	252
	253	struct tifm_dev tifm_alloc_device(struct tifm_adapter fm, unsigned int id,
	254	unsigned char type)
	255	{
	256	struct tifm_dev *sock = NULL;
	257
	258	if (!tifm_media_type_name(type, 0))
	259	return sock;
	260
	261	sock = kzalloc(sizeof(struct tifm_dev), GFP_KERNEL);
	262	if (sock) {
	263	spin_lock_init(&sock->lock);
	264	sock->type = type;
	265	sock->socket_id = id;
	266	sock->card_event = tifm_dummy_event;
	267	sock->data_event = tifm_dummy_event;
	268
	269	sock->dev.parent = fm->dev.parent;
	270	sock->dev.bus = &tifm_bus_type;
	271	sock->dev.dma_mask = fm->dev.parent->dma_mask;
	272	sock->dev.release = tifm_free_device;
	273
	274	dev_set_name(&sock->dev, "tifm_%s%u:%u",
	275	tifm_media_type_name(type, 2), fm->id, id);
	276	printk(KERN_INFO DRIVER_NAME
	277	": %s card detected in socket %u:%u\n",
	278	tifm_media_type_name(type, 0), fm->id, id);
	279	}
	280	return sock;
	281	}
	282	EXPORT_SYMBOL(tifm_alloc_device);
	283
	284	void tifm_eject(struct tifm_dev *sock)
	285	{
	286	struct tifm_adapter *fm = dev_get_drvdata(sock->dev.parent);
	287	fm->eject(fm, sock);
	288	}
	289	EXPORT_SYMBOL(tifm_eject);
	290
	291	int tifm_has_ms_pif(struct tifm_dev *sock)
	292	{
	293	struct tifm_adapter *fm = dev_get_drvdata(sock->dev.parent);
	294	return fm->has_ms_pif(fm, sock);
	295	}
	296	EXPORT_SYMBOL(tifm_has_ms_pif);
	297
	298	int tifm_map_sg(struct tifm_dev sock, struct scatterlist sg, int nents,
	299	int direction)
	300	{
	301	return pci_map_sg(to_pci_dev(sock->dev.parent), sg, nents, direction);
	302	}
	303	EXPORT_SYMBOL(tifm_map_sg);
	304
	305	void tifm_unmap_sg(struct tifm_dev sock, struct scatterlist sg, int nents,
	306	int direction)
	307	{
	308	pci_unmap_sg(to_pci_dev(sock->dev.parent), sg, nents, direction);
	309	}
	310	EXPORT_SYMBOL(tifm_unmap_sg);
	311
	312	void tifm_queue_work(struct work_struct *work)
	313	{
	314	queue_work(workqueue, work);
	315	}
	316	EXPORT_SYMBOL(tifm_queue_work);
	317
	318	int tifm_register_driver(struct tifm_driver *drv)
	319	{
	320	drv->driver.bus = &tifm_bus_type;
	321
	322	return driver_register(&drv->driver);
	323	}
	324	EXPORT_SYMBOL(tifm_register_driver);
	325
	326	void tifm_unregister_driver(struct tifm_driver *drv)
	327	{
	328	driver_unregister(&drv->driver);
	329	}
	330	EXPORT_SYMBOL(tifm_unregister_driver);
	331
	332	static int __init tifm_init(void)
	333	{
	334	int rc;
	335
	336	workqueue = create_freezable_workqueue("tifm");
	337	if (!workqueue)
	338	return -ENOMEM;
	339
	340	rc = bus_register(&tifm_bus_type);
	341
	342	if (rc)
	343	goto err_out_wq;
	344
	345	rc = class_register(&tifm_adapter_class);
	346	if (!rc)
	347	return 0;
	348
	349	bus_unregister(&tifm_bus_type);
	350
	351	err_out_wq:
	352	destroy_workqueue(workqueue);
	353
	354	return rc;
	355	}
	356
	357	static void __exit tifm_exit(void)
	358	{
	359	class_unregister(&tifm_adapter_class);
	360	bus_unregister(&tifm_bus_type);
	361	destroy_workqueue(workqueue);
	362	}
	363
	364	subsys_initcall(tifm_init);
	365	module_exit(tifm_exit);
	366
	367	MODULE_LICENSE("GPL");
	368	MODULE_AUTHOR("Alex Dubov");
	369	MODULE_DESCRIPTION("TI FlashMedia core driver");
	370	MODULE_LICENSE("GPL");
	371	MODULE_VERSION(DRIVER_VERSION);