[net-next-2.6.git] / drivers / serial / jsm / jsm_driver.c

/************************************************************************
 * Copyright 2003 Digi International (www.digi.com)
 *
 * Copyright (C) 2004 IBM Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED; without even the
 * implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
 * PURPOSE.  See the GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 * Temple Place - Suite 330, Boston,
 * MA  02111-1307, USA.
 *
 * Contact Information:
 * Scott H Kilau <Scott_Kilau@digi.com>
 * Wendy Xiong   <wendyx@us.ibm.com>
 *
 *
 ***********************************************************************/
#include <linux/moduleparam.h>
#include <linux/pci.h>
#include <linux/slab.h>

#include "jsm.h"

MODULE_AUTHOR("Digi International, http://www.digi.com");
MODULE_DESCRIPTION("Driver for the Digi International "
		   "Neo PCI based product line");
MODULE_LICENSE("GPL");
MODULE_SUPPORTED_DEVICE("jsm");

#define JSM_DRIVER_NAME "jsm"
#define NR_PORTS	32
#define JSM_MINOR_START	0

struct uart_driver jsm_uart_driver = {
	.owner		= THIS_MODULE,
	.driver_name	= JSM_DRIVER_NAME,
	.dev_name	= "ttyn",
	.major		= 0,
	.minor		= JSM_MINOR_START,
	.nr		= NR_PORTS,
};

static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
                                       pci_channel_state_t state);
static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev);
static void jsm_io_resume(struct pci_dev *pdev);

static struct pci_error_handlers jsm_err_handler = {
	.error_detected = jsm_io_error_detected,
	.slot_reset = jsm_io_slot_reset,
	.resume = jsm_io_resume,
};

int jsm_debug;
module_param(jsm_debug, int, 0);
MODULE_PARM_DESC(jsm_debug, "Driver debugging level");

static int __devinit jsm_probe_one(struct pci_dev *pdev, const struct pci_device_id *ent)
{
	int rc = 0;
	struct jsm_board *brd;
	static int adapter_count = 0;

	rc = pci_enable_device(pdev);
	if (rc) {
		dev_err(&pdev->dev, "Device enable FAILED\n");
		goto out;
	}

	rc = pci_request_regions(pdev, "jsm");
	if (rc) {
		dev_err(&pdev->dev, "pci_request_region FAILED\n");
		goto out_disable_device;
	}

	brd = kzalloc(sizeof(struct jsm_board), GFP_KERNEL);
	if (!brd) {
		dev_err(&pdev->dev,
			"memory allocation for board structure failed\n");
		rc = -ENOMEM;
		goto out_release_regions;
	}

	/* store the info for the board we've found */
	brd->boardnum = adapter_count++;
	brd->pci_dev = pdev;
	if (pdev->device == PCIE_DEVICE_ID_NEO_4_IBM)
		brd->maxports = 4;
	else if (pdev->device == PCI_DEVICE_ID_DIGI_NEO_8)
		brd->maxports = 8;
	else
		brd->maxports = 2;

	spin_lock_init(&brd->bd_intr_lock);

	/* store which revision we have */
	brd->rev = pdev->revision;

	brd->irq = pdev->irq;

	jsm_printk(INIT, INFO, &brd->pci_dev,
		"jsm_found_board - NEO adapter\n");

	/* get the PCI Base Address Registers */
	brd->membase	= pci_resource_start(pdev, 0);
	brd->membase_end = pci_resource_end(pdev, 0);

	if (brd->membase & 1)
		brd->membase &= ~3;
	else
		brd->membase &= ~15;

	/* Assign the board_ops struct */
	brd->bd_ops = &jsm_neo_ops;

	brd->bd_uart_offset = 0x200;
	brd->bd_dividend = 921600;

	brd->re_map_membase = ioremap(brd->membase, 0x1000);
	if (!brd->re_map_membase) {
		dev_err(&pdev->dev,
			"card has no PCI Memory resources, "
			"failing board.\n");
		rc = -ENOMEM;
		goto out_kfree_brd;
	}

	rc = request_irq(brd->irq, brd->bd_ops->intr,
			IRQF_SHARED, "JSM", brd);
	if (rc) {
		printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
		goto out_iounmap;
	}

	rc = jsm_tty_init(brd);
	if (rc < 0) {
		dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
		rc = -ENXIO;
		goto out_free_irq;
	}

	rc = jsm_uart_port_init(brd);
	if (rc < 0) {
		/* XXX: leaking all resources from jsm_tty_init here! */
		dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
		rc = -ENXIO;
		goto out_free_irq;
	}

	/* Log the information about the board */
	dev_info(&pdev->dev, "board %d: Digi Neo (rev %d), irq %d\n",
			adapter_count, brd->rev, brd->irq);

	/*
	 * allocate flip buffer for board.
	 *
	 * Okay to malloc with GFP_KERNEL, we are not at interrupt
	 * context, and there are no locks held.
	 */
	brd->flipbuf = kzalloc(MYFLIPLEN, GFP_KERNEL);
	if (!brd->flipbuf) {
		/* XXX: leaking all resources from jsm_tty_init and
		 	jsm_uart_port_init here! */
		dev_err(&pdev->dev, "memory allocation for flipbuf failed\n");
		rc = -ENOMEM;
		goto out_free_irq;
	}

	pci_set_drvdata(pdev, brd);
	pci_save_state(pdev);

	return 0;
 out_free_irq:
	jsm_remove_uart_port(brd);
	free_irq(brd->irq, brd);
 out_iounmap:
	iounmap(brd->re_map_membase);
 out_kfree_brd:
	kfree(brd);
 out_release_regions:
	pci_release_regions(pdev);
 out_disable_device:
	pci_disable_device(pdev);
 out:
	return rc;
}

