4 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
5 * Author: Johannes Thumshirn <johannes.thumshirn@men.de>
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the Free
9 * Software Foundation; version 2 of the License.
12 #include <linux/module.h>
13 #include <linux/pci.h>
14 #include <linux/mcb.h>
16 #include "mcb-internal.h"
24 static int mcb_pci_get_irq(struct mcb_device *mdev)
26 struct mcb_bus *mbus = mdev->bus;
27 struct device *dev = mbus->carrier;
28 struct pci_dev *pdev = to_pci_dev(dev);
33 static int mcb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
40 priv = devm_kzalloc(&pdev->dev, sizeof(struct priv), GFP_KERNEL);
44 ret = pci_enable_device(pdev);
46 dev_err(&pdev->dev, "Failed to enable PCI device\n");
51 priv->mapbase = pci_resource_start(pdev, 0);
53 dev_err(&pdev->dev, "No PCI resource\n");
58 res = devm_request_mem_region(&pdev->dev, priv->mapbase,
62 dev_err(&pdev->dev, "Failed to request PCI memory\n");
67 priv->base = devm_ioremap(&pdev->dev, priv->mapbase, CHAM_HEADER_SIZE);
69 dev_err(&pdev->dev, "Cannot ioremap\n");
74 flags = pci_resource_flags(pdev, 0);
75 if (flags & IORESOURCE_IO) {
78 "IO mapped PCI devices are not supported\n");
82 pci_set_drvdata(pdev, priv);
84 priv->bus = mcb_alloc_bus(&pdev->dev);
85 if (IS_ERR(priv->bus)) {
86 ret = PTR_ERR(priv->bus);
90 priv->bus->get_irq = mcb_pci_get_irq;
92 ret = chameleon_parse_cells(priv->bus, priv->mapbase, priv->base);
98 if (table_size < CHAM_HEADER_SIZE) {
99 /* Release the previous resources */
100 devm_iounmap(&pdev->dev, priv->base);
101 devm_release_mem_region(&pdev->dev, priv->mapbase, CHAM_HEADER_SIZE);
103 /* Then, allocate it again with the actual chameleon table size */
104 res = devm_request_mem_region(&pdev->dev, priv->mapbase,
108 dev_err(&pdev->dev, "Failed to request PCI memory\n");
113 priv->base = devm_ioremap(&pdev->dev, priv->mapbase, table_size);
115 dev_err(&pdev->dev, "Cannot ioremap\n");
121 mcb_bus_add_devices(priv->bus);
126 mcb_release_bus(priv->bus);
128 pci_disable_device(pdev);
132 static void mcb_pci_remove(struct pci_dev *pdev)
134 struct priv *priv = pci_get_drvdata(pdev);
136 mcb_release_bus(priv->bus);
138 pci_disable_device(pdev);
141 static const struct pci_device_id mcb_pci_tbl[] = {
142 { PCI_DEVICE(PCI_VENDOR_ID_MEN, PCI_DEVICE_ID_MEN_CHAMELEON) },
143 { PCI_DEVICE(PCI_VENDOR_ID_ALTERA, PCI_DEVICE_ID_MEN_CHAMELEON) },
146 MODULE_DEVICE_TABLE(pci, mcb_pci_tbl);
148 static struct pci_driver mcb_pci_driver = {
150 .id_table = mcb_pci_tbl,
151 .probe = mcb_pci_probe,
152 .remove = mcb_pci_remove,
155 module_pci_driver(mcb_pci_driver);
157 MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
158 MODULE_LICENSE("GPL");
159 MODULE_DESCRIPTION("MCB over PCI support");