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