static void __devexit jsm_remove_one(struct pci_dev *pdev)
{
	struct jsm_board *brd = pci_get_drvdata(pdev);
	int i = 0;

	jsm_remove_uart_port(brd);

	free_irq(brd->irq, brd);
	iounmap(brd->re_map_membase);

	/* Free all allocated channels structs */
	for (i = 0; i < brd->maxports; i++) {
		if (brd->channels[i]) {
			kfree(brd->channels[i]->ch_rqueue);
			kfree(brd->channels[i]->ch_equeue);
			kfree(brd->channels[i]->ch_wqueue);
			kfree(brd->channels[i]);
		}
	}

	pci_release_regions(pdev);
	pci_disable_device(pdev);
	kfree(brd->flipbuf);
	kfree(brd);
}

static struct pci_device_id jsm_pci_tbl[] = {
	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4_IBM), 0, 0, 4 },
	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_DIGI_NEO_8), 0, 0, 5 },
	{ 0, }
};
MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);

static struct pci_driver jsm_driver = {
	.name		= "jsm",
	.id_table	= jsm_pci_tbl,
	.probe		= jsm_probe_one,
	.remove		= __devexit_p(jsm_remove_one),
	.err_handler    = &jsm_err_handler,
};

static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
					pci_channel_state_t state)
{
	struct jsm_board *brd = pci_get_drvdata(pdev);

	jsm_remove_uart_port(brd);

	return PCI_ERS_RESULT_NEED_RESET;
}

static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev)
{
	int rc;

	rc = pci_enable_device(pdev);

	if (rc)
		return PCI_ERS_RESULT_DISCONNECT;

	pci_set_master(pdev);

	return PCI_ERS_RESULT_RECOVERED;
}

static void jsm_io_resume(struct pci_dev *pdev)
{
	struct jsm_board *brd = pci_get_drvdata(pdev);

	pci_restore_state(pdev);

	jsm_uart_port_init(brd);
}

static int __init jsm_init_module(void)
{
	int rc;

	rc = uart_register_driver(&jsm_uart_driver);
	if (!rc) {
		rc = pci_register_driver(&jsm_driver);
		if (rc)
			uart_unregister_driver(&jsm_uart_driver);
	}
	return rc;
}

static void __exit jsm_exit_module(void)
{
	pci_unregister_driver(&jsm_driver);
	uart_unregister_driver(&jsm_uart_driver);
}

