drivers/usb/host/isp1760-if.c - kernel/msm-4.19 - Gitiles

 /*
  * Glue code for the ISP1760 driver and bus
  * Currently there is support for
  * - OpenFirmware
  * - PCI
  * - PDEV (generic platform device centralized driver model)
  *
  * (c) 2007 Sebastian Siewior <bigeasy@linutronix.de>
  *
  */

 #include <linux/usb.h>
 #include <linux/io.h>
 #include <linux/module.h>
 #include <linux/of.h>
 #include <linux/platform_device.h>
 #include <linux/slab.h>
 #include <linux/usb/isp1760.h>
 #include <linux/usb/hcd.h>

 #include "isp1760-hcd.h"

 #ifdef CONFIG_PCI
 #include <linux/pci.h>
 #endif

 #ifdef CONFIG_PCI
 static int isp1761_pci_probe(struct pci_dev *dev,
 		const struct pci_device_id *id)
 {
 	u8 latency, limit;
 	__u32 reg_data;
 	int retry_count;
 	struct usb_hcd *hcd;
 	unsigned int devflags = 0;
 	int ret_status = 0;

 	resource_size_t pci_mem_phy0;
 	resource_size_t memlength;

 	u8 __iomem *chip_addr;
 	u8 __iomem *iobase;
 	resource_size_t nxp_pci_io_base;
 	resource_size_t iolength;

 	if (usb_disabled())
 		return -ENODEV;

 	if (pci_enable_device(dev) < 0)
 		return -ENODEV;

 	if (!dev->irq)
 		return -ENODEV;

 	/* Grab the PLX PCI mem maped port start address we need  */
 	nxp_pci_io_base = pci_resource_start(dev, 0);
 	iolength = pci_resource_len(dev, 0);

 	if (!request_mem_region(nxp_pci_io_base, iolength, "ISP1761 IO MEM")) {
 		printk(KERN_ERR "request region #1\n");
 		return -EBUSY;
 	}

 	iobase = ioremap_nocache(nxp_pci_io_base, iolength);
 	if (!iobase) {
 		printk(KERN_ERR "ioremap #1\n");
 		ret_status = -ENOMEM;
 		goto cleanup1;
 	}
 	/* Grab the PLX PCI shared memory of the ISP 1761 we need  */
 	pci_mem_phy0 = pci_resource_start(dev, 3);
 	memlength = pci_resource_len(dev, 3);
 	if (memlength < 0xffff) {
 		printk(KERN_ERR "memory length for this resource is wrong\n");
 		ret_status = -ENOMEM;
 		goto cleanup2;
 	}

 	if (!request_mem_region(pci_mem_phy0, memlength, "ISP-PCI")) {
 		printk(KERN_ERR "host controller already in use\n");
 		ret_status = -EBUSY;
 		goto cleanup2;
 	}

 	/* map available memory */
 	chip_addr = ioremap_nocache(pci_mem_phy0,memlength);
 	if (!chip_addr) {
 		printk(KERN_ERR "Error ioremap failed\n");
 		ret_status = -ENOMEM;
 		goto cleanup3;
 	}

 	/* bad pci latencies can contribute to overruns */
 	pci_read_config_byte(dev, PCI_LATENCY_TIMER, &latency);
 	if (latency) {
 		pci_read_config_byte(dev, PCI_MAX_LAT, &limit);
 		if (limit && limit < latency)
 			pci_write_config_byte(dev, PCI_LATENCY_TIMER, limit);
 	}

 	/* Try to check whether we can access Scratch Register of
 	 * Host Controller or not. The initial PCI access is retried until
 	 * local init for the PCI bridge is completed
 	 */
 	retry_count = 20;
 	reg_data = 0;
 	while ((reg_data != 0xFACE) && retry_count) {
 		/*by default host is in 16bit mode, so
 		 * io operations at this stage must be 16 bit
 		 * */
 		writel(0xface, chip_addr + HC_SCRATCH_REG);
 		udelay(100);
 		reg_data = readl(chip_addr + HC_SCRATCH_REG) & 0x0000ffff;
 		retry_count--;
 	}

 	iounmap(chip_addr);

 	/* Host Controller presence is detected by writing to scratch register
 	 * and reading back and checking the contents are same or not
 	 */
 	if (reg_data != 0xFACE) {
 		dev_err(&dev->dev, "scratch register mismatch %x\n", reg_data);
 		ret_status = -ENOMEM;
 		goto cleanup3;
 	}

 	pci_set_master(dev);

 	/* configure PLX PCI chip to pass interrupts */
 #define PLX_INT_CSR_REG 0x68
 	reg_data = readl(iobase + PLX_INT_CSR_REG);
 	reg_data |= 0x900;
 	writel(reg_data, iobase + PLX_INT_CSR_REG);

 	dev->dev.dma_mask = NULL;
 	hcd = isp1760_register(pci_mem_phy0, memlength, dev->irq,
 			       IRQF_SHARED, &dev->dev, dev_name(&dev->dev),
 			       devflags);
 	if (IS_ERR(hcd)) {
 		ret_status = -ENODEV;
 		goto cleanup3;
 	}

 	/* done with PLX IO access */
 	iounmap(iobase);
 	release_mem_region(nxp_pci_io_base, iolength);

 	pci_set_drvdata(dev, hcd);
 	return 0;

 cleanup3:
 	release_mem_region(pci_mem_phy0, memlength);
 cleanup2:
 	iounmap(iobase);
 cleanup1:
 	release_mem_region(nxp_pci_io_base, iolength);
 	return ret_status;
 }

 static void isp1761_pci_remove(struct pci_dev *dev)
 {
 	isp1760_unregister(&dev->dev);

 	pci_disable_device(dev);
 }

 static void isp1761_pci_shutdown(struct pci_dev *dev)
 {
 	printk(KERN_ERR "ips1761_pci_shutdown\n");
 }

 static const struct pci_device_id isp1760_plx [] = {
 	{
 		.class          = PCI_CLASS_BRIDGE_OTHER << 8,
 		.class_mask     = ~0,
 		.vendor		= PCI_VENDOR_ID_PLX,
 		.device		= 0x5406,
 		.subvendor	= PCI_VENDOR_ID_PLX,
 		.subdevice	= 0x9054,
 	},
 	{ }
 };
 MODULE_DEVICE_TABLE(pci, isp1760_plx);

 static struct pci_driver isp1761_pci_driver = {
 	.name =         "isp1760",
 	.id_table =     isp1760_plx,
 	.probe =        isp1761_pci_probe,
 	.remove =       isp1761_pci_remove,
 	.shutdown =     isp1761_pci_shutdown,
 };
 #endif

 static int isp1760_plat_probe(struct platform_device *pdev)
 {
 	unsigned long irqflags = IRQF_SHARED;
 	unsigned int devflags = 0;
 	struct resource *mem_res;
 	struct resource *irq_res;
 	resource_size_t mem_size;
 	struct usb_hcd *hcd;
 	int ret;

 	mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 	if (!mem_res) {
 		pr_warning("isp1760: Memory resource not available\n");
 		return -ENODEV;
 	}
 	mem_size = resource_size(mem_res);
 	if (!request_mem_region(mem_res->start, mem_size, "isp1760")) {
 		pr_warning("isp1760: Cannot reserve the memory resource\n");
 		return -EBUSY;
 	}

 	irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 	if (!irq_res) {
 		pr_warning("isp1760: IRQ resource not available\n");
 		ret = -ENODEV;
 		goto cleanup;
 	}

 	irqflags |= irq_res->flags & IRQF_TRIGGER_MASK;

 	if (IS_ENABLED(CONFIG_OF) && pdev->dev.of_node) {
 		struct device_node *dp = pdev->dev.of_node;
 		u32 bus_width = 0;

 		if (of_device_is_compatible(dp, "nxp,usb-isp1761"))
 			devflags |= ISP1760_FLAG_ISP1761;

 		/* Some systems wire up only 16 of the 32 data lines */
 		of_property_read_u32(dp, "bus-width", &bus_width);
 		if (bus_width == 16)
 			devflags |= ISP1760_FLAG_BUS_WIDTH_16;

 		if (of_property_read_bool(dp, "port1-otg"))
 			devflags |= ISP1760_FLAG_OTG_EN;

 		if (of_property_read_bool(dp, "analog-oc"))
 			devflags |= ISP1760_FLAG_ANALOG_OC;

 		if (of_property_read_bool(dp, "dack-polarity"))
 			devflags |= ISP1760_FLAG_DACK_POL_HIGH;

 		if (of_property_read_bool(dp, "dreq-polarity"))
 			devflags |= ISP1760_FLAG_DREQ_POL_HIGH;
 	} else if (dev_get_platdata(&pdev->dev)) {
 		struct isp1760_platform_data *pdata =
 			dev_get_platdata(&pdev->dev);

 		if (pdata->is_isp1761)
 			devflags |= ISP1760_FLAG_ISP1761;
 		if (pdata->bus_width_16)
 			devflags |= ISP1760_FLAG_BUS_WIDTH_16;
 		if (pdata->port1_otg)
 			devflags |= ISP1760_FLAG_OTG_EN;
 		if (pdata->analog_oc)
 			devflags |= ISP1760_FLAG_ANALOG_OC;
 		if (pdata->dack_polarity_high)
 			devflags |= ISP1760_FLAG_DACK_POL_HIGH;
 		if (pdata->dreq_polarity_high)
 			devflags |= ISP1760_FLAG_DREQ_POL_HIGH;
 	}

 	hcd = isp1760_register(mem_res->start, mem_size, irq_res->start,
 			       irqflags, &pdev->dev, dev_name(&pdev->dev),
 			       devflags);
 	if (IS_ERR(hcd)) {
 		pr_warning("isp1760: Failed to register the HCD device\n");
 		ret = PTR_ERR(hcd);
 		goto cleanup;
 	}

 	platform_set_drvdata(pdev, hcd);

 	pr_info("ISP1760 USB device initialised\n");
 	return 0;

 cleanup:
 	release_mem_region(mem_res->start, mem_size);
 	return ret;
 }

 static int isp1760_plat_remove(struct platform_device *pdev)
 {
 	isp1760_unregister(&pdev->dev);

 	return 0;
 }

 #ifdef CONFIG_OF
 static const struct of_device_id isp1760_of_match[] = {
 	{ .compatible = "nxp,usb-isp1760", },
 	{ .compatible = "nxp,usb-isp1761", },
 	{ },
 };
 MODULE_DEVICE_TABLE(of, isp1760_of_match);
 #endif

 static struct platform_driver isp1760_plat_driver = {
 	.probe	= isp1760_plat_probe,
 	.remove	= isp1760_plat_remove,
 	.driver	= {
 		.name	= "isp1760",
 		.of_match_table = of_match_ptr(isp1760_of_match),
 	},
 };

 static int __init isp1760_init(void)
 {
 	int ret, any_ret = -ENODEV;

 	init_kmem_once();

 	ret = platform_driver_register(&isp1760_plat_driver);
 	if (!ret)
 		any_ret = 0;
 #ifdef CONFIG_PCI
 	ret = pci_register_driver(&isp1761_pci_driver);
 	if (!ret)
 		any_ret = 0;
 #endif

 	if (any_ret)
 		deinit_kmem_cache();
 	return any_ret;
 }
 module_init(isp1760_init);

 static void __exit isp1760_exit(void)
 {
 	platform_driver_unregister(&isp1760_plat_driver);
 #ifdef CONFIG_PCI
 	pci_unregister_driver(&isp1761_pci_driver);
 #endif
 	deinit_kmem_cache();
 }
 module_exit(isp1760_exit);
	/*
	* Glue code for the ISP1760 driver and bus
	* Currently there is support for
	* - OpenFirmware
	* - PCI
	* - PDEV (generic platform device centralized driver model)
	*
	* (c) 2007 Sebastian Siewior <bigeasy@linutronix.de>
	*
	*/

	#include <linux/usb.h>
	#include <linux/io.h>
	#include <linux/module.h>
	#include <linux/of.h>
	#include <linux/platform_device.h>
	#include <linux/slab.h>
	#include <linux/usb/isp1760.h>
	#include <linux/usb/hcd.h>

	#include "isp1760-hcd.h"

	#ifdef CONFIG_PCI
	#include <linux/pci.h>
	#endif

	#ifdef CONFIG_PCI
	static int isp1761_pci_probe(struct pci_dev *dev,
	const struct pci_device_id *id)
	{
	u8 latency, limit;
	__u32 reg_data;
	int retry_count;
	struct usb_hcd *hcd;
	unsigned int devflags = 0;
	int ret_status = 0;

	resource_size_t pci_mem_phy0;
	resource_size_t memlength;

	u8 __iomem *chip_addr;
	u8 __iomem *iobase;
	resource_size_t nxp_pci_io_base;
	resource_size_t iolength;

	if (usb_disabled())
	return -ENODEV;

	if (pci_enable_device(dev) < 0)
	return -ENODEV;

	if (!dev->irq)
	return -ENODEV;

	/* Grab the PLX PCI mem maped port start address we need */
	nxp_pci_io_base = pci_resource_start(dev, 0);
	iolength = pci_resource_len(dev, 0);

	if (!request_mem_region(nxp_pci_io_base, iolength, "ISP1761 IO MEM")) {
	printk(KERN_ERR "request region #1\n");
	return -EBUSY;
	}

	iobase = ioremap_nocache(nxp_pci_io_base, iolength);
	if (!iobase) {
	printk(KERN_ERR "ioremap #1\n");
	ret_status = -ENOMEM;
	goto cleanup1;
	}
	/* Grab the PLX PCI shared memory of the ISP 1761 we need */
	pci_mem_phy0 = pci_resource_start(dev, 3);
	memlength = pci_resource_len(dev, 3);
	if (memlength < 0xffff) {
	printk(KERN_ERR "memory length for this resource is wrong\n");
	ret_status = -ENOMEM;
	goto cleanup2;
	}

	if (!request_mem_region(pci_mem_phy0, memlength, "ISP-PCI")) {
	printk(KERN_ERR "host controller already in use\n");
	ret_status = -EBUSY;
	goto cleanup2;
	}

	/* map available memory */
	chip_addr = ioremap_nocache(pci_mem_phy0,memlength);
	if (!chip_addr) {
	printk(KERN_ERR "Error ioremap failed\n");
	ret_status = -ENOMEM;
	goto cleanup3;
	}

	/* bad pci latencies can contribute to overruns */
	pci_read_config_byte(dev, PCI_LATENCY_TIMER, &latency);
	if (latency) {
	pci_read_config_byte(dev, PCI_MAX_LAT, &limit);
	if (limit && limit < latency)
	pci_write_config_byte(dev, PCI_LATENCY_TIMER, limit);
	}

	/* Try to check whether we can access Scratch Register of
	* Host Controller or not. The initial PCI access is retried until
	* local init for the PCI bridge is completed
	*/
	retry_count = 20;
	reg_data = 0;
	while ((reg_data != 0xFACE) && retry_count) {
	/*by default host is in 16bit mode, so
	* io operations at this stage must be 16 bit
	* */
	writel(0xface, chip_addr + HC_SCRATCH_REG);
	udelay(100);
	reg_data = readl(chip_addr + HC_SCRATCH_REG) & 0x0000ffff;
	retry_count--;
	}

	iounmap(chip_addr);

	/* Host Controller presence is detected by writing to scratch register
	* and reading back and checking the contents are same or not
	*/
	if (reg_data != 0xFACE) {
	dev_err(&dev->dev, "scratch register mismatch %x\n", reg_data);
	ret_status = -ENOMEM;
	goto cleanup3;
	}

	pci_set_master(dev);

	/* configure PLX PCI chip to pass interrupts */
	#define PLX_INT_CSR_REG 0x68
	reg_data = readl(iobase + PLX_INT_CSR_REG);
	reg_data \|= 0x900;
	writel(reg_data, iobase + PLX_INT_CSR_REG);

	dev->dev.dma_mask = NULL;
	hcd = isp1760_register(pci_mem_phy0, memlength, dev->irq,
	IRQF_SHARED, &dev->dev, dev_name(&dev->dev),
	devflags);
	if (IS_ERR(hcd)) {
	ret_status = -ENODEV;
	goto cleanup3;
	}

	/* done with PLX IO access */
	iounmap(iobase);
	release_mem_region(nxp_pci_io_base, iolength);

	pci_set_drvdata(dev, hcd);
	return 0;

	cleanup3:
	release_mem_region(pci_mem_phy0, memlength);
	cleanup2:
	iounmap(iobase);
	cleanup1:
	release_mem_region(nxp_pci_io_base, iolength);
	return ret_status;
	}

	static void isp1761_pci_remove(struct pci_dev *dev)
	{
	isp1760_unregister(&dev->dev);

	pci_disable_device(dev);
	}

	static void isp1761_pci_shutdown(struct pci_dev *dev)
	{
	printk(KERN_ERR "ips1761_pci_shutdown\n");
	}

	static const struct pci_device_id isp1760_plx [] = {
	{
	.class = PCI_CLASS_BRIDGE_OTHER << 8,
	.class_mask = ~0,
	.vendor = PCI_VENDOR_ID_PLX,
	.device = 0x5406,
	.subvendor = PCI_VENDOR_ID_PLX,
	.subdevice = 0x9054,
	},
	{ }
	};
	MODULE_DEVICE_TABLE(pci, isp1760_plx);

	static struct pci_driver isp1761_pci_driver = {
	.name = "isp1760",
	.id_table = isp1760_plx,
	.probe = isp1761_pci_probe,
	.remove = isp1761_pci_remove,
	.shutdown = isp1761_pci_shutdown,
	};
	#endif

	static int isp1760_plat_probe(struct platform_device *pdev)
	{
	unsigned long irqflags = IRQF_SHARED;
	unsigned int devflags = 0;
	struct resource *mem_res;
	struct resource *irq_res;
	resource_size_t mem_size;
	struct usb_hcd *hcd;
	int ret;

	mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!mem_res) {
	pr_warning("isp1760: Memory resource not available\n");
	return -ENODEV;
	}
	mem_size = resource_size(mem_res);
	if (!request_mem_region(mem_res->start, mem_size, "isp1760")) {
	pr_warning("isp1760: Cannot reserve the memory resource\n");
	return -EBUSY;
	}

	irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
	if (!irq_res) {
	pr_warning("isp1760: IRQ resource not available\n");
	ret = -ENODEV;
	goto cleanup;
	}

	irqflags \|= irq_res->flags & IRQF_TRIGGER_MASK;

	if (IS_ENABLED(CONFIG_OF) && pdev->dev.of_node) {
	struct device_node *dp = pdev->dev.of_node;
	u32 bus_width = 0;

	if (of_device_is_compatible(dp, "nxp,usb-isp1761"))
	devflags \|= ISP1760_FLAG_ISP1761;

	/* Some systems wire up only 16 of the 32 data lines */
	of_property_read_u32(dp, "bus-width", &bus_width);
	if (bus_width == 16)
	devflags \|= ISP1760_FLAG_BUS_WIDTH_16;

	if (of_property_read_bool(dp, "port1-otg"))
	devflags \|= ISP1760_FLAG_OTG_EN;

	if (of_property_read_bool(dp, "analog-oc"))
	devflags \|= ISP1760_FLAG_ANALOG_OC;

	if (of_property_read_bool(dp, "dack-polarity"))
	devflags \|= ISP1760_FLAG_DACK_POL_HIGH;

	if (of_property_read_bool(dp, "dreq-polarity"))
	devflags \|= ISP1760_FLAG_DREQ_POL_HIGH;
	} else if (dev_get_platdata(&pdev->dev)) {
	struct isp1760_platform_data *pdata =
	dev_get_platdata(&pdev->dev);

	if (pdata->is_isp1761)
	devflags \|= ISP1760_FLAG_ISP1761;
	if (pdata->bus_width_16)
	devflags \|= ISP1760_FLAG_BUS_WIDTH_16;
	if (pdata->port1_otg)
	devflags \|= ISP1760_FLAG_OTG_EN;
	if (pdata->analog_oc)
	devflags \|= ISP1760_FLAG_ANALOG_OC;
	if (pdata->dack_polarity_high)
	devflags \|= ISP1760_FLAG_DACK_POL_HIGH;
	if (pdata->dreq_polarity_high)
	devflags \|= ISP1760_FLAG_DREQ_POL_HIGH;
	}

	hcd = isp1760_register(mem_res->start, mem_size, irq_res->start,
	irqflags, &pdev->dev, dev_name(&pdev->dev),
	devflags);
	if (IS_ERR(hcd)) {
	pr_warning("isp1760: Failed to register the HCD device\n");
	ret = PTR_ERR(hcd);
	goto cleanup;
	}

	platform_set_drvdata(pdev, hcd);

	pr_info("ISP1760 USB device initialised\n");
	return 0;

	cleanup:
	release_mem_region(mem_res->start, mem_size);
	return ret;
	}

	static int isp1760_plat_remove(struct platform_device *pdev)
	{
	isp1760_unregister(&pdev->dev);

	return 0;
	}

	#ifdef CONFIG_OF
	static const struct of_device_id isp1760_of_match[] = {
	{ .compatible = "nxp,usb-isp1760", },
	{ .compatible = "nxp,usb-isp1761", },
	{ },
	};
	MODULE_DEVICE_TABLE(of, isp1760_of_match);
	#endif

	static struct platform_driver isp1760_plat_driver = {
	.probe = isp1760_plat_probe,
	.remove = isp1760_plat_remove,
	.driver = {
	.name = "isp1760",
	.of_match_table = of_match_ptr(isp1760_of_match),
	},
	};

	static int __init isp1760_init(void)
	{
	int ret, any_ret = -ENODEV;

	init_kmem_once();

	ret = platform_driver_register(&isp1760_plat_driver);
	if (!ret)
	any_ret = 0;
	#ifdef CONFIG_PCI
	ret = pci_register_driver(&isp1761_pci_driver);
	if (!ret)
	any_ret = 0;
	#endif

	if (any_ret)
	deinit_kmem_cache();
	return any_ret;
	}
	module_init(isp1760_init);

	static void __exit isp1760_exit(void)
	{
	platform_driver_unregister(&isp1760_plat_driver);
	#ifdef CONFIG_PCI
	pci_unregister_driver(&isp1761_pci_driver);
	#endif
	deinit_kmem_cache();
	}
	module_exit(isp1760_exit);