[mirror_ubuntu-bionic-kernel.git] / drivers / usb / dwc3 / ulpi.c

// SPDX-License-Identifier: GPL-2.0
/**
 * ulpi.c - DesignWare USB3 Controller's ULPI PHY interface
 *
 * Copyright (C) 2015 Intel Corporation
 *
 * Author: Heikki Krogerus <heikki.krogerus@linux.intel.com>
 */

#include <linux/ulpi/regs.h>

#include "core.h"
#include "io.h"

#define DWC3_ULPI_ADDR(a) \
		((a >= ULPI_EXT_VENDOR_SPECIFIC) ? \
		DWC3_GUSB2PHYACC_ADDR(ULPI_ACCESS_EXTENDED) | \
		DWC3_GUSB2PHYACC_EXTEND_ADDR(a) : DWC3_GUSB2PHYACC_ADDR(a))

static int dwc3_ulpi_busyloop(struct dwc3 *dwc)
{
	unsigned count = 1000;
	u32 reg;

	while (count--) {
		reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYACC(0));
		if (!(reg & DWC3_GUSB2PHYACC_BUSY))
			return 0;
		cpu_relax();
	}

	return -ETIMEDOUT;
}

static int dwc3_ulpi_read(struct device *dev, u8 addr)
{
	struct dwc3 *dwc = dev_get_drvdata(dev);
	u32 reg;
	int ret;

	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
	if (reg & DWC3_GUSB2PHYCFG_SUSPHY) {
		reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
		dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);
	}

	reg = DWC3_GUSB2PHYACC_NEWREGREQ | DWC3_ULPI_ADDR(addr);
	dwc3_writel(dwc->regs, DWC3_GUSB2PHYACC(0), reg);

	ret = dwc3_ulpi_busyloop(dwc);
	if (ret)
		return ret;

	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYACC(0));

	return DWC3_GUSB2PHYACC_DATA(reg);
}

static int dwc3_ulpi_write(struct device *dev, u8 addr, u8 val)
{
	struct dwc3 *dwc = dev_get_drvdata(dev);
	u32 reg;

	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
	if (reg & DWC3_GUSB2PHYCFG_SUSPHY) {
		reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
		dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);
	}

	reg = DWC3_GUSB2PHYACC_NEWREGREQ | DWC3_ULPI_ADDR(addr);
	reg |= DWC3_GUSB2PHYACC_WRITE | val;
	dwc3_writel(dwc->regs, DWC3_GUSB2PHYACC(0), reg);

	return dwc3_ulpi_busyloop(dwc);
}

static const struct ulpi_ops dwc3_ulpi_ops = {
	.read = dwc3_ulpi_read,
	.write = dwc3_ulpi_write,
};

int dwc3_ulpi_init(struct dwc3 *dwc)
{
	/* Register the interface */
	dwc->ulpi = ulpi_register_interface(dwc->dev, &dwc3_ulpi_ops);
	if (IS_ERR(dwc->ulpi)) {
		dev_err(dwc->dev, "failed to register ULPI interface");
		return PTR_ERR(dwc->ulpi);
	}

	return 0;
}

void dwc3_ulpi_exit(struct dwc3 *dwc)
{
	if (dwc->ulpi) {
		ulpi_unregister_interface(dwc->ulpi);
		dwc->ulpi = NULL;
	}
}
Commit	Line	Data
5fd54ace	1	// SPDX-License-Identifier: GPL-2.0
88bc9d19 HK	2	/**
	3	* ulpi.c - DesignWare USB3 Controller's ULPI PHY interface
	4	*
	5	* Copyright (C) 2015 Intel Corporation
	6	*
	7	* Author: Heikki Krogerus <heikki.krogerus@linux.intel.com>
88bc9d19 HK	8	*/
	9
	10	#include <linux/ulpi/regs.h>
	11
	12	#include "core.h"
	13	#include "io.h"
	14
	15	#define DWC3_ULPI_ADDR(a) \
	16	((a >= ULPI_EXT_VENDOR_SPECIFIC) ? \
	17	DWC3_GUSB2PHYACC_ADDR(ULPI_ACCESS_EXTENDED) \| \
	18	DWC3_GUSB2PHYACC_EXTEND_ADDR(a) : DWC3_GUSB2PHYACC_ADDR(a))
	19
	20	static int dwc3_ulpi_busyloop(struct dwc3 *dwc)
	21	{
	22	unsigned count = 1000;
	23	u32 reg;
	24
	25	while (count--) {
	26	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYACC(0));
	27	if (!(reg & DWC3_GUSB2PHYACC_BUSY))
	28	return 0;
	29	cpu_relax();
	30	}
	31
	32	return -ETIMEDOUT;
	33	}
	34
b7cf1dc3	35	static int dwc3_ulpi_read(struct device *dev, u8 addr)
88bc9d19	36	{
b7cf1dc3	37	struct dwc3 *dwc = dev_get_drvdata(dev);
88bc9d19 HK	38	u32 reg;
	39	int ret;
	40
e0082698 FB	41	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
	42	if (reg & DWC3_GUSB2PHYCFG_SUSPHY) {
	43	reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
	44	dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);
	45	}
	46
88bc9d19 HK	47	reg = DWC3_GUSB2PHYACC_NEWREGREQ \| DWC3_ULPI_ADDR(addr);
	48	dwc3_writel(dwc->regs, DWC3_GUSB2PHYACC(0), reg);
	49
	50	ret = dwc3_ulpi_busyloop(dwc);
	51	if (ret)
	52	return ret;
	53
	54	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYACC(0));
	55
	56	return DWC3_GUSB2PHYACC_DATA(reg);
	57	}
	58
b7cf1dc3	59	static int dwc3_ulpi_write(struct device *dev, u8 addr, u8 val)
88bc9d19	60	{
b7cf1dc3	61	struct dwc3 *dwc = dev_get_drvdata(dev);
88bc9d19 HK	62	u32 reg;
88bc9d19 HK	63
e0082698 FB	64	reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
	65	if (reg & DWC3_GUSB2PHYCFG_SUSPHY) {
	66	reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
	67	dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);
	68	}
	69
88bc9d19 HK	70	reg = DWC3_GUSB2PHYACC_NEWREGREQ \| DWC3_ULPI_ADDR(addr);
	71	reg \|= DWC3_GUSB2PHYACC_WRITE \| val;
	72	dwc3_writel(dwc->regs, DWC3_GUSB2PHYACC(0), reg);
	73
	74	return dwc3_ulpi_busyloop(dwc);
	75	}
	76
073c47ac	77	static const struct ulpi_ops dwc3_ulpi_ops = {
e6f74849 TS	78	.read = dwc3_ulpi_read,
e6f74849 TS	79	.write = dwc3_ulpi_write,
88bc9d19 HK	80	};
	81
	82	int dwc3_ulpi_init(struct dwc3 *dwc)
	83	{
	84	/* Register the interface */
	85	dwc->ulpi = ulpi_register_interface(dwc->dev, &dwc3_ulpi_ops);
	86	if (IS_ERR(dwc->ulpi)) {
	87	dev_err(dwc->dev, "failed to register ULPI interface");
	88	return PTR_ERR(dwc->ulpi);
	89	}
	90
	91	return 0;
	92	}
	93
	94	void dwc3_ulpi_exit(struct dwc3 *dwc)
	95	{
	96	if (dwc->ulpi) {
	97	ulpi_unregister_interface(dwc->ulpi);
	98	dwc->ulpi = NULL;
	99	}
	100	}