blob: de36237d7c6b45de10fca57cc1870fde5a0620e5 [file] [log] [blame]
Johannes Thumshirnb71bb862014-02-26 17:29:06 +01001/*
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;
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010020 phys_addr_t mapbase;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010021 void __iomem *base;
22};
23
Johannes Thumshirn4ec65b72014-04-24 14:35:25 +020024static 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
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010033static int mcb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
34{
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010035 struct resource *res;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010036 struct priv *priv;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010037 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
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010051 priv->mapbase = pci_resource_start(pdev, 0);
52 if (!priv->mapbase) {
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010053 dev_err(&pdev->dev, "No PCI resource\n");
Johannes Thumshirna48742b2015-01-12 16:26:32 +010054 goto out_disable;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010055 }
56
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010057 res = request_mem_region(priv->mapbase, CHAM_HEADER_SIZE,
58 KBUILD_MODNAME);
Dan Carpenterd86fb452015-03-26 22:12:49 +030059 if (!res) {
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010060 dev_err(&pdev->dev, "Failed to request PCI memory\n");
Dan Carpenterd86fb452015-03-26 22:12:49 +030061 ret = -EBUSY;
Johannes Thumshirna48742b2015-01-12 16:26:32 +010062 goto out_disable;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010063 }
64
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010065 priv->base = ioremap(priv->mapbase, CHAM_HEADER_SIZE);
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010066 if (!priv->base) {
67 dev_err(&pdev->dev, "Cannot ioremap\n");
68 ret = -ENOMEM;
Johannes Thumshirna48742b2015-01-12 16:26:32 +010069 goto out_release;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010070 }
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");
Johannes Thumshirna48742b2015-01-12 16:26:32 +010077 goto out_release;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010078 }
79
80 pci_set_drvdata(pdev, priv);
81
Johannes Thumshirn4ec65b72014-04-24 14:35:25 +020082 priv->bus = mcb_alloc_bus(&pdev->dev);
83 if (IS_ERR(priv->bus)) {
84 ret = PTR_ERR(priv->bus);
Johannes Thumshirna48742b2015-01-12 16:26:32 +010085 goto out_iounmap;
Johannes Thumshirn4ec65b72014-04-24 14:35:25 +020086 }
87
88 priv->bus->get_irq = mcb_pci_get_irq;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010089
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010090 ret = chameleon_parse_cells(priv->bus, priv->mapbase, priv->base);
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010091 if (ret < 0)
Johannes Thumshirna48742b2015-01-12 16:26:32 +010092 goto out_iounmap;
Johannes Thumshirnb71bb862014-02-26 17:29:06 +010093 num_cells = ret;
94
95 dev_dbg(&pdev->dev, "Found %d cells\n", num_cells);
96
97 mcb_bus_add_devices(priv->bus);
98
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +010099 return 0;
100
Johannes Thumshirna48742b2015-01-12 16:26:32 +0100101out_iounmap:
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +0100102 iounmap(priv->base);
Johannes Thumshirna48742b2015-01-12 16:26:32 +0100103out_release:
Johannes Thumshirnb71bb862014-02-26 17:29:06 +0100104 pci_release_region(pdev, 0);
Johannes Thumshirna48742b2015-01-12 16:26:32 +0100105out_disable:
Johannes Thumshirnb71bb862014-02-26 17:29:06 +0100106 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);
Johannes Thumshirn7b7c5492014-12-16 10:09:20 +0100115
116 iounmap(priv->base);
117 release_region(priv->mapbase, CHAM_HEADER_SIZE);
118 pci_disable_device(pdev);
Johannes Thumshirnb71bb862014-02-26 17:29:06 +0100119}
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");