module_init(jsm_init_module);
module_exit(jsm_exit_module);
Commit	Line	Data
1da177e4 LT	1	/************************************************************************
	2	* Copyright 2003 Digi International (www.digi.com)
	3	*
	4	* Copyright (C) 2004 IBM Corporation. All rights reserved.
	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 as published by
	8	* the Free Software Foundation; either version 2, or (at your option)
	9	* any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED; without even the
	13	* implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
	14	* PURPOSE. See the GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 59 * Temple Place - Suite 330, Boston,
	19	* MA 02111-1307, USA.
	20	*
	21	* Contact Information:
	22	* Scott H Kilau <Scott_Kilau@digi.com>
2a08b4e9	23	* Wendy Xiong <wendyx@us.ibm.com>
1da177e4	24	*
c2236956	25	*
1da177e4 LT	26	***********************************************************************/
	27	#include <linux/moduleparam.h>
	28	#include <linux/pci.h>
5a0e3ad6	29	#include <linux/slab.h>
1da177e4 LT	30
	31	#include "jsm.h"
	32
	33	MODULE_AUTHOR("Digi International, http://www.digi.com");
614a7d6a CH	34	MODULE_DESCRIPTION("Driver for the Digi International "
	35	"Neo PCI based product line");
	36	MODULE_LICENSE("GPL");
1da177e4 LT	37	MODULE_SUPPORTED_DEVICE("jsm");
	38
	39	#define JSM_DRIVER_NAME "jsm"
	40	#define NR_PORTS 32
	41	#define JSM_MINOR_START 0
	42
	43	struct uart_driver jsm_uart_driver = {
	44	.owner = THIS_MODULE,
	45	.driver_name = JSM_DRIVER_NAME,
	46	.dev_name = "ttyn",
9539c1d4	47	.major = 0,
1da177e4 LT	48	.minor = JSM_MINOR_START,
1da177e4 LT	49	.nr = NR_PORTS,
1da177e4 LT	50	};
1da177e4 LT	51
e6bdf24c BL	52	static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
	53	pci_channel_state_t state);
	54	static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev);
	55	static void jsm_io_resume(struct pci_dev *pdev);
	56
	57	static struct pci_error_handlers jsm_err_handler = {
	58	.error_detected = jsm_io_error_detected,
	59	.slot_reset = jsm_io_slot_reset,
	60	.resume = jsm_io_resume,
	61	};
	62
