[linux-block.git] / drivers / mcb / mcb-pci.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * MEN Chameleon Bus.
 *
 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
 * Author: Johannes Thumshirn <johannes.thumshirn@men.de>
 */

#include <linux/module.h>
#include <linux/pci.h>
#include <linux/mcb.h>

#include "mcb-internal.h"

struct priv {
	struct mcb_bus *bus;
	phys_addr_t mapbase;
	void __iomem *base;
};

static int mcb_pci_get_irq(struct mcb_device *mdev)
{
	struct mcb_bus *mbus = mdev->bus;
	struct device *dev = mbus->carrier;
	struct pci_dev *pdev = to_pci_dev(dev);

	return pdev->irq;
}

static int mcb_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
{
	struct resource *res;
	struct priv *priv;
	int ret;
	unsigned long flags;

	priv = devm_kzalloc(&pdev->dev, sizeof(struct priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	ret = pci_enable_device(pdev);
	if (ret) {
		dev_err(&pdev->dev, "Failed to enable PCI device\n");
		return -ENODEV;
	}
	pci_set_master(pdev);

	priv->mapbase = pci_resource_start(pdev, 0);
	if (!priv->mapbase) {
		dev_err(&pdev->dev, "No PCI resource\n");
		ret = -ENODEV;
		goto out_disable;
	}

	res = devm_request_mem_region(&pdev->dev, priv->mapbase,
				      CHAM_HEADER_SIZE,
				      KBUILD_MODNAME);
	if (!res) {
		dev_err(&pdev->dev, "Failed to request PCI memory\n");
		ret = -EBUSY;
		goto out_disable;
	}

	priv->base = devm_ioremap(&pdev->dev, priv->mapbase, CHAM_HEADER_SIZE);
	if (!priv->base) {
		dev_err(&pdev->dev, "Cannot ioremap\n");
		ret = -ENOMEM;
		goto out_disable;
	}

	flags = pci_resource_flags(pdev, 0);
	if (flags & IORESOURCE_IO) {
		ret = -ENOTSUPP;
		dev_err(&pdev->dev,
			"IO mapped PCI devices are not supported\n");
		goto out_disable;
	}

	pci_set_drvdata(pdev, priv);

	priv->bus = mcb_alloc_bus(&pdev->dev);
	if (IS_ERR(priv->bus)) {
		ret = PTR_ERR(priv->bus);
		goto out_disable;
	}

	priv->bus->get_irq = mcb_pci_get_irq;

	ret = chameleon_parse_cells(priv->bus, priv->mapbase, priv->base);
	if (ret < 0)
		goto out_mcb_bus;

	dev_dbg(&pdev->dev, "Found %d cells\n", ret);

	mcb_bus_add_devices(priv->bus);

	return 0;

out_mcb_bus:
	mcb_release_bus(priv->bus);
out_disable:
	pci_disable_device(pdev);
	return ret;
}

static void mcb_pci_remove(struct pci_dev *pdev)
{
	struct priv *priv = pci_get_drvdata(pdev);

	mcb_release_bus(priv->bus);

	pci_disable_device(pdev);
}

static const struct pci_device_id mcb_pci_tbl[] = {
	{ PCI_DEVICE(PCI_VENDOR_ID_MEN, PCI_DEVICE_ID_MEN_CHAMELEON) },
	{ PCI_DEVICE(PCI_VENDOR_ID_ALTERA, PCI_DEVICE_ID_MEN_CHAMELEON) },
	{ 0 },
};
MODULE_DEVICE_TABLE(pci, mcb_pci_tbl);

static struct pci_driver mcb_pci_driver = {
	.name = "mcb-pci",
	.id_table = mcb_pci_tbl,
	.probe = mcb_pci_probe,
	.remove = mcb_pci_remove,
};

module_pci_driver(mcb_pci_driver);

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