1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /************************************************************************
3*4882a593Smuzhiyun * Copyright 2003 Digi International (www.digi.com)
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2004 IBM Corporation. All rights reserved.
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Contact Information:
8*4882a593Smuzhiyun * Scott H Kilau <Scott_Kilau@digi.com>
9*4882a593Smuzhiyun * Wendy Xiong <wendyx@us.ibm.com>
10*4882a593Smuzhiyun *
11*4882a593Smuzhiyun *
12*4882a593Smuzhiyun ***********************************************************************/
13*4882a593Smuzhiyun #include <linux/module.h>
14*4882a593Smuzhiyun #include <linux/pci.h>
15*4882a593Smuzhiyun #include <linux/slab.h>
16*4882a593Smuzhiyun
17*4882a593Smuzhiyun #include "jsm.h"
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun MODULE_AUTHOR("Digi International, https://www.digi.com");
20*4882a593Smuzhiyun MODULE_DESCRIPTION("Driver for the Digi International Neo and Classic PCI based product line");
21*4882a593Smuzhiyun MODULE_LICENSE("GPL");
22*4882a593Smuzhiyun MODULE_SUPPORTED_DEVICE("jsm");
23*4882a593Smuzhiyun
24*4882a593Smuzhiyun #define JSM_DRIVER_NAME "jsm"
25*4882a593Smuzhiyun #define NR_PORTS 32
26*4882a593Smuzhiyun #define JSM_MINOR_START 0
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun struct uart_driver jsm_uart_driver = {
29*4882a593Smuzhiyun .owner = THIS_MODULE,
30*4882a593Smuzhiyun .driver_name = JSM_DRIVER_NAME,
31*4882a593Smuzhiyun .dev_name = "ttyn",
32*4882a593Smuzhiyun .major = 0,
33*4882a593Smuzhiyun .minor = JSM_MINOR_START,
34*4882a593Smuzhiyun .nr = NR_PORTS,
35*4882a593Smuzhiyun };
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
38*4882a593Smuzhiyun pci_channel_state_t state);
39*4882a593Smuzhiyun static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev);
40*4882a593Smuzhiyun static void jsm_io_resume(struct pci_dev *pdev);
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun static const struct pci_error_handlers jsm_err_handler = {
43*4882a593Smuzhiyun .error_detected = jsm_io_error_detected,
44*4882a593Smuzhiyun .slot_reset = jsm_io_slot_reset,
45*4882a593Smuzhiyun .resume = jsm_io_resume,
46*4882a593Smuzhiyun };
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun int jsm_debug;
49*4882a593Smuzhiyun module_param(jsm_debug, int, 0);
50*4882a593Smuzhiyun MODULE_PARM_DESC(jsm_debug, "Driver debugging level");
51*4882a593Smuzhiyun
jsm_probe_one(struct pci_dev * pdev,const struct pci_device_id * ent)52*4882a593Smuzhiyun static int jsm_probe_one(struct pci_dev *pdev, const struct pci_device_id *ent)
53*4882a593Smuzhiyun {
54*4882a593Smuzhiyun int rc = 0;
55*4882a593Smuzhiyun struct jsm_board *brd;
56*4882a593Smuzhiyun static int adapter_count;
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun rc = pci_enable_device(pdev);
59*4882a593Smuzhiyun if (rc) {
60*4882a593Smuzhiyun dev_err(&pdev->dev, "Device enable FAILED\n");
61*4882a593Smuzhiyun goto out;
62*4882a593Smuzhiyun }
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun rc = pci_request_regions(pdev, JSM_DRIVER_NAME);
65*4882a593Smuzhiyun if (rc) {
66*4882a593Smuzhiyun dev_err(&pdev->dev, "pci_request_region FAILED\n");
67*4882a593Smuzhiyun goto out_disable_device;
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun brd = kzalloc(sizeof(*brd), GFP_KERNEL);
71*4882a593Smuzhiyun if (!brd) {
72*4882a593Smuzhiyun rc = -ENOMEM;
73*4882a593Smuzhiyun goto out_release_regions;
74*4882a593Smuzhiyun }
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun /* store the info for the board we've found */
77*4882a593Smuzhiyun brd->boardnum = adapter_count++;
78*4882a593Smuzhiyun brd->pci_dev = pdev;
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun switch (pdev->device) {
81*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2DB9:
82*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2DB9PRI:
83*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2RJ45:
84*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2RJ45PRI:
85*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2_422_485:
86*4882a593Smuzhiyun brd->maxports = 2;
87*4882a593Smuzhiyun break;
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_4:
90*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_4_422:
91*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_4:
92*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_4:
93*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_4RJ45:
94*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_4_IBM:
95*4882a593Smuzhiyun brd->maxports = 4;
96*4882a593Smuzhiyun break;
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_8:
99*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_8_422:
100*4882a593Smuzhiyun case PCI_DEVICE_ID_DIGI_NEO_8:
101*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_8:
102*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_8RJ45:
103*4882a593Smuzhiyun brd->maxports = 8;
104*4882a593Smuzhiyun break;
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun default:
107*4882a593Smuzhiyun brd->maxports = 1;
108*4882a593Smuzhiyun break;
109*4882a593Smuzhiyun }
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun spin_lock_init(&brd->bd_intr_lock);
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun /* store which revision we have */
114*4882a593Smuzhiyun brd->rev = pdev->revision;
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun brd->irq = pdev->irq;
117*4882a593Smuzhiyun
118*4882a593Smuzhiyun switch (pdev->device) {
119*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_4:
120*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_4_422:
121*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_8:
122*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_8_422:
123*4882a593Smuzhiyun
124*4882a593Smuzhiyun jsm_dbg(INIT, &brd->pci_dev,
125*4882a593Smuzhiyun "jsm_found_board - Classic adapter\n");
126*4882a593Smuzhiyun
127*4882a593Smuzhiyun /*
128*4882a593Smuzhiyun * For PCI ClassicBoards
129*4882a593Smuzhiyun * PCI Local Address (.i.e. "resource" number) space
130*4882a593Smuzhiyun * 0 PLX Memory Mapped Config
131*4882a593Smuzhiyun * 1 PLX I/O Mapped Config
132*4882a593Smuzhiyun * 2 I/O Mapped UARTs and Status
133*4882a593Smuzhiyun * 3 Memory Mapped VPD
134*4882a593Smuzhiyun * 4 Memory Mapped UARTs and Status
135*4882a593Smuzhiyun */
136*4882a593Smuzhiyun
137*4882a593Smuzhiyun /* Get the PCI Base Address Registers */
138*4882a593Smuzhiyun brd->membase = pci_resource_start(pdev, 4);
139*4882a593Smuzhiyun brd->membase_end = pci_resource_end(pdev, 4);
140*4882a593Smuzhiyun
141*4882a593Smuzhiyun if (brd->membase & 0x1)
142*4882a593Smuzhiyun brd->membase &= ~0x3;
143*4882a593Smuzhiyun else
144*4882a593Smuzhiyun brd->membase &= ~0xF;
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun brd->iobase = pci_resource_start(pdev, 1);
147*4882a593Smuzhiyun brd->iobase_end = pci_resource_end(pdev, 1);
148*4882a593Smuzhiyun brd->iobase = ((unsigned int)(brd->iobase)) & 0xFFFE;
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun /* Assign the board_ops struct */
151*4882a593Smuzhiyun brd->bd_ops = &jsm_cls_ops;
152*4882a593Smuzhiyun
153*4882a593Smuzhiyun brd->bd_uart_offset = 0x8;
154*4882a593Smuzhiyun brd->bd_dividend = 921600;
155*4882a593Smuzhiyun
156*4882a593Smuzhiyun brd->re_map_membase = ioremap(brd->membase,
157*4882a593Smuzhiyun pci_resource_len(pdev, 4));
158*4882a593Smuzhiyun if (!brd->re_map_membase) {
159*4882a593Smuzhiyun dev_err(&pdev->dev,
160*4882a593Smuzhiyun "Card has no PCI Memory resources, failing board.\n");
161*4882a593Smuzhiyun rc = -ENOMEM;
162*4882a593Smuzhiyun goto out_kfree_brd;
163*4882a593Smuzhiyun }
164*4882a593Smuzhiyun
165*4882a593Smuzhiyun /*
166*4882a593Smuzhiyun * Enable Local Interrupt 1 (0x1),
167*4882a593Smuzhiyun * Local Interrupt 1 Polarity Active high (0x2),
168*4882a593Smuzhiyun * Enable PCI interrupt (0x43)
169*4882a593Smuzhiyun */
170*4882a593Smuzhiyun outb(0x43, brd->iobase + 0x4c);
171*4882a593Smuzhiyun
172*4882a593Smuzhiyun break;
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2DB9:
175*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2DB9PRI:
176*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2RJ45:
177*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2RJ45PRI:
178*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_2_422_485:
179*4882a593Smuzhiyun case PCI_DEVICE_ID_NEO_4:
180*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_4:
181*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_4RJ45:
182*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_4_IBM:
183*4882a593Smuzhiyun case PCI_DEVICE_ID_DIGI_NEO_8:
184*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_8:
185*4882a593Smuzhiyun case PCIE_DEVICE_ID_NEO_8RJ45:
186*4882a593Smuzhiyun
187*4882a593Smuzhiyun jsm_dbg(INIT, &brd->pci_dev, "jsm_found_board - NEO adapter\n");
188*4882a593Smuzhiyun
189*4882a593Smuzhiyun /* get the PCI Base Address Registers */
190*4882a593Smuzhiyun brd->membase = pci_resource_start(pdev, 0);
191*4882a593Smuzhiyun brd->membase_end = pci_resource_end(pdev, 0);
192*4882a593Smuzhiyun
193*4882a593Smuzhiyun if (brd->membase & 1)
194*4882a593Smuzhiyun brd->membase &= ~0x3;
195*4882a593Smuzhiyun else
196*4882a593Smuzhiyun brd->membase &= ~0xF;
197*4882a593Smuzhiyun
198*4882a593Smuzhiyun /* Assign the board_ops struct */
199*4882a593Smuzhiyun brd->bd_ops = &jsm_neo_ops;
200*4882a593Smuzhiyun
201*4882a593Smuzhiyun brd->bd_uart_offset = 0x200;
202*4882a593Smuzhiyun brd->bd_dividend = 921600;
203*4882a593Smuzhiyun
204*4882a593Smuzhiyun brd->re_map_membase = ioremap(brd->membase,
205*4882a593Smuzhiyun pci_resource_len(pdev, 0));
206*4882a593Smuzhiyun if (!brd->re_map_membase) {
207*4882a593Smuzhiyun dev_err(&pdev->dev,
208*4882a593Smuzhiyun "Card has no PCI Memory resources, failing board.\n");
209*4882a593Smuzhiyun rc = -ENOMEM;
210*4882a593Smuzhiyun goto out_kfree_brd;
211*4882a593Smuzhiyun }
212*4882a593Smuzhiyun
213*4882a593Smuzhiyun break;
214*4882a593Smuzhiyun default:
215*4882a593Smuzhiyun rc = -ENXIO;
216*4882a593Smuzhiyun goto out_kfree_brd;
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun
219*4882a593Smuzhiyun rc = request_irq(brd->irq, brd->bd_ops->intr, IRQF_SHARED, "JSM", brd);
220*4882a593Smuzhiyun if (rc) {
221*4882a593Smuzhiyun dev_warn(&pdev->dev, "Failed to hook IRQ %d\n", brd->irq);
222*4882a593Smuzhiyun goto out_iounmap;
223*4882a593Smuzhiyun }
224*4882a593Smuzhiyun
225*4882a593Smuzhiyun rc = jsm_tty_init(brd);
226*4882a593Smuzhiyun if (rc < 0) {
227*4882a593Smuzhiyun dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
228*4882a593Smuzhiyun rc = -ENXIO;
229*4882a593Smuzhiyun goto out_free_irq;
230*4882a593Smuzhiyun }
231*4882a593Smuzhiyun
232*4882a593Smuzhiyun rc = jsm_uart_port_init(brd);
233*4882a593Smuzhiyun if (rc < 0) {
234*4882a593Smuzhiyun /* XXX: leaking all resources from jsm_tty_init here! */
235*4882a593Smuzhiyun dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
236*4882a593Smuzhiyun rc = -ENXIO;
237*4882a593Smuzhiyun goto out_free_irq;
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun
240*4882a593Smuzhiyun /* Log the information about the board */
241*4882a593Smuzhiyun dev_info(&pdev->dev, "board %d: Digi Classic/Neo (rev %d), irq %d\n",
242*4882a593Smuzhiyun adapter_count, brd->rev, brd->irq);
243*4882a593Smuzhiyun
244*4882a593Smuzhiyun pci_set_drvdata(pdev, brd);
245*4882a593Smuzhiyun pci_save_state(pdev);
246*4882a593Smuzhiyun
247*4882a593Smuzhiyun return 0;
248*4882a593Smuzhiyun out_free_irq:
249*4882a593Smuzhiyun jsm_remove_uart_port(brd);
250*4882a593Smuzhiyun free_irq(brd->irq, brd);
251*4882a593Smuzhiyun out_iounmap:
252*4882a593Smuzhiyun iounmap(brd->re_map_membase);
253*4882a593Smuzhiyun out_kfree_brd:
254*4882a593Smuzhiyun kfree(brd);
255*4882a593Smuzhiyun out_release_regions:
256*4882a593Smuzhiyun pci_release_regions(pdev);
257*4882a593Smuzhiyun out_disable_device:
258*4882a593Smuzhiyun pci_disable_device(pdev);
259*4882a593Smuzhiyun out:
260*4882a593Smuzhiyun return rc;
261*4882a593Smuzhiyun }
262*4882a593Smuzhiyun
jsm_remove_one(struct pci_dev * pdev)263*4882a593Smuzhiyun static void jsm_remove_one(struct pci_dev *pdev)
264*4882a593Smuzhiyun {
265*4882a593Smuzhiyun struct jsm_board *brd = pci_get_drvdata(pdev);
266*4882a593Smuzhiyun int i = 0;
267*4882a593Smuzhiyun
268*4882a593Smuzhiyun switch (pdev->device) {
269*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_4:
270*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_4_422:
271*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_8:
272*4882a593Smuzhiyun case PCI_DEVICE_ID_CLASSIC_8_422:
273*4882a593Smuzhiyun /* Tell card not to interrupt anymore. */
274*4882a593Smuzhiyun outb(0x0, brd->iobase + 0x4c);
275*4882a593Smuzhiyun break;
276*4882a593Smuzhiyun default:
277*4882a593Smuzhiyun break;
278*4882a593Smuzhiyun }
279*4882a593Smuzhiyun
280*4882a593Smuzhiyun jsm_remove_uart_port(brd);
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun free_irq(brd->irq, brd);
283*4882a593Smuzhiyun iounmap(brd->re_map_membase);
284*4882a593Smuzhiyun
285*4882a593Smuzhiyun /* Free all allocated channels structs */
286*4882a593Smuzhiyun for (i = 0; i < brd->maxports; i++) {
287*4882a593Smuzhiyun if (brd->channels[i]) {
288*4882a593Smuzhiyun kfree(brd->channels[i]->ch_rqueue);
289*4882a593Smuzhiyun kfree(brd->channels[i]->ch_equeue);
290*4882a593Smuzhiyun kfree(brd->channels[i]);
291*4882a593Smuzhiyun }
292*4882a593Smuzhiyun }
293*4882a593Smuzhiyun
294*4882a593Smuzhiyun pci_release_regions(pdev);
295*4882a593Smuzhiyun pci_disable_device(pdev);
296*4882a593Smuzhiyun kfree(brd);
297*4882a593Smuzhiyun }
298*4882a593Smuzhiyun
299*4882a593Smuzhiyun static const struct pci_device_id jsm_pci_tbl[] = {
300*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
301*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
302*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
303*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
304*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4_IBM), 0, 0, 4 },
305*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_DIGI_NEO_8), 0, 0, 5 },
306*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_4), 0, 0, 6 },
307*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_1_422), 0, 0, 7 },
308*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_1_422_485), 0, 0, 8 },
309*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2_422_485), 0, 0, 9 },
310*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_8), 0, 0, 10 },
311*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4), 0, 0, 11 },
312*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4RJ45), 0, 0, 12 },
313*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_8RJ45), 0, 0, 13 },
314*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_CLASSIC_4), 0, 0, 14 },
315*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_CLASSIC_4_422), 0, 0, 15 },
316*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_CLASSIC_8), 0, 0, 16 },
317*4882a593Smuzhiyun { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_CLASSIC_8_422), 0, 0, 17 },
318*4882a593Smuzhiyun { 0, }
319*4882a593Smuzhiyun };
320*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun static struct pci_driver jsm_driver = {
323*4882a593Smuzhiyun .name = JSM_DRIVER_NAME,
324*4882a593Smuzhiyun .id_table = jsm_pci_tbl,
325*4882a593Smuzhiyun .probe = jsm_probe_one,
326*4882a593Smuzhiyun .remove = jsm_remove_one,
327*4882a593Smuzhiyun .err_handler = &jsm_err_handler,
328*4882a593Smuzhiyun };
329*4882a593Smuzhiyun
jsm_io_error_detected(struct pci_dev * pdev,pci_channel_state_t state)330*4882a593Smuzhiyun static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
331*4882a593Smuzhiyun pci_channel_state_t state)
332*4882a593Smuzhiyun {
333*4882a593Smuzhiyun struct jsm_board *brd = pci_get_drvdata(pdev);
334*4882a593Smuzhiyun
335*4882a593Smuzhiyun jsm_remove_uart_port(brd);
336*4882a593Smuzhiyun
337*4882a593Smuzhiyun return PCI_ERS_RESULT_NEED_RESET;
338*4882a593Smuzhiyun }
339*4882a593Smuzhiyun
jsm_io_slot_reset(struct pci_dev * pdev)340*4882a593Smuzhiyun static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev)
341*4882a593Smuzhiyun {
342*4882a593Smuzhiyun int rc;
343*4882a593Smuzhiyun
344*4882a593Smuzhiyun rc = pci_enable_device(pdev);
345*4882a593Smuzhiyun
346*4882a593Smuzhiyun if (rc)
347*4882a593Smuzhiyun return PCI_ERS_RESULT_DISCONNECT;
348*4882a593Smuzhiyun
349*4882a593Smuzhiyun pci_set_master(pdev);
350*4882a593Smuzhiyun
351*4882a593Smuzhiyun return PCI_ERS_RESULT_RECOVERED;
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun
jsm_io_resume(struct pci_dev * pdev)354*4882a593Smuzhiyun static void jsm_io_resume(struct pci_dev *pdev)
355*4882a593Smuzhiyun {
356*4882a593Smuzhiyun struct jsm_board *brd = pci_get_drvdata(pdev);
357*4882a593Smuzhiyun
358*4882a593Smuzhiyun pci_restore_state(pdev);
359*4882a593Smuzhiyun pci_save_state(pdev);
360*4882a593Smuzhiyun
361*4882a593Smuzhiyun jsm_uart_port_init(brd);
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun
jsm_init_module(void)364*4882a593Smuzhiyun static int __init jsm_init_module(void)
365*4882a593Smuzhiyun {
366*4882a593Smuzhiyun int rc;
367*4882a593Smuzhiyun
368*4882a593Smuzhiyun rc = uart_register_driver(&jsm_uart_driver);
369*4882a593Smuzhiyun if (!rc) {
370*4882a593Smuzhiyun rc = pci_register_driver(&jsm_driver);
371*4882a593Smuzhiyun if (rc)
372*4882a593Smuzhiyun uart_unregister_driver(&jsm_uart_driver);
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun return rc;
375*4882a593Smuzhiyun }
376*4882a593Smuzhiyun
jsm_exit_module(void)377*4882a593Smuzhiyun static void __exit jsm_exit_module(void)
378*4882a593Smuzhiyun {
379*4882a593Smuzhiyun pci_unregister_driver(&jsm_driver);
380*4882a593Smuzhiyun uart_unregister_driver(&jsm_uart_driver);
381*4882a593Smuzhiyun }
382*4882a593Smuzhiyun
383*4882a593Smuzhiyun module_init(jsm_init_module);
384*4882a593Smuzhiyun module_exit(jsm_exit_module);
385