jsm: Fix the return variable and removing the unused retval.
[linux-2.6/linux-2.6-openrd.git] / drivers / serial / jsm / jsm_driver.c
blobd2d32a19862961a06e6ecd0738d5e3877ade07a0
1 /************************************************************************
2 * Copyright 2003 Digi International (www.digi.com)
4 * Copyright (C) 2004 IBM Corporation. All rights reserved.
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.
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.
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.
21 * Contact Information:
22 * Scott H Kilau <Scott_Kilau@digi.com>
23 * Wendy Xiong <wendyx@us.ibm.com>
26 ***********************************************************************/
27 #include <linux/moduleparam.h>
28 #include <linux/pci.h>
30 #include "jsm.h"
32 MODULE_AUTHOR("Digi International, http://www.digi.com");
33 MODULE_DESCRIPTION("Driver for the Digi International "
34 "Neo PCI based product line");
35 MODULE_LICENSE("GPL");
36 MODULE_SUPPORTED_DEVICE("jsm");
38 #define JSM_DRIVER_NAME "jsm"
39 #define NR_PORTS 32
40 #define JSM_MINOR_START 0
42 struct uart_driver jsm_uart_driver = {
43 .owner = THIS_MODULE,
44 .driver_name = JSM_DRIVER_NAME,
45 .dev_name = "ttyn",
46 .major = 0,
47 .minor = JSM_MINOR_START,
48 .nr = NR_PORTS,
51 int jsm_debug;
52 module_param(jsm_debug, int, 0);
53 MODULE_PARM_DESC(jsm_debug, "Driver debugging level");
55 static int __devinit jsm_probe_one(struct pci_dev *pdev, const struct pci_device_id *ent)
57 int rc = 0;
58 struct jsm_board *brd;
59 static int adapter_count = 0;
61 rc = pci_enable_device(pdev);
62 if (rc) {
63 dev_err(&pdev->dev, "Device enable FAILED\n");
64 goto out;
67 rc = pci_request_regions(pdev, "jsm");
68 if (rc) {
69 dev_err(&pdev->dev, "pci_request_region FAILED\n");
70 goto out_disable_device;
73 brd = kzalloc(sizeof(struct jsm_board), GFP_KERNEL);
74 if (!brd) {
75 dev_err(&pdev->dev,
76 "memory allocation for board structure failed\n");
77 rc = -ENOMEM;
78 goto out_release_regions;
81 /* store the info for the board we've found */
82 brd->boardnum = adapter_count++;
83 brd->pci_dev = pdev;
84 if (pdev->device == PCIE_DEVICE_ID_NEO_4_IBM)
85 brd->maxports = 4;
86 else if (pdev->device == PCI_DEVICE_ID_DIGI_NEO_8)
87 brd->maxports = 8;
88 else
89 brd->maxports = 2;
91 spin_lock_init(&brd->bd_lock);
92 spin_lock_init(&brd->bd_intr_lock);
94 /* store which revision we have */
95 brd->rev = pdev->revision;
97 brd->irq = pdev->irq;
99 jsm_printk(INIT, INFO, &brd->pci_dev,
100 "jsm_found_board - NEO adapter\n");
102 /* get the PCI Base Address Registers */
103 brd->membase = pci_resource_start(pdev, 0);
104 brd->membase_end = pci_resource_end(pdev, 0);
106 if (brd->membase & 1)
107 brd->membase &= ~3;
108 else
109 brd->membase &= ~15;
111 /* Assign the board_ops struct */
112 brd->bd_ops = &jsm_neo_ops;
114 brd->bd_uart_offset = 0x200;
115 brd->bd_dividend = 921600;
117 brd->re_map_membase = ioremap(brd->membase, 0x1000);
118 if (!brd->re_map_membase) {
119 dev_err(&pdev->dev,
120 "card has no PCI Memory resources, "
121 "failing board.\n");
122 rc = -ENOMEM;
123 goto out_kfree_brd;
126 rc = request_irq(brd->irq, brd->bd_ops->intr,
127 IRQF_DISABLED|IRQF_SHARED, "JSM", brd);
128 if (rc) {
129 printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
130 goto out_iounmap;
133 rc = jsm_tty_init(brd);
134 if (rc < 0) {
135 dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
136 rc = -ENXIO;
137 goto out_free_irq;
140 rc = jsm_uart_port_init(brd);
141 if (rc < 0) {
142 /* XXX: leaking all resources from jsm_tty_init here! */
143 dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
144 rc = -ENXIO;
145 goto out_free_irq;
148 /* Log the information about the board */
149 dev_info(&pdev->dev, "board %d: Digi Neo (rev %d), irq %d\n",
150 adapter_count, brd->rev, brd->irq);
153 * allocate flip buffer for board.
155 * Okay to malloc with GFP_KERNEL, we are not at interrupt
156 * context, and there are no locks held.
158 brd->flipbuf = kzalloc(MYFLIPLEN, GFP_KERNEL);
159 if (!brd->flipbuf) {
160 /* XXX: leaking all resources from jsm_tty_init and
161 jsm_uart_port_init here! */
162 dev_err(&pdev->dev, "memory allocation for flipbuf failed\n");
163 rc = -ENOMEM;
164 goto out_free_irq;
167 pci_set_drvdata(pdev, brd);
169 return 0;
170 out_free_irq:
171 free_irq(brd->irq, brd);
172 out_iounmap:
173 iounmap(brd->re_map_membase);
174 out_kfree_brd:
175 kfree(brd);
176 out_release_regions:
177 pci_release_regions(pdev);
178 out_disable_device:
179 pci_disable_device(pdev);
180 out:
181 return rc;
184 static void __devexit jsm_remove_one(struct pci_dev *pdev)
186 struct jsm_board *brd = pci_get_drvdata(pdev);
187 int i = 0;
189 jsm_remove_uart_port(brd);
191 free_irq(brd->irq, brd);
192 iounmap(brd->re_map_membase);
194 /* Free all allocated channels structs */
195 for (i = 0; i < brd->maxports; i++) {
196 if (brd->channels[i]) {
197 kfree(brd->channels[i]->ch_rqueue);
198 kfree(brd->channels[i]->ch_equeue);
199 kfree(brd->channels[i]->ch_wqueue);
200 kfree(brd->channels[i]);
204 pci_release_regions(pdev);
205 pci_disable_device(pdev);
206 kfree(brd->flipbuf);
207 kfree(brd);
210 static struct pci_device_id jsm_pci_tbl[] = {
211 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
212 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
213 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
214 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
215 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4_IBM), 0, 0, 4 },
216 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_DIGI_NEO_8), 0, 0, 5 },
217 { 0, }
219 MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
221 static struct pci_driver jsm_driver = {
222 .name = "jsm",
223 .id_table = jsm_pci_tbl,
224 .probe = jsm_probe_one,
225 .remove = __devexit_p(jsm_remove_one),
228 static int __init jsm_init_module(void)
230 int rc;
232 rc = uart_register_driver(&jsm_uart_driver);
233 if (!rc) {
234 rc = pci_register_driver(&jsm_driver);
235 if (rc)
236 uart_unregister_driver(&jsm_uart_driver);
238 return rc;
241 static void __exit jsm_exit_module(void)
243 pci_unregister_driver(&jsm_driver);
244 uart_unregister_driver(&jsm_uart_driver);
247 module_init(jsm_init_module);
248 module_exit(jsm_exit_module);