[deliverable/linux.git] / drivers / isdn / hisax / st5481_init.c

/*
 * Driver for ST5481 USB ISDN modem
 *
 * Author       Frode Isaksen
 * Copyright    2001 by Frode Isaksen      <fisaksen@bewan.com>
 *              2001 by Kai Germaschewski  <kai.germaschewski@gmx.de>
 *
 * This software may be used and distributed according to the terms
 * of the GNU General Public License, incorporated herein by reference.
 *
 */

/*
 * TODO:
 *
 * b layer1 delay?
 * hotplug / unregister issues
 * mod_inc/dec_use_count
 * unify parts of d/b channel usb handling
 * file header
 * avoid copy to isoc buffer?
 * improve usb delay?
 * merge l1 state machines?
 * clean up debug
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/usb.h>
#include <linux/slab.h>
#include "st5481.h"

MODULE_DESCRIPTION("ISDN4Linux: driver for ST5481 USB ISDN adapter");
MODULE_AUTHOR("Frode Isaksen");
MODULE_LICENSE("GPL");

static int protocol = 2;       /* EURO-ISDN Default */
module_param(protocol, int, 0);

static int number_of_leds = 2;       /* 2 LEDs on the adpater default */
module_param(number_of_leds, int, 0);

#ifdef CONFIG_HISAX_DEBUG
static int debug = 0;
module_param(debug, int, 0);
#endif
int st5481_debug;

/* ======================================================================
 * registration/deregistration with the USB layer
 */

/*
 * This function will be called when the adapter is plugged
 * into the USB bus.
 */
static int probe_st5481(struct usb_interface *intf,
			const struct usb_device_id *id)
{
	struct usb_device *dev = interface_to_usbdev(intf);
	struct st5481_adapter *adapter;
	struct hisax_b_if *b_if[2];
	int retval, i;

	printk(KERN_INFO "st541: found adapter VendorId %04x, ProductId %04x, LEDs %d\n",
	       le16_to_cpu(dev->descriptor.idVendor),
	       le16_to_cpu(dev->descriptor.idProduct),
	       number_of_leds);

	adapter = kzalloc(sizeof(struct st5481_adapter), GFP_KERNEL);
	if (!adapter)
		return -ENOMEM;

	adapter->number_of_leds = number_of_leds;
	adapter->usb_dev = dev;

	adapter->hisax_d_if.owner = THIS_MODULE;
	adapter->hisax_d_if.ifc.priv = adapter;
	adapter->hisax_d_if.ifc.l2l1 = st5481_d_l2l1;

	for (i = 0; i < 2; i++) {
		adapter->bcs[i].adapter = adapter;
		adapter->bcs[i].channel = i;
		adapter->bcs[i].b_if.ifc.priv = &adapter->bcs[i];
		adapter->bcs[i].b_if.ifc.l2l1 = st5481_b_l2l1;
	}

	retval = st5481_setup_usb(adapter);
	if (retval < 0)
		goto err;

	retval = st5481_setup_d(adapter);
	if (retval < 0)
		goto err_usb;

	retval = st5481_setup_b(&adapter->bcs[0]);
	if (retval < 0)
		goto err_d;

	retval = st5481_setup_b(&adapter->bcs[1]);
	if (retval < 0)
		goto err_b;

	for (i = 0; i < 2; i++)
		b_if[i] = &adapter->bcs[i].b_if;

	if (hisax_register(&adapter->hisax_d_if, b_if, "st5481_usb",
			   protocol) != 0)
		goto err_b1;

	st5481_start(adapter);

	usb_set_intfdata(intf, adapter);
	return 0;

err_b1:
	st5481_release_b(&adapter->bcs[1]);
err_b:
	st5481_release_b(&adapter->bcs[0]);
err_d:
	st5481_release_d(adapter);
err_usb:
	st5481_release_usb(adapter);
err:
	kfree(adapter);
	return -EIO;
}

/*
 * This function will be called when the adapter is removed
 * from the USB bus.
 */
static void disconnect_st5481(struct usb_interface *intf)
{
	struct st5481_adapter *adapter = usb_get_intfdata(intf);

	DBG(1, "");

	usb_set_intfdata(intf, NULL);
	if (!adapter)
		return;

	st5481_stop(adapter);
	st5481_release_b(&adapter->bcs[1]);
	st5481_release_b(&adapter->bcs[0]);
	st5481_release_d(adapter);
	// we would actually better wait for completion of outstanding urbs
	mdelay(2);
	st5481_release_usb(adapter);

	hisax_unregister(&adapter->hisax_d_if);

	kfree(adapter);
}

/*
 * The last 4 bits in the Product Id is set with 4 pins on the chip.
 */