1da177e4	63	int jsm_debug;
1da177e4	64	module_param(jsm_debug, int, 0);
1da177e4	65	MODULE_PARM_DESC(jsm_debug, "Driver debugging level");
1da177e4	66
aacf17ad	67	static int __devinit jsm_probe_one(struct pci_dev pdev, const struct pci_device_id ent)
1da177e4 LT	68	{
1da177e4 LT	69	int rc = 0;
614a7d6a CH	70	struct jsm_board *brd;
614a7d6a CH	71	static int adapter_count = 0;
1da177e4	72
614a7d6a CH	73	rc = pci_enable_device(pdev);
	74	if (rc) {
	75	dev_err(&pdev->dev, "Device enable FAILED\n");
	76	goto out;
1da177e4	77	}
1da177e4	78
614a7d6a CH	79	rc = pci_request_regions(pdev, "jsm");
	80	if (rc) {
	81	dev_err(&pdev->dev, "pci_request_region FAILED\n");
	82	goto out_disable_device;
	83	}
1da177e4	84
8f31bb39	85	brd = kzalloc(sizeof(struct jsm_board), GFP_KERNEL);
1da177e4	86	if (!brd) {
614a7d6a CH	87	dev_err(&pdev->dev,
	88	"memory allocation for board structure failed\n");
	89	rc = -ENOMEM;
	90	goto out_release_regions;
1da177e4	91	}
1da177e4	92
1da177e4	93	/* store the info for the board we've found */
614a7d6a	94	brd->boardnum = adapter_count++;
1da177e4	95	brd->pci_dev = pdev;
99da9047 SK	96	if (pdev->device == PCIE_DEVICE_ID_NEO_4_IBM)
99da9047 SK	97	brd->maxports = 4;
ffa7525c AL	98	else if (pdev->device == PCI_DEVICE_ID_DIGI_NEO_8)
ffa7525c AL	99	brd->maxports = 8;
99da9047 SK	100	else
99da9047 SK	101	brd->maxports = 2;
1da177e4	102
1da177e4 LT	103	spin_lock_init(&brd->bd_intr_lock);
1da177e4 LT	104
1da177e4	105	/* store which revision we have */
44c10138	106	brd->rev = pdev->revision;
1da177e4 LT	107
	108	brd->irq = pdev->irq;
	109
614a7d6a CH	110	jsm_printk(INIT, INFO, &brd->pci_dev,
614a7d6a CH	111	"jsm_found_board - NEO adapter\n");
1da177e4	112
614a7d6a CH	113	/* get the PCI Base Address Registers */
	114	brd->membase = pci_resource_start(pdev, 0);
	115	brd->membase_end = pci_resource_end(pdev, 0);
1da177e4	116
614a7d6a CH	117	if (brd->membase & 1)
	118	brd->membase &= ~3;
	119	else
	120	brd->membase &= ~15;
1da177e4	121
614a7d6a CH	122	/* Assign the board_ops struct */
614a7d6a CH	123	brd->bd_ops = &jsm_neo_ops;
1da177e4	124
614a7d6a CH	125	brd->bd_uart_offset = 0x200;
614a7d6a CH	126	brd->bd_dividend = 921600;
1da177e4	127
614a7d6a CH	128	brd->re_map_membase = ioremap(brd->membase, 0x1000);
	129	if (!brd->re_map_membase) {
	130	dev_err(&pdev->dev,
	131	"card has no PCI Memory resources, "
	132	"failing board.\n");
	133	rc = -ENOMEM;
	134	goto out_kfree_brd;
1da177e4 LT	135	}
1da177e4 LT	136
614a7d6a	137	rc = request_irq(brd->irq, brd->bd_ops->intr,
a88a477f	138	IRQF_SHARED, "JSM", brd);
614a7d6a CH	139	if (rc) {
	140	printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
	141	goto out_iounmap;
1da177e4 LT	142	}
	143
	144	rc = jsm_tty_init(brd);
	145	if (rc < 0) {
	146	dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
e713abea	147	rc = -ENXIO;
614a7d6a	148	goto out_free_irq;
1da177e4 LT	149	}
	150
	151	rc = jsm_uart_port_init(brd);
	152	if (rc < 0) {
614a7d6a	153	/* XXX: leaking all resources from jsm_tty_init here! */
1da177e4	154	dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
e713abea	155	rc = -ENXIO;
614a7d6a	156	goto out_free_irq;
1da177e4 LT	157	}
1da177e4 LT	158
1da177e4	159	/* Log the information about the board */
614a7d6a CH	160	dev_info(&pdev->dev, "board %d: Digi Neo (rev %d), irq %d\n",
614a7d6a CH	161	adapter_count, brd->rev, brd->irq);
1da177e4 LT	162
	163	/*
	164	* allocate flip buffer for board.
	165	*
	166	* Okay to malloc with GFP_KERNEL, we are not at interrupt
	167	* context, and there are no locks held.
	168	*/
8f31bb39	169	brd->flipbuf = kzalloc(MYFLIPLEN, GFP_KERNEL);
1da177e4	170	if (!brd->flipbuf) {
614a7d6a CH	171	/* XXX: leaking all resources from jsm_tty_init and
614a7d6a CH	172	jsm_uart_port_init here! */
1da177e4	173	dev_err(&pdev->dev, "memory allocation for flipbuf failed\n");
e713abea	174	rc = -ENOMEM;
614a7d6a	175	goto out_free_irq;
1da177e4	176	}
1da177e4	177
614a7d6a	178	pci_set_drvdata(pdev, brd);
e6bdf24c	179	pci_save_state(pdev);
1da177e4	180
1da177e4	181	return 0;
614a7d6a	182	out_free_irq:
54862ee0	183	jsm_remove_uart_port(brd);
1da177e4	184	free_irq(brd->irq, brd);
614a7d6a	185	out_iounmap:
1da177e4	186	iounmap(brd->re_map_membase);
614a7d6a CH	187	out_kfree_brd:
	188	kfree(brd);
	189	out_release_regions:
	190	pci_release_regions(pdev);
	191	out_disable_device:
	192	pci_disable_device(pdev);
	193	out:
1da177e4 LT	194	return rc;
	195	}
	196
