cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

isp1760-if.c (7191B)


      1// SPDX-License-Identifier: GPL-2.0
      2/*
      3 * Glue code for the ISP1760 driver and bus
      4 * Currently there is support for
      5 * - OpenFirmware
      6 * - PCI
      7 * - PDEV (generic platform device centralized driver model)
      8 *
      9 * (c) 2007 Sebastian Siewior <bigeasy@linutronix.de>
     10 * Copyright 2021 Linaro, Rui Miguel Silva <rui.silva@linaro.org>
     11 *
     12 */
     13
     14#include <linux/usb.h>
     15#include <linux/io.h>
     16#include <linux/irq.h>
     17#include <linux/module.h>
     18#include <linux/of.h>
     19#include <linux/platform_device.h>
     20#include <linux/slab.h>
     21#include <linux/usb/hcd.h>
     22#include <linux/usb/otg.h>
     23
     24#include "isp1760-core.h"
     25#include "isp1760-regs.h"
     26
     27#ifdef CONFIG_USB_PCI
     28#include <linux/pci.h>
     29#endif
     30
     31#ifdef CONFIG_USB_PCI
     32static int isp1761_pci_init(struct pci_dev *dev)
     33{
     34	resource_size_t mem_start;
     35	resource_size_t mem_length;
     36	u8 __iomem *iobase;
     37	u8 latency, limit;
     38	int retry_count;
     39	u32 reg_data;
     40
     41	/* Grab the PLX PCI shared memory of the ISP 1761 we need  */
     42	mem_start = pci_resource_start(dev, 3);
     43	mem_length = pci_resource_len(dev, 3);
     44	if (mem_length < 0xffff) {
     45		printk(KERN_ERR "memory length for this resource is wrong\n");
     46		return -ENOMEM;
     47	}
     48
     49	if (!request_mem_region(mem_start, mem_length, "ISP-PCI")) {
     50		printk(KERN_ERR "host controller already in use\n");
     51		return -EBUSY;
     52	}
     53
     54	/* map available memory */
     55	iobase = ioremap(mem_start, mem_length);
     56	if (!iobase) {
     57		printk(KERN_ERR "Error ioremap failed\n");
     58		release_mem_region(mem_start, mem_length);
     59		return -ENOMEM;
     60	}
     61
     62	/* bad pci latencies can contribute to overruns */
     63	pci_read_config_byte(dev, PCI_LATENCY_TIMER, &latency);
     64	if (latency) {
     65		pci_read_config_byte(dev, PCI_MAX_LAT, &limit);
     66		if (limit && limit < latency)
     67			pci_write_config_byte(dev, PCI_LATENCY_TIMER, limit);
     68	}
     69
     70	/* Try to check whether we can access Scratch Register of
     71	 * Host Controller or not. The initial PCI access is retried until
     72	 * local init for the PCI bridge is completed
     73	 */
     74	retry_count = 20;
     75	reg_data = 0;
     76	while ((reg_data != 0xFACE) && retry_count) {
     77		/*by default host is in 16bit mode, so
     78		 * io operations at this stage must be 16 bit
     79		 * */
     80		writel(0xface, iobase + ISP176x_HC_SCRATCH);
     81		udelay(100);
     82		reg_data = readl(iobase + ISP176x_HC_SCRATCH) & 0x0000ffff;
     83		retry_count--;
     84	}
     85
     86	iounmap(iobase);
     87	release_mem_region(mem_start, mem_length);
     88
     89	/* Host Controller presence is detected by writing to scratch register
     90	 * and reading back and checking the contents are same or not
     91	 */
     92	if (reg_data != 0xFACE) {
     93		dev_err(&dev->dev, "scratch register mismatch %x\n", reg_data);
     94		return -ENOMEM;
     95	}
     96
     97	/* Grab the PLX PCI mem maped port start address we need  */
     98	mem_start = pci_resource_start(dev, 0);
     99	mem_length = pci_resource_len(dev, 0);
    100
    101	if (!request_mem_region(mem_start, mem_length, "ISP1761 IO MEM")) {
    102		printk(KERN_ERR "request region #1\n");
    103		return -EBUSY;
    104	}
    105
    106	iobase = ioremap(mem_start, mem_length);
    107	if (!iobase) {
    108		printk(KERN_ERR "ioremap #1\n");
    109		release_mem_region(mem_start, mem_length);
    110		return -ENOMEM;
    111	}
    112
    113	/* configure PLX PCI chip to pass interrupts */
    114#define PLX_INT_CSR_REG 0x68
    115	reg_data = readl(iobase + PLX_INT_CSR_REG);
    116	reg_data |= 0x900;
    117	writel(reg_data, iobase + PLX_INT_CSR_REG);
    118
    119	/* done with PLX IO access */
    120	iounmap(iobase);
    121	release_mem_region(mem_start, mem_length);
    122
    123	return 0;
    124}
    125
    126static int isp1761_pci_probe(struct pci_dev *dev,
    127		const struct pci_device_id *id)
    128{
    129	unsigned int devflags = 0;
    130	int ret;
    131
    132	if (!dev->irq)
    133		return -ENODEV;
    134
    135	if (pci_enable_device(dev) < 0)
    136		return -ENODEV;
    137
    138	ret = isp1761_pci_init(dev);
    139	if (ret < 0)
    140		goto error;
    141
    142	pci_set_master(dev);
    143
    144	ret = isp1760_register(&dev->resource[3], dev->irq, 0, &dev->dev,
    145			       devflags);
    146	if (ret < 0)
    147		goto error;
    148
    149	return 0;
    150
    151error:
    152	pci_disable_device(dev);
    153	return ret;
    154}
    155
    156static void isp1761_pci_remove(struct pci_dev *dev)
    157{
    158	isp1760_unregister(&dev->dev);
    159
    160	pci_disable_device(dev);
    161}
    162
    163static void isp1761_pci_shutdown(struct pci_dev *dev)
    164{
    165	printk(KERN_ERR "ips1761_pci_shutdown\n");
    166}
    167
    168static const struct pci_device_id isp1760_plx[] = {
    169	{
    170		.class          = PCI_CLASS_BRIDGE_OTHER << 8,
    171		.class_mask     = ~0,
    172		.vendor		= PCI_VENDOR_ID_PLX,
    173		.device		= 0x5406,
    174		.subvendor	= PCI_VENDOR_ID_PLX,
    175		.subdevice	= 0x9054,
    176	},
    177	{ }
    178};
    179MODULE_DEVICE_TABLE(pci, isp1760_plx);
    180
    181static struct pci_driver isp1761_pci_driver = {
    182	.name =         "isp1760",
    183	.id_table =     isp1760_plx,
    184	.probe =        isp1761_pci_probe,
    185	.remove =       isp1761_pci_remove,
    186	.shutdown =     isp1761_pci_shutdown,
    187};
    188#endif
    189
    190static int isp1760_plat_probe(struct platform_device *pdev)
    191{
    192	unsigned long irqflags;
    193	unsigned int devflags = 0;
    194	struct resource *mem_res;
    195	int irq;
    196	int ret;
    197
    198	mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
    199
    200	irq = platform_get_irq(pdev, 0);
    201	if (irq < 0)
    202		return irq;
    203	irqflags = irq_get_trigger_type(irq);
    204
    205	if (IS_ENABLED(CONFIG_OF) && pdev->dev.of_node) {
    206		struct device_node *dp = pdev->dev.of_node;
    207		u32 bus_width = 0;
    208
    209		if (of_device_is_compatible(dp, "nxp,usb-isp1761"))
    210			devflags |= ISP1760_FLAG_ISP1761;
    211
    212		if (of_device_is_compatible(dp, "nxp,usb-isp1763"))
    213			devflags |= ISP1760_FLAG_ISP1763;
    214
    215		/*
    216		 * Some systems wire up only 8 of 16 data lines or
    217		 * 16 of the 32 data lines
    218		 */
    219		of_property_read_u32(dp, "bus-width", &bus_width);
    220		if (bus_width == 16)
    221			devflags |= ISP1760_FLAG_BUS_WIDTH_16;
    222		else if (bus_width == 8)
    223			devflags |= ISP1760_FLAG_BUS_WIDTH_8;
    224
    225		if (usb_get_dr_mode(&pdev->dev) == USB_DR_MODE_PERIPHERAL)
    226			devflags |= ISP1760_FLAG_PERIPHERAL_EN;
    227
    228		if (of_property_read_bool(dp, "analog-oc"))
    229			devflags |= ISP1760_FLAG_ANALOG_OC;
    230
    231		if (of_property_read_bool(dp, "dack-polarity"))
    232			devflags |= ISP1760_FLAG_DACK_POL_HIGH;
    233
    234		if (of_property_read_bool(dp, "dreq-polarity"))
    235			devflags |= ISP1760_FLAG_DREQ_POL_HIGH;
    236	} else {
    237		pr_err("isp1760: no platform data\n");
    238		return -ENXIO;
    239	}
    240
    241	ret = isp1760_register(mem_res, irq, irqflags, &pdev->dev, devflags);
    242	if (ret < 0)
    243		return ret;
    244
    245	pr_info("ISP1760 USB device initialised\n");
    246	return 0;
    247}
    248
    249static int isp1760_plat_remove(struct platform_device *pdev)
    250{
    251	isp1760_unregister(&pdev->dev);
    252
    253	return 0;
    254}
    255
    256#ifdef CONFIG_OF
    257static const struct of_device_id isp1760_of_match[] = {
    258	{ .compatible = "nxp,usb-isp1760", },
    259	{ .compatible = "nxp,usb-isp1761", },
    260	{ .compatible = "nxp,usb-isp1763", },
    261	{ },
    262};
    263MODULE_DEVICE_TABLE(of, isp1760_of_match);
    264#endif
    265
    266static struct platform_driver isp1760_plat_driver = {
    267	.probe	= isp1760_plat_probe,
    268	.remove	= isp1760_plat_remove,
    269	.driver	= {
    270		.name	= "isp1760",
    271		.of_match_table = of_match_ptr(isp1760_of_match),
    272	},
    273};
    274
    275static int __init isp1760_init(void)
    276{
    277	int ret, any_ret = -ENODEV;
    278
    279	isp1760_init_kmem_once();
    280
    281	ret = platform_driver_register(&isp1760_plat_driver);
    282	if (!ret)
    283		any_ret = 0;
    284#ifdef CONFIG_USB_PCI
    285	ret = pci_register_driver(&isp1761_pci_driver);
    286	if (!ret)
    287		any_ret = 0;
    288#endif
    289
    290	if (any_ret)
    291		isp1760_deinit_kmem_cache();
    292	return any_ret;
    293}
    294module_init(isp1760_init);
    295
    296static void __exit isp1760_exit(void)
    297{
    298	platform_driver_unregister(&isp1760_plat_driver);
    299#ifdef CONFIG_USB_PCI
    300	pci_unregister_driver(&isp1761_pci_driver);
    301#endif
    302	isp1760_deinit_kmem_cache();
    303}
    304module_exit(isp1760_exit);