mcb-pci.c revision 4ec65b77c64504e178d75aaba6ac96f68837416c 
1/*
2 * MEN Chameleon Bus.
3 *
4 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
5 * Author: Johannes Thumshirn <johannes.thumshirn@men.de>
6 *
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.
10 */
11
12#include <linux/module.h>
13#include <linux/pci.h>
14#include <linux/mcb.h>
15
16#include "mcb-internal.h"
17
18struct priv {
19	struct mcb_bus *bus;
20	void __iomem *base;
21};
22
23static int mcb_pci_get_irq(struct mcb_device *mdev)
24{
25	struct mcb_bus *mbus = mdev->bus;
26	struct device *dev = mbus->carrier;
27	struct pci_dev *pdev = to_pci_dev(dev);
28
29	return pdev->irq;
30}
31
32static int mcb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
33{
34	struct priv *priv;
35	phys_addr_t mapbase;
36	int ret;
37	int num_cells;
38	unsigned long flags;
39
40	priv = devm_kzalloc(&pdev->dev, sizeof(struct priv), GFP_KERNEL);
41	if (!priv)
42		return -ENOMEM;
43
44	ret = pci_enable_device(pdev);
45	if (ret) {
46		dev_err(&pdev->dev, "Failed to enable PCI device\n");
47		return -ENODEV;
48	}
49
50	mapbase = pci_resource_start(pdev, 0);
51	if (!mapbase) {
52		dev_err(&pdev->dev, "No PCI resource\n");
53		goto err_start;
54	}
55
56	ret = pci_request_region(pdev, 0, KBUILD_MODNAME);
57	if (ret) {
58		dev_err(&pdev->dev, "Failed to request PCI BARs\n");
59		goto err_start;
60	}
61
62	priv->base = pci_iomap(pdev, 0, 0);
63	if (!priv->base) {
64		dev_err(&pdev->dev, "Cannot ioremap\n");
65		ret = -ENOMEM;
66		goto err_ioremap;
67	}
68
69	flags = pci_resource_flags(pdev, 0);
70	if (flags & IORESOURCE_IO) {
71		ret = -ENOTSUPP;
72		dev_err(&pdev->dev,
73			"IO mapped PCI devices are not supported\n");
74		goto err_ioremap;
75	}
76
77	pci_set_drvdata(pdev, priv);
78
79	priv->bus = mcb_alloc_bus(&pdev->dev);
80	if (IS_ERR(priv->bus)) {
81		ret = PTR_ERR(priv->bus);
82		goto err_drvdata;
83	}
84
85	priv->bus->get_irq = mcb_pci_get_irq;
86
87	ret = chameleon_parse_cells(priv->bus, mapbase, priv->base);
88	if (ret < 0)
89		goto err_drvdata;
90	num_cells = ret;
91
92	dev_dbg(&pdev->dev, "Found %d cells\n", num_cells);
93
94	mcb_bus_add_devices(priv->bus);
95
96err_drvdata:
97	pci_iounmap(pdev, priv->base);
98err_ioremap:
99	pci_release_region(pdev, 0);
100err_start:
101	pci_disable_device(pdev);
102	return ret;
103}
104
105static void mcb_pci_remove(struct pci_dev *pdev)
106{
107	struct priv *priv = pci_get_drvdata(pdev);
108
109	mcb_release_bus(priv->bus);
110}
111
112static const struct pci_device_id mcb_pci_tbl[] = {
113	{ PCI_DEVICE(PCI_VENDOR_ID_MEN, PCI_DEVICE_ID_MEN_CHAMELEON) },
114	{ 0 },
115};
116MODULE_DEVICE_TABLE(pci, mcb_pci_tbl);
117
118static struct pci_driver mcb_pci_driver = {
119	.name = "mcb-pci",
120	.id_table = mcb_pci_tbl,
121	.probe = mcb_pci_probe,
122	.remove = mcb_pci_remove,
123};
124
125module_pci_driver(mcb_pci_driver);
126
127MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
128MODULE_LICENSE("GPL");
129MODULE_DESCRIPTION("MCB over PCI support");
130