[net-next-2.6.git] / drivers / telephony / ixj_pcmcia.c

#include "ixj-ver.h"

#include <linux/module.h>

#include <linux/init.h>
#include <linux/kernel.h>	/* printk() */
#include <linux/fs.h>		/* everything... */
#include <linux/errno.h>	/* error codes */
#include <linux/slab.h>

#include <pcmcia/cistpl.h>
#include <pcmcia/ds.h>

#include "ixj.h"

/*
 *	PCMCIA service support for Quicknet cards
 */
 

typedef struct ixj_info_t {
	int ndev;
	struct ixj *port;
} ixj_info_t;

static void ixj_detach(struct pcmcia_device *p_dev);
static int ixj_config(struct pcmcia_device * link);
static void ixj_cs_release(struct pcmcia_device * link);

static int ixj_probe(struct pcmcia_device *p_dev)
{
	dev_dbg(&p_dev->dev, "ixj_attach()\n");
	/* Create new ixj device */
	p_dev->priv = kzalloc(sizeof(struct ixj_info_t), GFP_KERNEL);
	if (!p_dev->priv) {
		return -ENOMEM;
	}

	return ixj_config(p_dev);
}

static void ixj_detach(struct pcmcia_device *link)
{
	dev_dbg(&link->dev, "ixj_detach\n");

	ixj_cs_release(link);

        kfree(link->priv);
}

static void ixj_get_serial(struct pcmcia_device * link, IXJ * j)
{
	char *str;
	int i, place;
	dev_dbg(&link->dev, "ixj_get_serial\n");

	str = link->prod_id[0];
	if (!str)
		goto failed;
	printk("%s", str);
	str = link->prod_id[1];
	if (!str)
		goto failed;
	printk(" %s", str);
	str = link->prod_id[2];
	if (!str)
		goto failed;
	place = 1;
	for (i = strlen(str) - 1; i >= 0; i--) {
		switch (str[i]) {
		case '0':
		case '1':
		case '2':
		case '3':
		case '4':
		case '5':
		case '6':
		case '7':
		case '8':
		case '9':
			j->serial += (str[i] - 48) * place;
			break;
		case 'A':
		case 'B':
		case 'C':
		case 'D':
		case 'E':
		case 'F':
			j->serial += (str[i] - 55) * place;
			break;
		case 'a':
		case 'b':
		case 'c':
		case 'd':
		case 'e':
		case 'f':
			j->serial += (str[i] - 87) * place;
			break;
		}
		place = place * 0x10;
	}
	str = link->prod_id[3];
	if (!str)
		goto failed;
	printk(" version %s\n", str);
failed:
	return;
}

static int ixj_config_check(struct pcmcia_device *p_dev, void *priv_data)
{
	p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
	p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
	p_dev->resource[1]->flags &= ~IO_DATA_PATH_WIDTH;
	p_dev->resource[1]->flags |= IO_DATA_PATH_WIDTH_8;
	p_dev->io_lines = 3;

	return pcmcia_request_io(p_dev);
}

static int ixj_config(struct pcmcia_device * link)
{
	IXJ *j;
	ixj_info_t *info;

	info = link->priv;
	dev_dbg(&link->dev, "ixj_config\n");

	link->config_flags = CONF_AUTO_SET_IO;

	if (pcmcia_loop_config(link, ixj_config_check, NULL))
		goto failed;

	if (pcmcia_enable_device(link))
		goto failed;

	/*
 	 *	Register the card with the core.
	 */
	j = ixj_pcmcia_probe(link->resource[0]->start,
			     link->resource[0]->start + 0x10);

	info->ndev = 1;
	ixj_get_serial(link, j);
	return 0;

failed:
	ixj_cs_release(link);
	return -ENODEV;
}

static void ixj_cs_release(struct pcmcia_device *link)
{
	ixj_info_t *info = link->priv;
	dev_dbg(&link->dev, "ixj_cs_release\n");
	info->ndev = 0;
	pcmcia_disable_device(link);
}

static struct pcmcia_device_id ixj_ids[] = {
	PCMCIA_DEVICE_MANF_CARD(0x0257, 0x0600),
	PCMCIA_DEVICE_NULL
};
MODULE_DEVICE_TABLE(pcmcia, ixj_ids);

