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

ohci-nxp.c (7605B)


      1// SPDX-License-Identifier: GPL-2.0
      2/*
      3 * driver for NXP USB Host devices
      4 *
      5 * Currently supported OHCI host devices:
      6 * - NXP LPC32xx
      7 *
      8 * Authors: Dmitry Chigirev <source@mvista.com>
      9 *	    Vitaly Wool <vitalywool@gmail.com>
     10 *
     11 * register initialization is based on code examples provided by Philips
     12 * Copyright (c) 2005 Koninklijke Philips Electronics N.V.
     13 *
     14 * NOTE: This driver does not have suspend/resume functionality
     15 * This driver is intended for engineering development purposes only
     16 *
     17 * 2005-2006 (c) MontaVista Software, Inc.
     18 */
     19#include <linux/clk.h>
     20#include <linux/dma-mapping.h>
     21#include <linux/io.h>
     22#include <linux/i2c.h>
     23#include <linux/module.h>
     24#include <linux/of.h>
     25#include <linux/platform_device.h>
     26#include <linux/usb/isp1301.h>
     27#include <linux/usb.h>
     28#include <linux/usb/hcd.h>
     29
     30#include "ohci.h"
     31
     32#define USB_CONFIG_BASE		0x31020000
     33
     34/* USB_OTG_STAT_CONTROL bit defines */
     35#define TRANSPARENT_I2C_EN	(1 << 7)
     36#define HOST_EN			(1 << 0)
     37
     38/* On LPC32xx, those are undefined */
     39#ifndef start_int_set_falling_edge
     40#define start_int_set_falling_edge(irq)
     41#define start_int_set_rising_edge(irq)
     42#define start_int_ack(irq)
     43#define start_int_mask(irq)
     44#define start_int_umask(irq)
     45#endif
     46
     47#define DRIVER_DESC "OHCI NXP driver"
     48
     49static const char hcd_name[] = "ohci-nxp";
     50static struct hc_driver __read_mostly ohci_nxp_hc_driver;
     51
     52static struct i2c_client *isp1301_i2c_client;
     53
     54static struct clk *usb_host_clk;
     55
     56static void isp1301_configure_lpc32xx(void)
     57{
     58	/* LPC32XX only supports DAT_SE0 USB mode */
     59	/* This sequence is important */
     60
     61	/* Disable transparent UART mode first */
     62	i2c_smbus_write_byte_data(isp1301_i2c_client,
     63		(ISP1301_I2C_MODE_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR),
     64		MC1_UART_EN);
     65	i2c_smbus_write_byte_data(isp1301_i2c_client,
     66		(ISP1301_I2C_MODE_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR),
     67		~MC1_SPEED_REG);
     68	i2c_smbus_write_byte_data(isp1301_i2c_client,
     69				  ISP1301_I2C_MODE_CONTROL_1, MC1_SPEED_REG);
     70	i2c_smbus_write_byte_data(isp1301_i2c_client,
     71		  (ISP1301_I2C_MODE_CONTROL_2 | ISP1301_I2C_REG_CLEAR_ADDR),
     72		  ~0);
     73	i2c_smbus_write_byte_data(isp1301_i2c_client,
     74		ISP1301_I2C_MODE_CONTROL_2,
     75		(MC2_BI_DI | MC2_PSW_EN | MC2_SPD_SUSP_CTRL));
     76	i2c_smbus_write_byte_data(isp1301_i2c_client,
     77		(ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR), ~0);
     78	i2c_smbus_write_byte_data(isp1301_i2c_client,
     79		ISP1301_I2C_MODE_CONTROL_1, MC1_DAT_SE0);
     80	i2c_smbus_write_byte_data(isp1301_i2c_client,
     81		ISP1301_I2C_OTG_CONTROL_1,
     82		(OTG1_DM_PULLDOWN | OTG1_DP_PULLDOWN));
     83	i2c_smbus_write_byte_data(isp1301_i2c_client,
     84		(ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR),
     85		(OTG1_DM_PULLUP | OTG1_DP_PULLUP));
     86	i2c_smbus_write_byte_data(isp1301_i2c_client,
     87		ISP1301_I2C_INTERRUPT_LATCH | ISP1301_I2C_REG_CLEAR_ADDR, ~0);
     88	i2c_smbus_write_byte_data(isp1301_i2c_client,
     89		ISP1301_I2C_INTERRUPT_FALLING | ISP1301_I2C_REG_CLEAR_ADDR,
     90		~0);
     91	i2c_smbus_write_byte_data(isp1301_i2c_client,
     92		ISP1301_I2C_INTERRUPT_RISING | ISP1301_I2C_REG_CLEAR_ADDR, ~0);
     93
     94	printk(KERN_INFO "ISP1301 Vendor ID  : 0x%04x\n",
     95	      i2c_smbus_read_word_data(isp1301_i2c_client, 0x00));
     96	printk(KERN_INFO "ISP1301 Product ID : 0x%04x\n",
     97	      i2c_smbus_read_word_data(isp1301_i2c_client, 0x02));
     98	printk(KERN_INFO "ISP1301 Version ID : 0x%04x\n",
     99	      i2c_smbus_read_word_data(isp1301_i2c_client, 0x14));
    100}
    101
    102static void isp1301_configure(void)
    103{
    104	isp1301_configure_lpc32xx();
    105}
    106
    107static inline void isp1301_vbus_on(void)
    108{
    109	i2c_smbus_write_byte_data(isp1301_i2c_client, ISP1301_I2C_OTG_CONTROL_1,
    110				  OTG1_VBUS_DRV);
    111}
    112
    113static inline void isp1301_vbus_off(void)
    114{
    115	i2c_smbus_write_byte_data(isp1301_i2c_client,
    116		ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR,
    117		OTG1_VBUS_DRV);
    118}
    119
    120static void ohci_nxp_start_hc(void)
    121{
    122	void __iomem *usb_otg_stat_control = ioremap(USB_CONFIG_BASE + 0x110, 4);
    123	unsigned long tmp;
    124
    125	if (WARN_ON(!usb_otg_stat_control))
    126		return;
    127
    128	tmp = __raw_readl(usb_otg_stat_control) | HOST_EN;
    129
    130	__raw_writel(tmp, usb_otg_stat_control);
    131	isp1301_vbus_on();
    132
    133	iounmap(usb_otg_stat_control);
    134}
    135
    136static void ohci_nxp_stop_hc(void)
    137{
    138	void __iomem *usb_otg_stat_control = ioremap(USB_CONFIG_BASE + 0x110, 4);
    139	unsigned long tmp;
    140
    141	if (WARN_ON(!usb_otg_stat_control))
    142		return;
    143
    144	isp1301_vbus_off();
    145	tmp = __raw_readl(usb_otg_stat_control) & ~HOST_EN;
    146	__raw_writel(tmp, usb_otg_stat_control);
    147
    148	iounmap(usb_otg_stat_control);
    149}
    150
    151static int ohci_hcd_nxp_probe(struct platform_device *pdev)
    152{
    153	struct usb_hcd *hcd = NULL;
    154	const struct hc_driver *driver = &ohci_nxp_hc_driver;
    155	struct resource *res;
    156	int ret = 0, irq;
    157	struct device_node *isp1301_node;
    158
    159	if (pdev->dev.of_node) {
    160		isp1301_node = of_parse_phandle(pdev->dev.of_node,
    161						"transceiver", 0);
    162	} else {
    163		isp1301_node = NULL;
    164	}
    165
    166	isp1301_i2c_client = isp1301_get_client(isp1301_node);
    167	if (!isp1301_i2c_client)
    168		return -EPROBE_DEFER;
    169
    170	ret = dma_coerce_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
    171	if (ret)
    172		goto fail_disable;
    173
    174	dev_dbg(&pdev->dev, "%s: " DRIVER_DESC " (nxp)\n", hcd_name);
    175	if (usb_disabled()) {
    176		dev_err(&pdev->dev, "USB is disabled\n");
    177		ret = -ENODEV;
    178		goto fail_disable;
    179	}
    180
    181	/* Enable USB host clock */
    182	usb_host_clk = devm_clk_get(&pdev->dev, NULL);
    183	if (IS_ERR(usb_host_clk)) {
    184		dev_err(&pdev->dev, "failed to acquire USB OHCI clock\n");
    185		ret = PTR_ERR(usb_host_clk);
    186		goto fail_disable;
    187	}
    188
    189	ret = clk_prepare_enable(usb_host_clk);
    190	if (ret < 0) {
    191		dev_err(&pdev->dev, "failed to start USB OHCI clock\n");
    192		goto fail_disable;
    193	}
    194
    195	isp1301_configure();
    196
    197	hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
    198	if (!hcd) {
    199		dev_err(&pdev->dev, "Failed to allocate HC buffer\n");
    200		ret = -ENOMEM;
    201		goto fail_hcd;
    202	}
    203
    204	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
    205	hcd->regs = devm_ioremap_resource(&pdev->dev, res);
    206	if (IS_ERR(hcd->regs)) {
    207		ret = PTR_ERR(hcd->regs);
    208		goto fail_resource;
    209	}
    210	hcd->rsrc_start = res->start;
    211	hcd->rsrc_len = resource_size(res);
    212
    213	irq = platform_get_irq(pdev, 0);
    214	if (irq < 0) {
    215		ret = -ENXIO;
    216		goto fail_resource;
    217	}
    218
    219	ohci_nxp_start_hc();
    220	platform_set_drvdata(pdev, hcd);
    221
    222	dev_info(&pdev->dev, "at 0x%p, irq %d\n", hcd->regs, hcd->irq);
    223	ret = usb_add_hcd(hcd, irq, 0);
    224	if (ret == 0) {
    225		device_wakeup_enable(hcd->self.controller);
    226		return ret;
    227	}
    228
    229	ohci_nxp_stop_hc();
    230fail_resource:
    231	usb_put_hcd(hcd);
    232fail_hcd:
    233	clk_disable_unprepare(usb_host_clk);
    234fail_disable:
    235	isp1301_i2c_client = NULL;
    236	return ret;
    237}
    238
    239static int ohci_hcd_nxp_remove(struct platform_device *pdev)
    240{
    241	struct usb_hcd *hcd = platform_get_drvdata(pdev);
    242
    243	usb_remove_hcd(hcd);
    244	ohci_nxp_stop_hc();
    245	usb_put_hcd(hcd);
    246	clk_disable_unprepare(usb_host_clk);
    247	isp1301_i2c_client = NULL;
    248
    249	return 0;
    250}
    251
    252/* work with hotplug and coldplug */
    253MODULE_ALIAS("platform:usb-ohci");
    254
    255#ifdef CONFIG_OF
    256static const struct of_device_id ohci_hcd_nxp_match[] = {
    257	{ .compatible = "nxp,ohci-nxp" },
    258	{},
    259};
    260MODULE_DEVICE_TABLE(of, ohci_hcd_nxp_match);
    261#endif
    262
    263static struct platform_driver ohci_hcd_nxp_driver = {
    264	.driver = {
    265		.name = "usb-ohci",
    266		.of_match_table = of_match_ptr(ohci_hcd_nxp_match),
    267	},
    268	.probe = ohci_hcd_nxp_probe,
    269	.remove = ohci_hcd_nxp_remove,
    270};
    271
    272static int __init ohci_nxp_init(void)
    273{
    274	if (usb_disabled())
    275		return -ENODEV;
    276
    277	pr_info("%s: " DRIVER_DESC "\n", hcd_name);
    278
    279	ohci_init_driver(&ohci_nxp_hc_driver, NULL);
    280	return platform_driver_register(&ohci_hcd_nxp_driver);
    281}
    282module_init(ohci_nxp_init);
    283
    284static void __exit ohci_nxp_cleanup(void)
    285{
    286	platform_driver_unregister(&ohci_hcd_nxp_driver);
    287}
    288module_exit(ohci_nxp_cleanup);
    289
    290MODULE_DESCRIPTION(DRIVER_DESC);
    291MODULE_LICENSE("GPL v2");