drivers/mcb/mcb-pci.c

   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
  18 struct priv {
  19         struct mcb_bus *bus;
  20         void __iomem *base;
  21 };
  22
  23 static 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
  32 static 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
  96 err_drvdata:
  97         pci_iounmap(pdev, priv->base);
  98 err_ioremap:
  99         pci_release_region(pdev, 0);
 100 err_start:
 101         pci_disable_device(pdev);
 102         return ret;
 103 }
 104
 105 static 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
 112 static const struct pci_device_id mcb_pci_tbl[] = {
 113         { PCI_DEVICE(PCI_VENDOR_ID_MEN, PCI_DEVICE_ID_MEN_CHAMELEON) },
 114         { 0 },
 115 };
 116 MODULE_DEVICE_TABLE(pci, mcb_pci_tbl);
 117
 118 static 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
 125 module_pci_driver(mcb_pci_driver);
 126
 127 MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
 128 MODULE_LICENSE("GPL");
 129 MODULE_DESCRIPTION("MCB over PCI support");