static struct pcmcia_driver ixj_driver = {
	.owner		= THIS_MODULE,
	.name		= "ixj_cs",
	.probe		= ixj_probe,
	.remove		= ixj_detach,
	.id_table	= ixj_ids,
};

static int __init ixj_pcmcia_init(void)
{
	return pcmcia_register_driver(&ixj_driver);
}

static void ixj_pcmcia_exit(void)
{
	pcmcia_unregister_driver(&ixj_driver);
}

module_init(ixj_pcmcia_init);
module_exit(ixj_pcmcia_exit);

MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4 LT	1	#include "ixj-ver.h"
	2
	3	#include <linux/module.h>
	4
	5	#include <linux/init.h>
1da177e4 LT	6	#include <linux/kernel.h> /* printk() */
	7	#include <linux/fs.h> /* everything... */
	8	#include <linux/errno.h> /* error codes */
	9	#include <linux/slab.h>
	10
1da177e4 LT	11	#include <pcmcia/cistpl.h>
	12	#include <pcmcia/ds.h>
	13
	14	#include "ixj.h"
	15
	16	/*
	17	* PCMCIA service support for Quicknet cards
	18	*/
	19
1da177e4 LT	20
	21	typedef struct ixj_info_t {
	22	int ndev;
1da177e4 LT	23	struct ixj *port;
	24	} ixj_info_t;
	25
cc3b4866	26	static void ixj_detach(struct pcmcia_device *p_dev);
15b99ac1	27	static int ixj_config(struct pcmcia_device * link);
fba395ee	28	static void ixj_cs_release(struct pcmcia_device * link);
1da177e4	29
15b99ac1	30	static int ixj_probe(struct pcmcia_device *p_dev)
1da177e4	31	{
9b44de20	32	dev_dbg(&p_dev->dev, "ixj_attach()\n");
1da177e4	33	/* Create new ixj device */
dd00cc48	34	p_dev->priv = kzalloc(sizeof(struct ixj_info_t), GFP_KERNEL);
fd238232	35	if (!p_dev->priv) {
f8cfa618	36	return -ENOMEM;
1da177e4	37	}
f8cfa618	38
15b99ac1	39	return ixj_config(p_dev);
1da177e4 LT	40	}
1da177e4 LT	41
fba395ee	42	static void ixj_detach(struct pcmcia_device *link)
1da177e4	43	{
9b44de20	44	dev_dbg(&link->dev, "ixj_detach\n");
b4635811	45
e2d40963	46	ixj_cs_release(link);
cc3b4866	47
1da177e4	48	kfree(link->priv);
1da177e4 LT	49	}
1da177e4 LT	50
fba395ee	51	static void ixj_get_serial(struct pcmcia_device * link, IXJ * j)
1da177e4	52	{
1da177e4	53	char *str;
a9606fd3	54	int i, place;
9b44de20	55	dev_dbg(&link->dev, "ixj_get_serial\n");
a9606fd3 DB	56
	57	str = link->prod_id[0];
	58	if (!str)
9b44de20	59	goto failed;
1da177e4	60	printk("%s", str);
a9606fd3 DB	61	str = link->prod_id[1];
a9606fd3 DB	62	if (!str)
9b44de20	63	goto failed;
1da177e4	64	printk(" %s", str);
a9606fd3 DB	65	str = link->prod_id[2];
a9606fd3 DB	66	if (!str)
9b44de20	67	goto failed;
1da177e4 LT	68	place = 1;
	69	for (i = strlen(str) - 1; i >= 0; i--) {
	70	switch (str[i]) {
	71	case '0':
	72	case '1':
	73	case '2':
	74	case '3':
	75	case '4':
	76	case '5':
	77	case '6':
	78	case '7':
	79	case '8':
	80	case '9':
	81	j->serial += (str[i] - 48) * place;
	82	break;
	83	case 'A':
	84	case 'B':
	85	case 'C':
	86	case 'D':
	87	case 'E':
	88	case 'F':
	89	j->serial += (str[i] - 55) * place;
	90	break;
	91	case 'a':
	92	case 'b':
	93	case 'c':
	94	case 'd':
	95	case 'e':
	96	case 'f':
	97	j->serial += (str[i] - 87) * place;
	98	break;
	99	}
	100	place = place * 0x10;
	101	}
a9606fd3 DB	102	str = link->prod_id[3];
a9606fd3 DB	103	if (!str)
9b44de20	104	goto failed;
1da177e4	105	printk(" version %s\n", str);
9b44de20	106	failed:
1da177e4 LT	107	return;
	108	}
	109
