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	phys_addr_t mapbase;
21	void __iomem *base;
22};
23
24static int mcb_pci_get_irq(struct mcb_device *mdev)
25{
26	struct mcb_bus *mbus = mdev->bus;
27	struct device *dev = mbus->carrier;
28	struct pci_dev *pdev = to_pci_dev(dev);
29
30	return pdev->irq;
31}
32
33static int mcb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
34{
35	struct resource *res;
36	struct priv *priv;
37	int ret;
38	int num_cells;
39	unsigned long flags;
40
41	priv = devm_kzalloc(&pdev->dev, sizeof(struct priv), GFP_KERNEL);
42	if (!priv)
43		return -ENOMEM;
44
45	ret = pci_enable_device(pdev);
46	if (ret) {
47		dev_err(&pdev->dev, "Failed to enable PCI device\n");
48		return -ENODEV;
49	}
50
51	priv->mapbase = pci_resource_start(pdev, 0);
52	if (!priv->mapbase) {
53		dev_err(&pdev->dev, "No PCI resource\n");
54		goto out_disable;
55	}
56
57	res = request_mem_region(priv->mapbase, CHAM_HEADER_SIZE,
58				 KBUILD_MODNAME);
59	if (!res) {
60		dev_err(&pdev->dev, "Failed to request PCI memory\n");
61		ret = -EBUSY;
62		goto out_disable;
63	}
64
65	priv->base = ioremap(priv->mapbase, CHAM_HEADER_SIZE);
66	if (!priv->base) {
67		dev_err(&pdev->dev, "Cannot ioremap\n");
68		ret = -ENOMEM;
69		goto out_release;
70	}
71
72	flags = pci_resource_flags(pdev, 0);
73	if (flags & IORESOURCE_IO) {
74		ret = -ENOTSUPP;
75		dev_err(&pdev->dev,
76			"IO mapped PCI devices are not supported\n");
77		goto out_release;
78	}
79
80	pci_set_drvdata(pdev, priv);
81
82	priv->bus = mcb_alloc_bus(&pdev->dev);
83	if (IS_ERR(priv->bus)) {
84		ret = PTR_ERR(priv->bus);
85		goto out_iounmap;
86	}
87
88	priv->bus->get_irq = mcb_pci_get_irq;
89
90	ret = chameleon_parse_cells(priv->bus, priv->mapbase, priv->base);
91	if (ret < 0)
92		goto out_iounmap;
93	num_cells = ret;
94
95	dev_dbg(&pdev->dev, "Found %d cells\n", num_cells);
96
97	mcb_bus_add_devices(priv->bus);
98
99	return 0;
100
101out_iounmap:
102	iounmap(priv->base);
103out_release:
104	pci_release_region(pdev, 0);
105out_disable:
106	pci_disable_device(pdev);
107	return ret;
108}
109
110static void mcb_pci_remove(struct pci_dev *pdev)
111{
112	struct priv *priv = pci_get_drvdata(pdev);
113
114	mcb_release_bus(priv->bus);
115
116	iounmap(priv->base);
117	release_region(priv->mapbase, CHAM_HEADER_SIZE);
118	pci_disable_device(pdev);
119}
120
121static const struct pci_device_id mcb_pci_tbl[] = {
122	{ PCI_DEVICE(PCI_VENDOR_ID_MEN, PCI_DEVICE_ID_MEN_CHAMELEON) },
123	{ 0 },
124};
125MODULE_DEVICE_TABLE(pci, mcb_pci_tbl);
126
127static struct pci_driver mcb_pci_driver = {
128	.name = "mcb-pci",
129	.id_table = mcb_pci_tbl,
130	.probe = mcb_pci_probe,
131	.remove = mcb_pci_remove,
132};
133
134module_pci_driver(mcb_pci_driver);
135
136MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
137MODULE_LICENSE("GPL");
138MODULE_DESCRIPTION("MCB over PCI support");
139