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
)
41 priv
= devm_kzalloc(&pdev
->dev
, sizeof(struct priv
), GFP_KERNEL
);
45 ret
= pci_enable_device(pdev
);
47 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");
57 res
= request_mem_region(priv
->mapbase
, CHAM_HEADER_SIZE
,
60 dev_err(&pdev
->dev
, "Failed to request PCI memory\n");
65 priv
->base
= ioremap(priv
->mapbase
, CHAM_HEADER_SIZE
);
67 dev_err(&pdev
->dev
, "Cannot ioremap\n");
72 flags
= pci_resource_flags(pdev
, 0);
73 if (flags
& IORESOURCE_IO
) {
76 "IO mapped PCI devices are not supported\n");
80 pci_set_drvdata(pdev
, priv
);
82 priv
->bus
= mcb_alloc_bus(&pdev
->dev
);
83 if (IS_ERR(priv
->bus
)) {
84 ret
= PTR_ERR(priv
->bus
);
88 priv
->bus
->get_irq
= mcb_pci_get_irq
;
90 ret
= chameleon_parse_cells(priv
->bus
, priv
->mapbase
, priv
->base
);
95 dev_dbg(&pdev
->dev
, "Found %d cells\n", num_cells
);
97 mcb_bus_add_devices(priv
->bus
);
104 pci_release_region(pdev
, 0);
106 pci_disable_device(pdev
);
110 static void mcb_pci_remove(struct pci_dev
*pdev
)
112 struct priv
*priv
= pci_get_drvdata(pdev
);
114 mcb_release_bus(priv
->bus
);
117 release_region(priv
->mapbase
, CHAM_HEADER_SIZE
);
118 pci_disable_device(pdev
);
121 static const struct pci_device_id mcb_pci_tbl
[] = {
122 { PCI_DEVICE(PCI_VENDOR_ID_MEN
, PCI_DEVICE_ID_MEN_CHAMELEON
) },
125 MODULE_DEVICE_TABLE(pci
, mcb_pci_tbl
);
127 static struct pci_driver mcb_pci_driver
= {
129 .id_table
= mcb_pci_tbl
,
130 .probe
= mcb_pci_probe
,
131 .remove
= mcb_pci_remove
,
134 module_pci_driver(mcb_pci_driver
);
136 MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
137 MODULE_LICENSE("GPL");
138 MODULE_DESCRIPTION("MCB over PCI support");