1 // SPDX-License-Identifier: GPL-2.0-only
5 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
6 * Author: Johannes Thumshirn <johannes.thumshirn@men.de>
9 #include <linux/module.h>
10 #include <linux/pci.h>
11 #include <linux/mcb.h>
13 #include "mcb-internal.h"
21 static int mcb_pci_get_irq(struct mcb_device
*mdev
)
23 struct mcb_bus
*mbus
= mdev
->bus
;
24 struct device
*dev
= mbus
->carrier
;
25 struct pci_dev
*pdev
= to_pci_dev(dev
);
30 static int mcb_pci_probe(struct pci_dev
*pdev
, const struct pci_device_id
*id
)
37 priv
= devm_kzalloc(&pdev
->dev
, sizeof(struct priv
), GFP_KERNEL
);
41 ret
= pci_enable_device(pdev
);
43 dev_err(&pdev
->dev
, "Failed to enable PCI device\n");
48 flags
= pci_resource_flags(pdev
, 0);
49 if (flags
& IORESOURCE_IO
) {
52 "IO mapped PCI devices are not supported\n");
56 priv
->mapbase
= pci_resource_start(pdev
, 0);
58 dev_err(&pdev
->dev
, "No PCI resource\n");
63 res
= devm_request_mem_region(&pdev
->dev
, priv
->mapbase
,
67 dev_err(&pdev
->dev
, "Failed to request PCI memory\n");
72 priv
->base
= devm_ioremap(&pdev
->dev
, priv
->mapbase
, CHAM_HEADER_SIZE
);
74 dev_err(&pdev
->dev
, "Cannot ioremap\n");
79 pci_set_drvdata(pdev
, priv
);
81 priv
->bus
= mcb_alloc_bus(&pdev
->dev
);
82 if (IS_ERR(priv
->bus
)) {
83 ret
= PTR_ERR(priv
->bus
);
87 priv
->bus
->get_irq
= mcb_pci_get_irq
;
89 ret
= chameleon_parse_cells(priv
->bus
, priv
->mapbase
, priv
->base
);
95 if (table_size
< CHAM_HEADER_SIZE
) {
96 /* Release the previous resources */
97 devm_iounmap(&pdev
->dev
, priv
->base
);
98 devm_release_mem_region(&pdev
->dev
, priv
->mapbase
, CHAM_HEADER_SIZE
);
100 /* Then, allocate it again with the actual chameleon table size */
101 res
= devm_request_mem_region(&pdev
->dev
, priv
->mapbase
,
105 dev_err(&pdev
->dev
, "Failed to request PCI memory\n");
110 priv
->base
= devm_ioremap(&pdev
->dev
, priv
->mapbase
, table_size
);
112 dev_err(&pdev
->dev
, "Cannot ioremap\n");
118 mcb_bus_add_devices(priv
->bus
);
123 mcb_release_bus(priv
->bus
);
125 pci_disable_device(pdev
);
129 static void mcb_pci_remove(struct pci_dev
*pdev
)
131 struct priv
*priv
= pci_get_drvdata(pdev
);
133 mcb_release_bus(priv
->bus
);
135 pci_disable_device(pdev
);
138 static const struct pci_device_id mcb_pci_tbl
[] = {
139 { PCI_DEVICE(PCI_VENDOR_ID_MEN
, PCI_DEVICE_ID_MEN_CHAMELEON
) },
140 { PCI_DEVICE(PCI_VENDOR_ID_ALTERA
, PCI_DEVICE_ID_MEN_CHAMELEON
) },
143 MODULE_DEVICE_TABLE(pci
, mcb_pci_tbl
);
145 static struct pci_driver mcb_pci_driver
= {
147 .id_table
= mcb_pci_tbl
,
148 .probe
= mcb_pci_probe
,
149 .remove
= mcb_pci_remove
,
152 module_pci_driver(mcb_pci_driver
);
154 MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
155 MODULE_LICENSE("GPL");
156 MODULE_DESCRIPTION("MCB over PCI support");
157 MODULE_IMPORT_NS("MCB");