OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / tty / serial / jsm / jsm_driver.c
blob7545fe1b99257dad128f3ddd57356939ce8f8399
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/module.h>
28 #include <linux/pci.h>
29 #include <linux/slab.h>
31 #include "jsm.h"
33 MODULE_AUTHOR("Digi International, http://www.digi.com");
34 MODULE_DESCRIPTION("Driver for the Digi International "
35 "Neo PCI based product line");
36 MODULE_LICENSE("GPL");
37 MODULE_SUPPORTED_DEVICE("jsm");
39 #define JSM_DRIVER_NAME "jsm"
40 #define NR_PORTS 32
41 #define JSM_MINOR_START 0
43 struct uart_driver jsm_uart_driver = {
44 .owner = THIS_MODULE,
45 .driver_name = JSM_DRIVER_NAME,
46 .dev_name = "ttyn",
47 .major = 0,
48 .minor = JSM_MINOR_START,
49 .nr = NR_PORTS,
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);
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,
63 int jsm_debug;
64 module_param(jsm_debug, int, 0);
65 MODULE_PARM_DESC(jsm_debug, "Driver debugging level");
67 static int __devinit jsm_probe_one(struct pci_dev *pdev, const struct pci_device_id *ent)
69 int rc = 0;
70 struct jsm_board *brd;
71 static int adapter_count = 0;
73 rc = pci_enable_device(pdev);
74 if (rc) {
75 dev_err(&pdev->dev, "Device enable FAILED\n");
76 goto out;
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;
85 brd = kzalloc(sizeof(struct jsm_board), GFP_KERNEL);
86 if (!brd) {
87 dev_err(&pdev->dev,
88 "memory allocation for board structure failed\n");
89 rc = -ENOMEM;
90 goto out_release_regions;
93 /* store the info for the board we've found */
94 brd->boardnum = adapter_count++;
95 brd->pci_dev = pdev;
96 if (pdev->device == PCIE_DEVICE_ID_NEO_4_IBM)
97 brd->maxports = 4;
98 else if (pdev->device == PCI_DEVICE_ID_DIGI_NEO_8)
99 brd->maxports = 8;
100 else
101 brd->maxports = 2;
103 spin_lock_init(&brd->bd_intr_lock);
105 /* store which revision we have */
106 brd->rev = pdev->revision;
108 brd->irq = pdev->irq;
110 jsm_printk(INIT, INFO, &brd->pci_dev,
111 "jsm_found_board - NEO adapter\n");
113 /* get the PCI Base Address Registers */
114 brd->membase = pci_resource_start(pdev, 0);
115 brd->membase_end = pci_resource_end(pdev, 0);
117 if (brd->membase & 1)
118 brd->membase &= ~3;
119 else
120 brd->membase &= ~15;
122 /* Assign the board_ops struct */
123 brd->bd_ops = &jsm_neo_ops;
125 brd->bd_uart_offset = 0x200;
126 brd->bd_dividend = 921600;
128 brd->re_map_membase = ioremap(brd->membase, pci_resource_len(pdev, 0));
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;
137 rc = request_irq(brd->irq, brd->bd_ops->intr,
138 IRQF_SHARED, "JSM", brd);
139 if (rc) {
140 printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
141 goto out_iounmap;
144 rc = jsm_tty_init(brd);
145 if (rc < 0) {
146 dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
147 rc = -ENXIO;
148 goto out_free_irq;
151 rc = jsm_uart_port_init(brd);
152 if (rc < 0) {
153 /* XXX: leaking all resources from jsm_tty_init here! */
154 dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
155 rc = -ENXIO;
156 goto out_free_irq;
159 /* Log the information about the board */
160 dev_info(&pdev->dev, "board %d: Digi Neo (rev %d), irq %d\n",
161 adapter_count, brd->rev, brd->irq);
163 pci_set_drvdata(pdev, brd);
164 pci_save_state(pdev);
166 return 0;
167 out_free_irq:
168 jsm_remove_uart_port(brd);
169 free_irq(brd->irq, brd);
170 out_iounmap:
171 iounmap(brd->re_map_membase);
172 out_kfree_brd:
173 kfree(brd);
174 out_release_regions:
175 pci_release_regions(pdev);
176 out_disable_device:
177 pci_disable_device(pdev);
178 out:
179 return rc;
182 static void __devexit jsm_remove_one(struct pci_dev *pdev)
184 struct jsm_board *brd = pci_get_drvdata(pdev);
185 int i = 0;
187 jsm_remove_uart_port(brd);
189 free_irq(brd->irq, brd);
190 iounmap(brd->re_map_membase);
192 /* Free all allocated channels structs */
193 for (i = 0; i < brd->maxports; i++) {
194 if (brd->channels[i]) {
195 kfree(brd->channels[i]->ch_rqueue);
196 kfree(brd->channels[i]->ch_equeue);
197 kfree(brd->channels[i]);
201 pci_release_regions(pdev);
202 pci_disable_device(pdev);
203 kfree(brd);
206 static struct pci_device_id jsm_pci_tbl[] = {
207 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
208 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
209 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
210 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
211 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4_IBM), 0, 0, 4 },
212 { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_DIGI_NEO_8), 0, 0, 5 },
213 { 0, }
215 MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
217 static struct pci_driver jsm_driver = {
218 .name = "jsm",
219 .id_table = jsm_pci_tbl,
220 .probe = jsm_probe_one,
221 .remove = __devexit_p(jsm_remove_one),
222 .err_handler = &jsm_err_handler,
225 static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
226 pci_channel_state_t state)
228 struct jsm_board *brd = pci_get_drvdata(pdev);
230 jsm_remove_uart_port(brd);
232 return PCI_ERS_RESULT_NEED_RESET;
235 static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev)
237 int rc;
239 rc = pci_enable_device(pdev);
241 if (rc)
242 return PCI_ERS_RESULT_DISCONNECT;
244 pci_set_master(pdev);
246 return PCI_ERS_RESULT_RECOVERED;
249 static void jsm_io_resume(struct pci_dev *pdev)
251 struct jsm_board *brd = pci_get_drvdata(pdev);
253 pci_restore_state(pdev);
254 pci_save_state(pdev);
256 jsm_uart_port_init(brd);
259 static int __init jsm_init_module(void)
261 int rc;
263 rc = uart_register_driver(&jsm_uart_driver);
264 if (!rc) {
265 rc = pci_register_driver(&jsm_driver);
266 if (rc)
267 uart_unregister_driver(&jsm_uart_driver);
269 return rc;
272 static void __exit jsm_exit_module(void)
274 pci_unregister_driver(&jsm_driver);
275 uart_unregister_driver(&jsm_uart_driver);
278 module_init(jsm_init_module);
279 module_exit(jsm_exit_module);