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

/*
 * MEN Chameleon Bus.
 *
 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
 * Author: Johannes Thumshirn <johannes.thumshirn@men.de>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the Free
 * Software Foundation; version 2 of the License.
 */

#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;
	int num_cells;
	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;
	}

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

	res = request_mem_region(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 = ioremap(priv->mapbase, CHAM_HEADER_SIZE);
	if (!priv->base) {
		dev_err(&pdev->dev, "Cannot ioremap\n");
		ret = -ENOMEM;
		goto out_release;
	}

	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_iounmap;
	}

	pci_set_drvdata(pdev, priv);

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

	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;
	num_cells = ret;

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

	mcb_bus_add_devices(priv->bus);

	return 0;

out_mcb_bus:
	mcb_release_bus(priv->bus);
out_iounmap:
	iounmap(priv->base);
out_release:
	pci_release_region(pdev, 0);
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);

	iounmap(priv->base);
	release_region(priv->mapbase, CHAM_HEADER_SIZE);
	pci_disable_device(pdev);
}

static const struct pci_device_id mcb_pci_tbl[] = {
	{ PCI_DEVICE(PCI_VENDOR_ID_MEN, 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");
Commit	Line	Data
b71bb863 JT	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;
7b7c5491	20	phys_addr_t mapbase;
b71bb863 JT	21	void __iomem *base;
	22	};
	23
4ec65b77 JT	24	static 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
b71bb863 JT	33	static int mcb_pci_probe(struct pci_dev pdev, const struct pci_device_id id)
b71bb863 JT	34	{
7b7c5491	35	struct resource *res;
b71bb863	36	struct priv *priv;
b71bb863 JT	37	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
7b7c5491 JT	51	priv->mapbase = pci_resource_start(pdev, 0);
7b7c5491 JT	52	if (!priv->mapbase) {
b71bb863	53	dev_err(&pdev->dev, "No PCI resource\n");
bf25c199	54	ret = -ENODEV;
a48742bc	55	goto out_disable;
b71bb863 JT	56	}
b71bb863 JT	57
7b7c5491 JT	58	res = request_mem_region(priv->mapbase, CHAM_HEADER_SIZE,
7b7c5491 JT	59	KBUILD_MODNAME);
d86fb45b	60	if (!res) {
7b7c5491	61	dev_err(&pdev->dev, "Failed to request PCI memory\n");
d86fb45b	62	ret = -EBUSY;
a48742bc	63	goto out_disable;
b71bb863 JT	64	}
b71bb863 JT	65
7b7c5491	66	priv->base = ioremap(priv->mapbase, CHAM_HEADER_SIZE);
b71bb863 JT	67	if (!priv->base) {
	68	dev_err(&pdev->dev, "Cannot ioremap\n");
	69	ret = -ENOMEM;
a48742bc	70	goto out_release;
b71bb863 JT	71	}
	72
	73	flags = pci_resource_flags(pdev, 0);
	74	if (flags & IORESOURCE_IO) {
	75	ret = -ENOTSUPP;
	76	dev_err(&pdev->dev,
	77	"IO mapped PCI devices are not supported\n");
41ada9df	78	goto out_iounmap;
b71bb863 JT	79	}
	80
	81	pci_set_drvdata(pdev, priv);
	82
4ec65b77 JT	83	priv->bus = mcb_alloc_bus(&pdev->dev);
	84	if (IS_ERR(priv->bus)) {
	85	ret = PTR_ERR(priv->bus);
a48742bc	86	goto out_iounmap;
4ec65b77 JT	87	}
	88
	89	priv->bus->get_irq = mcb_pci_get_irq;
b71bb863	90
7b7c5491	91	ret = chameleon_parse_cells(priv->bus, priv->mapbase, priv->base);
b71bb863	92	if (ret < 0)
41ada9df	93	goto out_mcb_bus;
b71bb863 JT	94	num_cells = ret;
	95
	96	dev_dbg(&pdev->dev, "Found %d cells\n", num_cells);
	97
	98	mcb_bus_add_devices(priv->bus);
	99
7b7c5491 JT	100	return 0;
7b7c5491 JT	101
41ada9df AK	102	out_mcb_bus:
41ada9df AK	103	mcb_release_bus(priv->bus);
a48742bc	104	out_iounmap:
7b7c5491	105	iounmap(priv->base);
a48742bc	106	out_release:
b71bb863	107	pci_release_region(pdev, 0);
a48742bc	108	out_disable:
b71bb863 JT	109	pci_disable_device(pdev);
	110	return ret;
	111	}
	112
	113	static void mcb_pci_remove(struct pci_dev *pdev)
	114	{
	115	struct priv *priv = pci_get_drvdata(pdev);
	116
	117	mcb_release_bus(priv->bus);
7b7c5491 JT	118
	119	iounmap(priv->base);
	120	release_region(priv->mapbase, CHAM_HEADER_SIZE);
	121	pci_disable_device(pdev);
b71bb863 JT	122	}
	123
	124	static const struct pci_device_id mcb_pci_tbl[] = {
	125	{ PCI_DEVICE(PCI_VENDOR_ID_MEN, PCI_DEVICE_ID_MEN_CHAMELEON) },
	126	{ 0 },
	127	};
	128	MODULE_DEVICE_TABLE(pci, mcb_pci_tbl);
	129
	130	static struct pci_driver mcb_pci_driver = {
	131	.name = "mcb-pci",
	132	.id_table = mcb_pci_tbl,
	133	.probe = mcb_pci_probe,
	134	.remove = mcb_pci_remove,
	135	};
	136
	137	module_pci_driver(mcb_pci_driver);
	138
	139	MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
	140	MODULE_LICENSE("GPL");
	141	MODULE_DESCRIPTION("MCB over PCI support");