1b886d83cSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 2b71bb863SJohannes Thumshirn /* 3b71bb863SJohannes Thumshirn * MEN Chameleon Bus. 4b71bb863SJohannes Thumshirn * 5b71bb863SJohannes Thumshirn * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de) 6b71bb863SJohannes Thumshirn * Author: Johannes Thumshirn <johannes.thumshirn@men.de> 7b71bb863SJohannes Thumshirn */ 8b71bb863SJohannes Thumshirn 9b71bb863SJohannes Thumshirn #include <linux/module.h> 10b71bb863SJohannes Thumshirn #include <linux/pci.h> 11b71bb863SJohannes Thumshirn #include <linux/mcb.h> 12b71bb863SJohannes Thumshirn 13b71bb863SJohannes Thumshirn #include "mcb-internal.h" 14b71bb863SJohannes Thumshirn 15b71bb863SJohannes Thumshirn struct priv { 16b71bb863SJohannes Thumshirn struct mcb_bus *bus; 177b7c5491SJohannes Thumshirn phys_addr_t mapbase; 18b71bb863SJohannes Thumshirn void __iomem *base; 19b71bb863SJohannes Thumshirn }; 20b71bb863SJohannes Thumshirn 214ec65b77SJohannes Thumshirn static int mcb_pci_get_irq(struct mcb_device *mdev) 224ec65b77SJohannes Thumshirn { 234ec65b77SJohannes Thumshirn struct mcb_bus *mbus = mdev->bus; 244ec65b77SJohannes Thumshirn struct device *dev = mbus->carrier; 254ec65b77SJohannes Thumshirn struct pci_dev *pdev = to_pci_dev(dev); 264ec65b77SJohannes Thumshirn 274ec65b77SJohannes Thumshirn return pdev->irq; 284ec65b77SJohannes Thumshirn } 294ec65b77SJohannes Thumshirn 30b71bb863SJohannes Thumshirn static int mcb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) 31b71bb863SJohannes Thumshirn { 327b7c5491SJohannes Thumshirn struct resource *res; 33b71bb863SJohannes Thumshirn struct priv *priv; 349be24faaSRodríguez Barbarin, José Javier int ret, table_size; 35b71bb863SJohannes Thumshirn unsigned long flags; 36b71bb863SJohannes Thumshirn 37b71bb863SJohannes Thumshirn priv = devm_kzalloc(&pdev->dev, sizeof(struct priv), GFP_KERNEL); 38b71bb863SJohannes Thumshirn if (!priv) 39b71bb863SJohannes Thumshirn return -ENOMEM; 40b71bb863SJohannes Thumshirn 41b71bb863SJohannes Thumshirn ret = pci_enable_device(pdev); 42b71bb863SJohannes Thumshirn if (ret) { 43b71bb863SJohannes Thumshirn dev_err(&pdev->dev, "Failed to enable PCI device\n"); 44b71bb863SJohannes Thumshirn return -ENODEV; 45b71bb863SJohannes Thumshirn } 4615bb81d3SMichael Moese pci_set_master(pdev); 47b71bb863SJohannes Thumshirn 48*a774c5d1SSanjuán García, Jorge flags = pci_resource_flags(pdev, 0); 49*a774c5d1SSanjuán García, Jorge if (flags & IORESOURCE_IO) { 50*a774c5d1SSanjuán García, Jorge ret = -ENOTSUPP; 51*a774c5d1SSanjuán García, Jorge dev_err(&pdev->dev, 52*a774c5d1SSanjuán García, Jorge "IO mapped PCI devices are not supported\n"); 53*a774c5d1SSanjuán García, Jorge goto out_disable; 54*a774c5d1SSanjuán García, Jorge } 55*a774c5d1SSanjuán García, Jorge 567b7c5491SJohannes Thumshirn priv->mapbase = pci_resource_start(pdev, 0); 577b7c5491SJohannes Thumshirn if (!priv->mapbase) { 58b71bb863SJohannes Thumshirn dev_err(&pdev->dev, "No PCI resource\n"); 59bf25c199SAlexey Khoroshilov ret = -ENODEV; 60a48742bcSJohannes Thumshirn goto out_disable; 61b71bb863SJohannes Thumshirn } 62b71bb863SJohannes Thumshirn 63d19366f1SAndreas Werner res = devm_request_mem_region(&pdev->dev, priv->mapbase, 64d19366f1SAndreas Werner CHAM_HEADER_SIZE, 657b7c5491SJohannes Thumshirn KBUILD_MODNAME); 66d86fb45bSDan Carpenter if (!res) { 677b7c5491SJohannes Thumshirn dev_err(&pdev->dev, "Failed to request PCI memory\n"); 68d86fb45bSDan Carpenter ret = -EBUSY; 69a48742bcSJohannes Thumshirn goto out_disable; 70b71bb863SJohannes Thumshirn } 71b71bb863SJohannes Thumshirn 72d19366f1SAndreas Werner priv->base = devm_ioremap(&pdev->dev, priv->mapbase, CHAM_HEADER_SIZE); 73b71bb863SJohannes Thumshirn if (!priv->base) { 74b71bb863SJohannes Thumshirn dev_err(&pdev->dev, "Cannot ioremap\n"); 75b71bb863SJohannes Thumshirn ret = -ENOMEM; 76d19366f1SAndreas Werner goto out_disable; 77b71bb863SJohannes Thumshirn } 78b71bb863SJohannes Thumshirn 79b71bb863SJohannes Thumshirn pci_set_drvdata(pdev, priv); 80b71bb863SJohannes Thumshirn 814ec65b77SJohannes Thumshirn priv->bus = mcb_alloc_bus(&pdev->dev); 824ec65b77SJohannes Thumshirn if (IS_ERR(priv->bus)) { 834ec65b77SJohannes Thumshirn ret = PTR_ERR(priv->bus); 84d19366f1SAndreas Werner goto out_disable; 854ec65b77SJohannes Thumshirn } 864ec65b77SJohannes Thumshirn 874ec65b77SJohannes Thumshirn priv->bus->get_irq = mcb_pci_get_irq; 88b71bb863SJohannes Thumshirn 897b7c5491SJohannes Thumshirn ret = chameleon_parse_cells(priv->bus, priv->mapbase, priv->base); 90b71bb863SJohannes Thumshirn if (ret < 0) 9141ada9dfSAlexey Khoroshilov goto out_mcb_bus; 92b71bb863SJohannes Thumshirn 939be24faaSRodríguez Barbarin, José Javier table_size = ret; 949be24faaSRodríguez Barbarin, José Javier 959be24faaSRodríguez Barbarin, José Javier if (table_size < CHAM_HEADER_SIZE) { 969be24faaSRodríguez Barbarin, José Javier /* Release the previous resources */ 979be24faaSRodríguez Barbarin, José Javier devm_iounmap(&pdev->dev, priv->base); 989be24faaSRodríguez Barbarin, José Javier devm_release_mem_region(&pdev->dev, priv->mapbase, CHAM_HEADER_SIZE); 999be24faaSRodríguez Barbarin, José Javier 1009be24faaSRodríguez Barbarin, José Javier /* Then, allocate it again with the actual chameleon table size */ 1019be24faaSRodríguez Barbarin, José Javier res = devm_request_mem_region(&pdev->dev, priv->mapbase, 1029be24faaSRodríguez Barbarin, José Javier table_size, 1039be24faaSRodríguez Barbarin, José Javier KBUILD_MODNAME); 1049be24faaSRodríguez Barbarin, José Javier if (!res) { 1059be24faaSRodríguez Barbarin, José Javier dev_err(&pdev->dev, "Failed to request PCI memory\n"); 1069be24faaSRodríguez Barbarin, José Javier ret = -EBUSY; 1079be24faaSRodríguez Barbarin, José Javier goto out_mcb_bus; 1089be24faaSRodríguez Barbarin, José Javier } 1099be24faaSRodríguez Barbarin, José Javier 1109be24faaSRodríguez Barbarin, José Javier priv->base = devm_ioremap(&pdev->dev, priv->mapbase, table_size); 1119be24faaSRodríguez Barbarin, José Javier if (!priv->base) { 1129be24faaSRodríguez Barbarin, José Javier dev_err(&pdev->dev, "Cannot ioremap\n"); 1139be24faaSRodríguez Barbarin, José Javier ret = -ENOMEM; 1149be24faaSRodríguez Barbarin, José Javier goto out_mcb_bus; 1159be24faaSRodríguez Barbarin, José Javier } 1169be24faaSRodríguez Barbarin, José Javier } 117b71bb863SJohannes Thumshirn 118b71bb863SJohannes Thumshirn mcb_bus_add_devices(priv->bus); 119b71bb863SJohannes Thumshirn 1207b7c5491SJohannes Thumshirn return 0; 1217b7c5491SJohannes Thumshirn 12241ada9dfSAlexey Khoroshilov out_mcb_bus: 12341ada9dfSAlexey Khoroshilov mcb_release_bus(priv->bus); 124a48742bcSJohannes Thumshirn out_disable: 125b71bb863SJohannes Thumshirn pci_disable_device(pdev); 126b71bb863SJohannes Thumshirn return ret; 127b71bb863SJohannes Thumshirn } 128b71bb863SJohannes Thumshirn 129b71bb863SJohannes Thumshirn static void mcb_pci_remove(struct pci_dev *pdev) 130b71bb863SJohannes Thumshirn { 131b71bb863SJohannes Thumshirn struct priv *priv = pci_get_drvdata(pdev); 132b71bb863SJohannes Thumshirn 133b71bb863SJohannes Thumshirn mcb_release_bus(priv->bus); 1347b7c5491SJohannes Thumshirn 1357b7c5491SJohannes Thumshirn pci_disable_device(pdev); 136b71bb863SJohannes Thumshirn } 137b71bb863SJohannes Thumshirn 138b71bb863SJohannes Thumshirn static const struct pci_device_id mcb_pci_tbl[] = { 139b71bb863SJohannes Thumshirn { PCI_DEVICE(PCI_VENDOR_ID_MEN, PCI_DEVICE_ID_MEN_CHAMELEON) }, 14029ea6be3SJohannes Thumshirn { PCI_DEVICE(PCI_VENDOR_ID_ALTERA, PCI_DEVICE_ID_MEN_CHAMELEON) }, 141b71bb863SJohannes Thumshirn { 0 }, 142b71bb863SJohannes Thumshirn }; 143b71bb863SJohannes Thumshirn MODULE_DEVICE_TABLE(pci, mcb_pci_tbl); 144b71bb863SJohannes Thumshirn 145b71bb863SJohannes Thumshirn static struct pci_driver mcb_pci_driver = { 146b71bb863SJohannes Thumshirn .name = "mcb-pci", 147b71bb863SJohannes Thumshirn .id_table = mcb_pci_tbl, 148b71bb863SJohannes Thumshirn .probe = mcb_pci_probe, 149b71bb863SJohannes Thumshirn .remove = mcb_pci_remove, 150b71bb863SJohannes Thumshirn }; 151b71bb863SJohannes Thumshirn 152b71bb863SJohannes Thumshirn module_pci_driver(mcb_pci_driver); 153b71bb863SJohannes Thumshirn 154b71bb863SJohannes Thumshirn MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>"); 155b71bb863SJohannes Thumshirn MODULE_LICENSE("GPL"); 156b71bb863SJohannes Thumshirn MODULE_DESCRIPTION("MCB over PCI support"); 157891e6036SJohannes Thumshirn MODULE_IMPORT_NS(MCB); 158