static struct usb_device_id st5481_ids[] = {
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x0) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x1) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x2) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x3) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x4) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x5) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x6) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x7) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x8) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x9) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xA) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xB) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xC) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xD) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xE) },
	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xF) },
	{ }
};
MODULE_DEVICE_TABLE(usb, st5481_ids);

static struct usb_driver st5481_usb_driver = {
	.name =		"st5481_usb",
	.probe =	probe_st5481,
	.disconnect =	disconnect_st5481,
	.id_table =	st5481_ids,
};

static int __init st5481_usb_init(void)
{
	int retval;

#ifdef CONFIG_HISAX_DEBUG
	st5481_debug = debug;
#endif

	printk(KERN_INFO "hisax_st5481: ST5481 USB ISDN driver $Revision: 2.4.2.3 $\n");

	retval = st5481_d_init();
	if (retval < 0)
		goto out;

	retval = usb_register(&st5481_usb_driver);
	if (retval < 0)
		goto out_d_exit;

	return 0;

out_d_exit:
	st5481_d_exit();
out:
	return retval;
}

static void __exit st5481_usb_exit(void)
{
	usb_deregister(&st5481_usb_driver);
	st5481_d_exit();
}

module_init(st5481_usb_init);
module_exit(st5481_usb_exit);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Driver for ST5481 USB ISDN modem
	3	*
	4	* Author Frode Isaksen
	5	* Copyright 2001 by Frode Isaksen <fisaksen@bewan.com>
	6	* 2001 by Kai Germaschewski <kai.germaschewski@gmx.de>
475be4d8	7	*
1da177e4 LT	8	* This software may be used and distributed according to the terms
	9	* of the GNU General Public License, incorporated herein by reference.
	10	*
	11	*/
	12
475be4d8	13	/*
1da177e4 LT	14	* TODO:
	15	*
	16	* b layer1 delay?
	17	* hotplug / unregister issues
	18	* mod_inc/dec_use_count
	19	* unify parts of d/b channel usb handling
	20	* file header
	21	* avoid copy to isoc buffer?
	22	* improve usb delay?
	23	* merge l1 state machines?
	24	* clean up debug
	25	*/
	26
1da177e4 LT	27	#include <linux/module.h>
	28	#include <linux/init.h>
	29	#include <linux/usb.h>
	30	#include <linux/slab.h>
	31	#include "st5481.h"
	32
	33	MODULE_DESCRIPTION("ISDN4Linux: driver for ST5481 USB ISDN adapter");
	34	MODULE_AUTHOR("Frode Isaksen");
	35	MODULE_LICENSE("GPL");
	36
	37	static int protocol = 2; /* EURO-ISDN Default */
	38	module_param(protocol, int, 0);
	39
	40	static int number_of_leds = 2; /* 2 LEDs on the adpater default */
	41	module_param(number_of_leds, int, 0);
	42
	43	#ifdef CONFIG_HISAX_DEBUG