00990e7c	110	static int ixj_config_check(struct pcmcia_device p_dev, void priv_data)
84e2d340	111	{
00990e7c DB	112	p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
	113	p_dev->resource[0]->flags \|= IO_DATA_PATH_WIDTH_8;
	114	p_dev->resource[1]->flags &= ~IO_DATA_PATH_WIDTH;
	115	p_dev->resource[1]->flags \|= IO_DATA_PATH_WIDTH_8;
	116	p_dev->io_lines = 3;
	117
	118	return pcmcia_request_io(p_dev);
84e2d340 DB	119	}
84e2d340 DB	120
15b99ac1	121	static int ixj_config(struct pcmcia_device * link)
1da177e4 LT	122	{
1da177e4 LT	123	IXJ *j;
1da177e4	124	ixj_info_t *info;
84e2d340	125
1da177e4	126	info = link->priv;
9b44de20	127	dev_dbg(&link->dev, "ixj_config\n");
1da177e4	128
00990e7c DB	129	link->config_flags = CONF_AUTO_SET_IO;
	130
	131	if (pcmcia_loop_config(link, ixj_config_check, NULL))
9b44de20	132	goto failed;
84e2d340	133
1ac71e5a	134	if (pcmcia_enable_device(link))
9b44de20	135	goto failed;
1da177e4 LT	136
	137	/*
	138	* Register the card with the core.
84e2d340	139	*/
9a017a91 DB	140	j = ixj_pcmcia_probe(link->resource[0]->start,
9a017a91 DB	141	link->resource[0]->start + 0x10);
1da177e4 LT	142
1da177e4 LT	143	info->ndev = 1;
1da177e4	144	ixj_get_serial(link, j);
15b99ac1	145	return 0;
84e2d340	146
9b44de20	147	failed:
1da177e4	148	ixj_cs_release(link);
15b99ac1	149	return -ENODEV;
1da177e4 LT	150	}
1da177e4 LT	151
fba395ee	152	static void ixj_cs_release(struct pcmcia_device *link)
1da177e4 LT	153	{
1da177e4 LT	154	ixj_info_t *info = link->priv;
9b44de20	155	dev_dbg(&link->dev, "ixj_cs_release\n");
1da177e4	156	info->ndev = 0;
fba395ee	157	pcmcia_disable_device(link);
1da177e4 LT	158	}
1da177e4 LT	159
07081273 DB	160	static struct pcmcia_device_id ixj_ids[] = {
	161	PCMCIA_DEVICE_MANF_CARD(0x0257, 0x0600),
	162	PCMCIA_DEVICE_NULL
	163	};
	164	MODULE_DEVICE_TABLE(pcmcia, ixj_ids);
	165
1da177e4 LT	166	static struct pcmcia_driver ixj_driver = {
1da177e4 LT	167	.owner = THIS_MODULE,
2e9b981a	168	.name = "ixj_cs",
15b99ac1	169	.probe = ixj_probe,
cc3b4866	170	.remove = ixj_detach,
07081273	171	.id_table = ixj_ids,
1da177e4 LT	172	};
	173
	174	static int __init ixj_pcmcia_init(void)
	175	{
	176	return pcmcia_register_driver(&ixj_driver);
	177	}
	178
	179	static void ixj_pcmcia_exit(void)
	180	{
	181	pcmcia_unregister_driver(&ixj_driver);
1da177e4 LT	182	}
	183
	184	module_init(ixj_pcmcia_init);
	185	module_exit(ixj_pcmcia_exit);
	186
	187	MODULE_LICENSE("GPL");