e9fed567	197	static void __devexit jsm_remove_one(struct pci_dev *pdev)
1da177e4	198	{
614a7d6a	199	struct jsm_board *brd = pci_get_drvdata(pdev);
1da177e4 LT	200	int i = 0;
1da177e4 LT	201
614a7d6a CH	202	jsm_remove_uart_port(brd);
614a7d6a CH	203
1da177e4 LT	204	free_irq(brd->irq, brd);
	205	iounmap(brd->re_map_membase);
	206
	207	/* Free all allocated channels structs */
	208	for (i = 0; i < brd->maxports; i++) {
	209	if (brd->channels[i]) {
614a7d6a CH	210	kfree(brd->channels[i]->ch_rqueue);
	211	kfree(brd->channels[i]->ch_equeue);
	212	kfree(brd->channels[i]->ch_wqueue);
1da177e4 LT	213	kfree(brd->channels[i]);
	214	}
	215	}
	216
614a7d6a CH	217	pci_release_regions(pdev);
614a7d6a CH	218	pci_disable_device(pdev);
1da177e4 LT	219	kfree(brd->flipbuf);
	220	kfree(brd);
	221	}
	222
614a7d6a CH	223	static struct pci_device_id jsm_pci_tbl[] = {
	224	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
	225	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
	226	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
	227	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
99da9047	228	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4_IBM), 0, 0, 4 },
ffa7525c	229	{ PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_DIGI_NEO_8), 0, 0, 5 },
614a7d6a CH	230	{ 0, }
	231	};
	232	MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
1da177e4	233
614a7d6a	234	static struct pci_driver jsm_driver = {
1da177e4	235	.name = "jsm",
1da177e4	236	.id_table = jsm_pci_tbl,
614a7d6a	237	.probe = jsm_probe_one,
1da177e4	238	.remove = __devexit_p(jsm_remove_one),
e6bdf24c	239	.err_handler = &jsm_err_handler,
1da177e4 LT	240	};
1da177e4 LT	241
e6bdf24c BL	242	static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
	243	pci_channel_state_t state)
	244	{
	245	struct jsm_board *brd = pci_get_drvdata(pdev);
	246
	247	jsm_remove_uart_port(brd);
	248
	249	return PCI_ERS_RESULT_NEED_RESET;
	250	}
	251
	252	static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev)
	253	{
	254	int rc;
	255
	256	rc = pci_enable_device(pdev);
	257
	258	if (rc)
	259	return PCI_ERS_RESULT_DISCONNECT;
	260
	261	pci_set_master(pdev);
	262
	263	return PCI_ERS_RESULT_RECOVERED;
	264	}
	265
	266	static void jsm_io_resume(struct pci_dev *pdev)
	267	{
	268	struct jsm_board *brd = pci_get_drvdata(pdev);
	269
	270	pci_restore_state(pdev);
	271
	272	jsm_uart_port_init(brd);
	273	}
	274
1da177e4 LT	275	static int __init jsm_init_module(void)
1da177e4 LT	276	{
614a7d6a	277	int rc;
1da177e4 LT	278
1da177e4 LT	279	rc = uart_register_driver(&jsm_uart_driver);
614a7d6a CH	280	if (!rc) {
	281	rc = pci_register_driver(&jsm_driver);
	282	if (rc)
	283	uart_unregister_driver(&jsm_uart_driver);
1da177e4	284	}
1da177e4 LT	285	return rc;
	286	}
	287
1da177e4 LT	288	static void __exit jsm_exit_module(void)
1da177e4 LT	289	{
1da177e4	290	pci_unregister_driver(&jsm_driver);
1da177e4 LT	291	uart_unregister_driver(&jsm_uart_driver);
1da177e4 LT	292	}
614a7d6a CH	293
614a7d6a CH	294	module_init(jsm_init_module);
1da177e4	295	module_exit(jsm_exit_module);