61ffcafa	44	static int debug = 0;
1da177e4	45	module_param(debug, int, 0);
1da177e4	46	#endif
61ffcafa	47	int st5481_debug;
1da177e4	48
1da177e4 LT	49	/* ======================================================================
	50	* registration/deregistration with the USB layer
	51	*/
	52
	53	/*
	54	* This function will be called when the adapter is plugged
	55	* into the USB bus.
	56	*/
	57	static int probe_st5481(struct usb_interface *intf,
	58	const struct usb_device_id *id)
	59	{
	60	struct usb_device *dev = interface_to_usbdev(intf);
	61	struct st5481_adapter *adapter;
	62	struct hisax_b_if *b_if[2];
	63	int retval, i;
	64
	65	printk(KERN_INFO "st541: found adapter VendorId %04x, ProductId %04x, LEDs %d\n",
475be4d8 JP	66	le16_to_cpu(dev->descriptor.idVendor),
	67	le16_to_cpu(dev->descriptor.idProduct),
	68	number_of_leds);
1da177e4	69
41f96935	70	adapter = kzalloc(sizeof(struct st5481_adapter), GFP_KERNEL);
1da177e4 LT	71	if (!adapter)
	72	return -ENOMEM;
	73
1da177e4 LT	74	adapter->number_of_leds = number_of_leds;
	75	adapter->usb_dev = dev;
	76
	77	adapter->hisax_d_if.owner = THIS_MODULE;
	78	adapter->hisax_d_if.ifc.priv = adapter;
	79	adapter->hisax_d_if.ifc.l2l1 = st5481_d_l2l1;
	80
	81	for (i = 0; i < 2; i++) {
	82	adapter->bcs[i].adapter = adapter;
	83	adapter->bcs[i].channel = i;
	84	adapter->bcs[i].b_if.ifc.priv = &adapter->bcs[i];
	85	adapter->bcs[i].b_if.ifc.l2l1 = st5481_b_l2l1;
	86	}
1da177e4 LT	87
	88	retval = st5481_setup_usb(adapter);
	89	if (retval < 0)
	90	goto err;
	91
	92	retval = st5481_setup_d(adapter);
	93	if (retval < 0)
	94	goto err_usb;
	95
	96	retval = st5481_setup_b(&adapter->bcs[0]);
	97	if (retval < 0)
	98	goto err_d;
	99
	100	retval = st5481_setup_b(&adapter->bcs[1]);
	101	if (retval < 0)
	102	goto err_b;
	103
	104	for (i = 0; i < 2; i++)
	105	b_if[i] = &adapter->bcs[i].b_if;
	106
ae2d990e	107	if (hisax_register(&adapter->hisax_d_if, b_if, "st5481_usb",
475be4d8	108	protocol) != 0)
ae2d990e AS	109	goto err_b1;
ae2d990e AS	110
1da177e4 LT	111	st5481_start(adapter);
	112
	113	usb_set_intfdata(intf, adapter);
	114	return 0;
	115
475be4d8	116	err_b1:
ae2d990e	117	st5481_release_b(&adapter->bcs[1]);
475be4d8	118	err_b:
1da177e4	119	st5481_release_b(&adapter->bcs[0]);
475be4d8	120	err_d:
1da177e4	121	st5481_release_d(adapter);
475be4d8	122	err_usb:
1da177e4	123	st5481_release_usb(adapter);
475be4d8	124	err:
5310cbce	125	kfree(adapter);
1da177e4 LT	126	return -EIO;
	127	}
	128
	129	/*
	130	* This function will be called when the adapter is removed
	131	* from the USB bus.
	132	*/
	133	static void disconnect_st5481(struct usb_interface *intf)
	134	{
	135	struct st5481_adapter *adapter = usb_get_intfdata(intf);
	136
475be4d8	137	DBG(1, "");
1da177e4 LT	138
	139	usb_set_intfdata(intf, NULL);
	140	if (!adapter)
	141	return;
475be4d8	142
1da177e4 LT	143	st5481_stop(adapter);
	144	st5481_release_b(&adapter->bcs[1]);
	145	st5481_release_b(&adapter->bcs[0]);
	146	st5481_release_d(adapter);
	147	// we would actually better wait for completion of outstanding urbs
	148	mdelay(2);
	149	st5481_release_usb(adapter);
	150
	151	hisax_unregister(&adapter->hisax_d_if);
	152
	153	kfree(adapter);
	154	}
	155
	156	/*
	157	* The last 4 bits in the Product Id is set with 4 pins on the chip.
	158	*/
	159	static struct usb_device_id st5481_ids[] = {
475be4d8 JP	160	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x0) },
	161	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x1) },
	162	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x2) },
	163	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x3) },
	164	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x4) },
	165	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x5) },
	166	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x6) },
	167	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x7) },
	168	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x8) },
	169	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0x9) },
	170	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xA) },
	171	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xB) },
	172	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xC) },
	173	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xD) },
	174	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xE) },
	175	{ USB_DEVICE(ST_VENDOR_ID, ST5481_PRODUCT_ID + 0xF) },
1da177e4 LT	176	{ }
1da177e4 LT	177	};
475be4d8	178	MODULE_DEVICE_TABLE(usb, st5481_ids);
1da177e4 LT	179
1da177e4 LT	180	static struct usb_driver st5481_usb_driver = {
1da177e4 LT	181	.name = "st5481_usb",
	182	.probe = probe_st5481,
	183	.disconnect = disconnect_st5481,
	184	.id_table = st5481_ids,
	185	};
	186
	187	static int __init st5481_usb_init(void)
	188	{
	189	int retval;
	190
	191	#ifdef CONFIG_HISAX_DEBUG
	192	st5481_debug = debug;
	193	#endif
	194
	195	printk(KERN_INFO "hisax_st5481: ST5481 USB ISDN driver $Revision: 2.4.2.3 $\n");
	196
	197	retval = st5481_d_init();
	198	if (retval < 0)
	199	goto out;
	200
	201	retval = usb_register(&st5481_usb_driver);
	202	if (retval < 0)
	203	goto out_d_exit;
	204
	205	return 0;
	206
475be4d8	207	out_d_exit:
1da177e4	208	st5481_d_exit();
475be4d8	209	out:
1da177e4 LT	210	return retval;
	211	}
	212
	213	static void __exit st5481_usb_exit(void)
	214	{
	215	usb_deregister(&st5481_usb_driver);
	216	st5481_d_exit();
	217	}
	218
	219	module_init(st5481_usb_init);
	220	module_exit(st5481_usb_exit);