xref: /rk3399_rockchip-uboot/arch/arm/mach-tegra/tegra124/xusb-padctl.c (revision 90aa625c9a9e1fb7a2f001fd8e50099bacaf92b8)
109f455dcSMasahiro Yamada /*
21680d7b6SStephen Warren  * Copyright (c) 2014-2015, NVIDIA CORPORATION.  All rights reserved.
309f455dcSMasahiro Yamada  *
409f455dcSMasahiro Yamada  * SPDX-License-Identifier: GPL-2.0
509f455dcSMasahiro Yamada  */
609f455dcSMasahiro Yamada 
709f455dcSMasahiro Yamada #define pr_fmt(fmt) "tegra-xusb-padctl: " fmt
809f455dcSMasahiro Yamada 
909f455dcSMasahiro Yamada #include <common.h>
1009f455dcSMasahiro Yamada #include <errno.h>
11be789092SSimon Glass #include <dm/of_access.h>
12be789092SSimon Glass #include <dm/ofnode.h>
1309f455dcSMasahiro Yamada 
141680d7b6SStephen Warren #include "../xusb-padctl-common.h"
151680d7b6SStephen Warren 
1609f455dcSMasahiro Yamada #include <dt-bindings/pinctrl/pinctrl-tegra-xusb.h>
1709f455dcSMasahiro Yamada 
1809f455dcSMasahiro Yamada #define XUSB_PADCTL_ELPG_PROGRAM 0x01c
1909f455dcSMasahiro Yamada #define XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_VCORE_DOWN (1 << 26)
2009f455dcSMasahiro Yamada #define XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_CLAMP_EN_EARLY (1 << 25)
2109f455dcSMasahiro Yamada #define XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_CLAMP_EN (1 << 24)
2209f455dcSMasahiro Yamada 
2309f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL1 0x040
2409f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL1_PLL0_LOCKDET (1 << 19)
2509f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL1_REFCLK_SEL_MASK (0xf << 12)
2609f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL1_PLL_RST (1 << 1)
2709f455dcSMasahiro Yamada 
2809f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL2 0x044
2909f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL2_REFCLKBUF_EN (1 << 6)
3009f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL2_TXCLKREF_EN (1 << 5)
3109f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_P0_CTL2_TXCLKREF_SEL (1 << 4)
3209f455dcSMasahiro Yamada 
3309f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_S0_CTL1 0x138
3409f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL1_LOCKDET (1 << 27)
3509f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL1_MODE (1 << 24)
3609f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_PWR_OVRD (1 << 3)
3709f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_RST (1 << 1)
3809f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_IDDQ (1 << 0)
3909f455dcSMasahiro Yamada 
4009f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1 0x148
4109f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1_IDDQ_OVRD (1 << 1)
4209f455dcSMasahiro Yamada #define XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1_IDDQ (1 << 0)
4309f455dcSMasahiro Yamada 
4409f455dcSMasahiro Yamada enum tegra124_function {
4509f455dcSMasahiro Yamada 	TEGRA124_FUNC_SNPS,
4609f455dcSMasahiro Yamada 	TEGRA124_FUNC_XUSB,
4709f455dcSMasahiro Yamada 	TEGRA124_FUNC_UART,
4809f455dcSMasahiro Yamada 	TEGRA124_FUNC_PCIE,
4909f455dcSMasahiro Yamada 	TEGRA124_FUNC_USB3,
5009f455dcSMasahiro Yamada 	TEGRA124_FUNC_SATA,
5109f455dcSMasahiro Yamada 	TEGRA124_FUNC_RSVD,
5209f455dcSMasahiro Yamada };
5309f455dcSMasahiro Yamada 
5409f455dcSMasahiro Yamada static const char *const tegra124_functions[] = {
5509f455dcSMasahiro Yamada 	"snps",
5609f455dcSMasahiro Yamada 	"xusb",
5709f455dcSMasahiro Yamada 	"uart",
5809f455dcSMasahiro Yamada 	"pcie",
5909f455dcSMasahiro Yamada 	"usb3",
6009f455dcSMasahiro Yamada 	"sata",
6109f455dcSMasahiro Yamada 	"rsvd",
6209f455dcSMasahiro Yamada };
6309f455dcSMasahiro Yamada 
6409f455dcSMasahiro Yamada static const unsigned int tegra124_otg_functions[] = {
6509f455dcSMasahiro Yamada 	TEGRA124_FUNC_SNPS,
6609f455dcSMasahiro Yamada 	TEGRA124_FUNC_XUSB,
6709f455dcSMasahiro Yamada 	TEGRA124_FUNC_UART,
6809f455dcSMasahiro Yamada 	TEGRA124_FUNC_RSVD,
6909f455dcSMasahiro Yamada };
7009f455dcSMasahiro Yamada 
7109f455dcSMasahiro Yamada static const unsigned int tegra124_usb_functions[] = {
7209f455dcSMasahiro Yamada 	TEGRA124_FUNC_SNPS,
7309f455dcSMasahiro Yamada 	TEGRA124_FUNC_XUSB,
7409f455dcSMasahiro Yamada };
7509f455dcSMasahiro Yamada 
7609f455dcSMasahiro Yamada static const unsigned int tegra124_pci_functions[] = {
7709f455dcSMasahiro Yamada 	TEGRA124_FUNC_PCIE,
7809f455dcSMasahiro Yamada 	TEGRA124_FUNC_USB3,
7909f455dcSMasahiro Yamada 	TEGRA124_FUNC_SATA,
8009f455dcSMasahiro Yamada 	TEGRA124_FUNC_RSVD,
8109f455dcSMasahiro Yamada };
8209f455dcSMasahiro Yamada 
8309f455dcSMasahiro Yamada #define TEGRA124_LANE(_name, _offset, _shift, _mask, _iddq, _funcs)	\
8409f455dcSMasahiro Yamada 	{								\
8509f455dcSMasahiro Yamada 		.name = _name,						\
8609f455dcSMasahiro Yamada 		.offset = _offset,					\
8709f455dcSMasahiro Yamada 		.shift = _shift,					\
8809f455dcSMasahiro Yamada 		.mask = _mask,						\
8909f455dcSMasahiro Yamada 		.iddq = _iddq,						\
9009f455dcSMasahiro Yamada 		.num_funcs = ARRAY_SIZE(tegra124_##_funcs##_functions),	\
9109f455dcSMasahiro Yamada 		.funcs = tegra124_##_funcs##_functions,			\
9209f455dcSMasahiro Yamada 	}
9309f455dcSMasahiro Yamada 
9409f455dcSMasahiro Yamada static const struct tegra_xusb_padctl_lane tegra124_lanes[] = {
9509f455dcSMasahiro Yamada 	TEGRA124_LANE("otg-0",  0x004,  0, 0x3, 0, otg),
9609f455dcSMasahiro Yamada 	TEGRA124_LANE("otg-1",  0x004,  2, 0x3, 0, otg),
9709f455dcSMasahiro Yamada 	TEGRA124_LANE("otg-2",  0x004,  4, 0x3, 0, otg),
9809f455dcSMasahiro Yamada 	TEGRA124_LANE("ulpi-0", 0x004, 12, 0x1, 0, usb),
9909f455dcSMasahiro Yamada 	TEGRA124_LANE("hsic-0", 0x004, 14, 0x1, 0, usb),
10009f455dcSMasahiro Yamada 	TEGRA124_LANE("hsic-1", 0x004, 15, 0x1, 0, usb),
10109f455dcSMasahiro Yamada 	TEGRA124_LANE("pcie-0", 0x134, 16, 0x3, 1, pci),
10209f455dcSMasahiro Yamada 	TEGRA124_LANE("pcie-1", 0x134, 18, 0x3, 2, pci),
10309f455dcSMasahiro Yamada 	TEGRA124_LANE("pcie-2", 0x134, 20, 0x3, 3, pci),
10409f455dcSMasahiro Yamada 	TEGRA124_LANE("pcie-3", 0x134, 22, 0x3, 4, pci),
10509f455dcSMasahiro Yamada 	TEGRA124_LANE("pcie-4", 0x134, 24, 0x3, 5, pci),
10609f455dcSMasahiro Yamada 	TEGRA124_LANE("sata-0", 0x134, 26, 0x3, 6, pci),
10709f455dcSMasahiro Yamada };
10809f455dcSMasahiro Yamada 
tegra_xusb_padctl_enable(struct tegra_xusb_padctl * padctl)10909f455dcSMasahiro Yamada static int tegra_xusb_padctl_enable(struct tegra_xusb_padctl *padctl)
11009f455dcSMasahiro Yamada {
11109f455dcSMasahiro Yamada 	u32 value;
11209f455dcSMasahiro Yamada 
11309f455dcSMasahiro Yamada 	if (padctl->enable++ > 0)
11409f455dcSMasahiro Yamada 		return 0;
11509f455dcSMasahiro Yamada 
11609f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_ELPG_PROGRAM);
11709f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_CLAMP_EN;
11809f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_ELPG_PROGRAM);
11909f455dcSMasahiro Yamada 
12009f455dcSMasahiro Yamada 	udelay(100);
12109f455dcSMasahiro Yamada 
12209f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_ELPG_PROGRAM);
12309f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_CLAMP_EN_EARLY;
12409f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_ELPG_PROGRAM);
12509f455dcSMasahiro Yamada 
12609f455dcSMasahiro Yamada 	udelay(100);
12709f455dcSMasahiro Yamada 
12809f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_ELPG_PROGRAM);
12909f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_VCORE_DOWN;
13009f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_ELPG_PROGRAM);
13109f455dcSMasahiro Yamada 
13209f455dcSMasahiro Yamada 	return 0;
13309f455dcSMasahiro Yamada }
13409f455dcSMasahiro Yamada 
tegra_xusb_padctl_disable(struct tegra_xusb_padctl * padctl)13509f455dcSMasahiro Yamada static int tegra_xusb_padctl_disable(struct tegra_xusb_padctl *padctl)
13609f455dcSMasahiro Yamada {
13709f455dcSMasahiro Yamada 	u32 value;
13809f455dcSMasahiro Yamada 
13909f455dcSMasahiro Yamada 	if (padctl->enable == 0) {
140*90aa625cSMasahiro Yamada 		pr_err("unbalanced enable/disable");
14109f455dcSMasahiro Yamada 		return 0;
14209f455dcSMasahiro Yamada 	}
14309f455dcSMasahiro Yamada 
14409f455dcSMasahiro Yamada 	if (--padctl->enable > 0)
14509f455dcSMasahiro Yamada 		return 0;
14609f455dcSMasahiro Yamada 
14709f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_ELPG_PROGRAM);
14809f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_VCORE_DOWN;
14909f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_ELPG_PROGRAM);
15009f455dcSMasahiro Yamada 
15109f455dcSMasahiro Yamada 	udelay(100);
15209f455dcSMasahiro Yamada 
15309f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_ELPG_PROGRAM);
15409f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_CLAMP_EN_EARLY;
15509f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_ELPG_PROGRAM);
15609f455dcSMasahiro Yamada 
15709f455dcSMasahiro Yamada 	udelay(100);
15809f455dcSMasahiro Yamada 
15909f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_ELPG_PROGRAM);
16009f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_ELPG_PROGRAM_AUX_MUX_LP0_CLAMP_EN;
16109f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_ELPG_PROGRAM);
16209f455dcSMasahiro Yamada 
16309f455dcSMasahiro Yamada 	return 0;
16409f455dcSMasahiro Yamada }
16509f455dcSMasahiro Yamada 
phy_prepare(struct tegra_xusb_phy * phy)16609f455dcSMasahiro Yamada static int phy_prepare(struct tegra_xusb_phy *phy)
16709f455dcSMasahiro Yamada {
16809f455dcSMasahiro Yamada 	return tegra_xusb_padctl_enable(phy->padctl);
16909f455dcSMasahiro Yamada }
17009f455dcSMasahiro Yamada 
phy_unprepare(struct tegra_xusb_phy * phy)17109f455dcSMasahiro Yamada static int phy_unprepare(struct tegra_xusb_phy *phy)
17209f455dcSMasahiro Yamada {
17309f455dcSMasahiro Yamada 	return tegra_xusb_padctl_disable(phy->padctl);
17409f455dcSMasahiro Yamada }
17509f455dcSMasahiro Yamada 
pcie_phy_enable(struct tegra_xusb_phy * phy)17609f455dcSMasahiro Yamada static int pcie_phy_enable(struct tegra_xusb_phy *phy)
17709f455dcSMasahiro Yamada {
17809f455dcSMasahiro Yamada 	struct tegra_xusb_padctl *padctl = phy->padctl;
17909f455dcSMasahiro Yamada 	int err = -ETIMEDOUT;
18009f455dcSMasahiro Yamada 	unsigned long start;
18109f455dcSMasahiro Yamada 	u32 value;
18209f455dcSMasahiro Yamada 
18309f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_P0_CTL1);
18409f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_PLL_P0_CTL1_REFCLK_SEL_MASK;
18509f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_P0_CTL1);
18609f455dcSMasahiro Yamada 
18709f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_P0_CTL2);
18809f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_IOPHY_PLL_P0_CTL2_REFCLKBUF_EN |
18909f455dcSMasahiro Yamada 		 XUSB_PADCTL_IOPHY_PLL_P0_CTL2_TXCLKREF_EN |
19009f455dcSMasahiro Yamada 		 XUSB_PADCTL_IOPHY_PLL_P0_CTL2_TXCLKREF_SEL;
19109f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_P0_CTL2);
19209f455dcSMasahiro Yamada 
19309f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_P0_CTL1);
19409f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_IOPHY_PLL_P0_CTL1_PLL_RST;
19509f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_P0_CTL1);
19609f455dcSMasahiro Yamada 
19709f455dcSMasahiro Yamada 	start = get_timer(0);
19809f455dcSMasahiro Yamada 
19909f455dcSMasahiro Yamada 	while (get_timer(start) < 50) {
20009f455dcSMasahiro Yamada 		value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_P0_CTL1);
20109f455dcSMasahiro Yamada 		if (value & XUSB_PADCTL_IOPHY_PLL_P0_CTL1_PLL0_LOCKDET) {
20209f455dcSMasahiro Yamada 			err = 0;
20309f455dcSMasahiro Yamada 			break;
20409f455dcSMasahiro Yamada 		}
20509f455dcSMasahiro Yamada 	}
20609f455dcSMasahiro Yamada 
20709f455dcSMasahiro Yamada 	return err;
20809f455dcSMasahiro Yamada }
20909f455dcSMasahiro Yamada 
pcie_phy_disable(struct tegra_xusb_phy * phy)21009f455dcSMasahiro Yamada static int pcie_phy_disable(struct tegra_xusb_phy *phy)
21109f455dcSMasahiro Yamada {
21209f455dcSMasahiro Yamada 	struct tegra_xusb_padctl *padctl = phy->padctl;
21309f455dcSMasahiro Yamada 	u32 value;
21409f455dcSMasahiro Yamada 
21509f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_P0_CTL1);
21609f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_PLL_P0_CTL1_PLL_RST;
21709f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_P0_CTL1);
21809f455dcSMasahiro Yamada 
21909f455dcSMasahiro Yamada 	return 0;
22009f455dcSMasahiro Yamada }
22109f455dcSMasahiro Yamada 
sata_phy_enable(struct tegra_xusb_phy * phy)22209f455dcSMasahiro Yamada static int sata_phy_enable(struct tegra_xusb_phy *phy)
22309f455dcSMasahiro Yamada {
22409f455dcSMasahiro Yamada 	struct tegra_xusb_padctl *padctl = phy->padctl;
22509f455dcSMasahiro Yamada 	int err = -ETIMEDOUT;
22609f455dcSMasahiro Yamada 	unsigned long start;
22709f455dcSMasahiro Yamada 	u32 value;
22809f455dcSMasahiro Yamada 
22909f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1);
23009f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1_IDDQ_OVRD;
23109f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1_IDDQ;
23209f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1);
23309f455dcSMasahiro Yamada 
23409f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
23509f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_PWR_OVRD;
23609f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_IDDQ;
23709f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
23809f455dcSMasahiro Yamada 
23909f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
24009f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL1_MODE;
24109f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
24209f455dcSMasahiro Yamada 
24309f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
24409f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_RST;
24509f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
24609f455dcSMasahiro Yamada 
24709f455dcSMasahiro Yamada 	start = get_timer(0);
24809f455dcSMasahiro Yamada 
24909f455dcSMasahiro Yamada 	while (get_timer(start) < 50) {
25009f455dcSMasahiro Yamada 		value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
25109f455dcSMasahiro Yamada 		if (value & XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL1_LOCKDET) {
25209f455dcSMasahiro Yamada 			err = 0;
25309f455dcSMasahiro Yamada 			break;
25409f455dcSMasahiro Yamada 		}
25509f455dcSMasahiro Yamada 	}
25609f455dcSMasahiro Yamada 
25709f455dcSMasahiro Yamada 	return err;
25809f455dcSMasahiro Yamada }
25909f455dcSMasahiro Yamada 
sata_phy_disable(struct tegra_xusb_phy * phy)26009f455dcSMasahiro Yamada static int sata_phy_disable(struct tegra_xusb_phy *phy)
26109f455dcSMasahiro Yamada {
26209f455dcSMasahiro Yamada 	struct tegra_xusb_padctl *padctl = phy->padctl;
26309f455dcSMasahiro Yamada 	u32 value;
26409f455dcSMasahiro Yamada 
26509f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
26609f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_RST;
26709f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
26809f455dcSMasahiro Yamada 
26909f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
27009f455dcSMasahiro Yamada 	value &= ~XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL1_MODE;
27109f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
27209f455dcSMasahiro Yamada 
27309f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
27409f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_PWR_OVRD;
27509f455dcSMasahiro Yamada 	value |= XUSB_PADCTL_IOPHY_PLL_S0_CTL1_PLL_IDDQ;
27609f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_PLL_S0_CTL1);
27709f455dcSMasahiro Yamada 
27809f455dcSMasahiro Yamada 	value = padctl_readl(padctl, XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1);
27909f455dcSMasahiro Yamada 	value |= ~XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1_IDDQ_OVRD;
28009f455dcSMasahiro Yamada 	value |= ~XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1_IDDQ;
28109f455dcSMasahiro Yamada 	padctl_writel(padctl, value, XUSB_PADCTL_IOPHY_MISC_PAD_S0_CTL1);
28209f455dcSMasahiro Yamada 
28309f455dcSMasahiro Yamada 	return 0;
28409f455dcSMasahiro Yamada }
28509f455dcSMasahiro Yamada 
28609f455dcSMasahiro Yamada static const struct tegra_xusb_phy_ops pcie_phy_ops = {
28709f455dcSMasahiro Yamada 	.prepare = phy_prepare,
28809f455dcSMasahiro Yamada 	.enable = pcie_phy_enable,
28909f455dcSMasahiro Yamada 	.disable = pcie_phy_disable,
29009f455dcSMasahiro Yamada 	.unprepare = phy_unprepare,
29109f455dcSMasahiro Yamada };
29209f455dcSMasahiro Yamada 
29309f455dcSMasahiro Yamada static const struct tegra_xusb_phy_ops sata_phy_ops = {
29409f455dcSMasahiro Yamada 	.prepare = phy_prepare,
29509f455dcSMasahiro Yamada 	.enable = sata_phy_enable,
29609f455dcSMasahiro Yamada 	.disable = sata_phy_disable,
29709f455dcSMasahiro Yamada 	.unprepare = phy_unprepare,
29809f455dcSMasahiro Yamada };
29909f455dcSMasahiro Yamada 
300095e6583SStephen Warren static struct tegra_xusb_phy tegra124_phys[] = {
301095e6583SStephen Warren 	{
302095e6583SStephen Warren 		.type = TEGRA_XUSB_PADCTL_PCIE,
30309f455dcSMasahiro Yamada 		.ops = &pcie_phy_ops,
304095e6583SStephen Warren 		.padctl = &padctl,
30509f455dcSMasahiro Yamada 	},
306095e6583SStephen Warren 	{
307095e6583SStephen Warren 		.type = TEGRA_XUSB_PADCTL_SATA,
30809f455dcSMasahiro Yamada 		.ops = &sata_phy_ops,
309095e6583SStephen Warren 		.padctl = &padctl,
31009f455dcSMasahiro Yamada 	},
31109f455dcSMasahiro Yamada };
31209f455dcSMasahiro Yamada 
313095e6583SStephen Warren static const struct tegra_xusb_padctl_soc tegra124_socdata = {
314095e6583SStephen Warren 	.lanes = tegra124_lanes,
315095e6583SStephen Warren 	.num_lanes = ARRAY_SIZE(tegra124_lanes),
316095e6583SStephen Warren 	.functions = tegra124_functions,
317095e6583SStephen Warren 	.num_functions = ARRAY_SIZE(tegra124_functions),
318095e6583SStephen Warren 	.phys = tegra124_phys,
319095e6583SStephen Warren 	.num_phys = ARRAY_SIZE(tegra124_phys),
320095e6583SStephen Warren };
32109f455dcSMasahiro Yamada 
tegra_xusb_padctl_init(void)322be789092SSimon Glass void tegra_xusb_padctl_init(void)
32309f455dcSMasahiro Yamada {
324be789092SSimon Glass 	ofnode nodes[1];
325be789092SSimon Glass 	int count = 0;
326be789092SSimon Glass 	int ret;
32709f455dcSMasahiro Yamada 
328be789092SSimon Glass 	debug("%s: start\n", __func__);
329be789092SSimon Glass 	if (of_live_active()) {
330be789092SSimon Glass 		struct device_node *np = of_find_compatible_node(NULL, NULL,
331be789092SSimon Glass 						"nvidia,tegra124-xusb-padctl");
332be789092SSimon Glass 
333be789092SSimon Glass 		debug("np=%p\n", np);
334be789092SSimon Glass 		if (np) {
335be789092SSimon Glass 			nodes[0] = np_to_ofnode(np);
336be789092SSimon Glass 			count = 1;
337be789092SSimon Glass 		}
338be789092SSimon Glass 	} else {
339be789092SSimon Glass 		int node_offsets[1];
340be789092SSimon Glass 		int i;
341be789092SSimon Glass 
342be789092SSimon Glass 		count = fdtdec_find_aliases_for_id(gd->fdt_blob, "padctl",
34309f455dcSMasahiro Yamada 				COMPAT_NVIDIA_TEGRA124_XUSB_PADCTL,
344be789092SSimon Glass 				node_offsets, ARRAY_SIZE(node_offsets));
345be789092SSimon Glass 		for (i = 0; i < count; i++)
346be789092SSimon Glass 			nodes[i] = offset_to_ofnode(node_offsets[i]);
347be789092SSimon Glass 	}
348be789092SSimon Glass 
349be789092SSimon Glass 	ret = tegra_xusb_process_nodes(nodes, count, &tegra124_socdata);
350be789092SSimon Glass 	debug("%s: done, ret=%d\n", __func__, ret);
35109f455dcSMasahiro Yamada }
352