From nobody Fri Jan 06 03:06:43 2023 X-Original-To: dev-commits-src-main@mlmmj.nyi.freebsd.org Received: from mx1.freebsd.org (mx1.freebsd.org [IPv6:2610:1c1:1:606c::19:1]) by mlmmj.nyi.freebsd.org (Postfix) with ESMTP id 4Np7Xg6LJgz2pJVY; Fri, 6 Jan 2023 03:06:43 +0000 (UTC) (envelope-from git@FreeBSD.org) Received: from mxrelay.nyi.freebsd.org (mxrelay.nyi.freebsd.org [IPv6:2610:1c1:1:606c::19:3]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange X25519 server-signature RSA-PSS (4096 bits) server-digest SHA256 client-signature RSA-PSS (4096 bits) client-digest SHA256) (Client CN "mxrelay.nyi.freebsd.org", Issuer "R3" (verified OK)) by mx1.freebsd.org (Postfix) with ESMTPS id 4Np7Xg66tLz4FJd; Fri, 6 Jan 2023 03:06:43 +0000 (UTC) (envelope-from git@FreeBSD.org) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=freebsd.org; s=dkim; t=1672974403; h=from:from:reply-to:subject:subject:date:date:message-id:message-id: to:to:cc:mime-version:mime-version:content-type:content-type: content-transfer-encoding:content-transfer-encoding; bh=Bq/rL/0axcghwCT676C5JMxlHc/BRavqPXl3zJYLZys=; b=YiS7U53C3oB6TfdJ4yBfdWJwPE9KJecQynqEDVfMavCqzUOyAQ9Kfi/7za6fsSZ+OH4AI8 JwT7PfxBL3ON9lmgNEmYYD4QSh05o4n/HklfDn8uX3T78bxnSpQIqjmDsAQH+wb6Zna7Sa UraWmBI0NQK9iujP/2yct60aqKW3Cch0FAmJ0cufl3FjfohrNX3BhfjisuOG+Ub2Yy9WTt 9Ebc8eXCkRzfpwbrnqelt2V5+A+bBFBsOjhdML1vN4GKyj5xtaQhCI2uqRNP0Zy5IqnyQo fmM9sGKFRGTGCIM8pM/9RSOUsZgQMJ5QD0otl+bQ1wBnC9F9q4HeS7gpLfx3BQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=freebsd.org; s=dkim; t=1672974403; h=from:from:reply-to:subject:subject:date:date:message-id:message-id: to:to:cc:mime-version:mime-version:content-type:content-type: content-transfer-encoding:content-transfer-encoding; bh=Bq/rL/0axcghwCT676C5JMxlHc/BRavqPXl3zJYLZys=; b=W+vJN9ExT24L8G3blDfM1TAgcMaj0h0P16cvixDfFA63mysreDY5AF/9Q2mKMIz6PLjIvU Jg1iyIZPE6kiIq9TQ5zfPWzIApQ/dZyDv7v0WDay9d2l+rXmTL8ZHeJFwS1D+S0k4p89p+ bC7xUeom6vvgZO7HAEpvNtXOrxkirVoQqme3lq+oZpFFPmF3NuYMmCIkcEY3Oji6BPziqz B0huoY9y8Wp+KaViADWy8rSjhRc2PzRJ7humP6F+Prf4ouwwg/XlhijjpB58ijBOwB4qGy IZb7oBp3yYrsuzIk9o4FonEEWNq5i0K/R1ZPU6Zem2m/sfpovjRUfXIvfyjiOQ== ARC-Authentication-Results: i=1; mx1.freebsd.org; none ARC-Seal: i=1; s=dkim; d=freebsd.org; t=1672974403; a=rsa-sha256; cv=none; b=kMGAxAuBom1u5A5ZmAuooqMBsC8u9XikRUgOG8myZnJ844pkyQ9iBR20lLDR54Db9CpOEA DTqCjBeuc81iOsNi4VOOBDRv6v3TrairoDJ33iVEN6NPprEznmeMaSCwGxPOzP1FB8Mk/d rZA2D7jDkVZLqNpBqYcY4QaFnalI216/8ZF1QLZRNuAPXcEGL+EqL0gHn/kQ5D11TTHJqe pvVKtbUD6oyoslr9iqsUYf6aF6pvYWlBvwVIlrT8+O38kp1b+d9mzM5/X2coZqRbCQ2fl5 19sYGNhfwGAspEzlZ4ZXTiuNJPCHE1VZPIg6vKkRAN1W68r8IQnDVle+5qmyNQ== Received: from gitrepo.freebsd.org (gitrepo.freebsd.org [IPv6:2610:1c1:1:6068::e6a:5]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange X25519 server-signature RSA-PSS (4096 bits) server-digest SHA256) (Client did not present a certificate) by mxrelay.nyi.freebsd.org (Postfix) with ESMTPS id 4Np7Xg59LdzFfn; Fri, 6 Jan 2023 03:06:43 +0000 (UTC) (envelope-from git@FreeBSD.org) Received: from gitrepo.freebsd.org ([127.0.1.44]) by gitrepo.freebsd.org (8.16.1/8.16.1) with ESMTP id 30636hSi021007; Fri, 6 Jan 2023 03:06:43 GMT (envelope-from git@gitrepo.freebsd.org) Received: (from git@localhost) by gitrepo.freebsd.org (8.16.1/8.16.1/Submit) id 30636h4h021006; Fri, 6 Jan 2023 03:06:43 GMT (envelope-from git) Date: Fri, 6 Jan 2023 03:06:43 GMT Message-Id: <202301060306.30636h4h021006@gitrepo.freebsd.org> To: src-committers@FreeBSD.org, dev-commits-src-all@FreeBSD.org, dev-commits-src-main@FreeBSD.org From: Ganbold Tsagaankhuu Subject: git: 5723e5ac6d76 - main - Add Naneng combo PHY support for RK3568 SoC. List-Id: Commit messages for the main branch of the src repository List-Archive: https://lists.freebsd.org/archives/dev-commits-src-main List-Help: List-Post: List-Subscribe: List-Unsubscribe: Sender: owner-dev-commits-src-main@freebsd.org X-BeenThere: dev-commits-src-main@freebsd.org MIME-Version: 1.0 Content-Type: text/plain; charset=utf-8 Content-Transfer-Encoding: 8bit X-Git-Committer: ganbold X-Git-Repository: src X-Git-Refname: refs/heads/main X-Git-Reftype: branch X-Git-Commit: 5723e5ac6d7618ebec7e10185312e803898faffc Auto-Submitted: auto-generated X-ThisMailContainsUnwantedMimeParts: N The branch main has been updated by ganbold: URL: https://cgit.FreeBSD.org/src/commit/?id=5723e5ac6d7618ebec7e10185312e803898faffc commit 5723e5ac6d7618ebec7e10185312e803898faffc Author: Søren Schmidt AuthorDate: 2023-01-06 03:00:18 +0000 Commit: Ganbold Tsagaankhuu CommitDate: 2023-01-06 03:04:53 +0000 Add Naneng combo PHY support for RK3568 SoC. It can be used as pcie-phy, usb3-phy, sata-phy or sgmii-phy. --- sys/arm64/rockchip/rk3568_combphy.c | 469 ++++++++++++++++++++++++++++++++++++ sys/conf/files.arm64 | 1 + 2 files changed, 470 insertions(+) diff --git a/sys/arm64/rockchip/rk3568_combphy.c b/sys/arm64/rockchip/rk3568_combphy.c new file mode 100644 index 000000000000..e0374c844627 --- /dev/null +++ b/sys/arm64/rockchip/rk3568_combphy.c @@ -0,0 +1,469 @@ +/*- + * Copyright (c) 2021, 2022 Soren Schmidt + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * $Id: rk3568_combphy.c 893 2022-07-26 09:47:22Z sos $ + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include + +#include + +#include +#include +#include +#include +#include + +#include + +#include "syscon_if.h" +#include "phydev_if.h" +#include "phynode_if.h" + + +static struct ofw_compat_data compat_data[] = { + {"rockchip,rk3568-naneng-combphy", 1}, + {NULL, 0} +}; + +struct rk3568_combphy_softc { + device_t dev; + phandle_t node; + struct resource *mem; + struct phynode *phynode; + struct syscon *pipe_grf; + struct syscon *pipe_phy_grf; + clk_t ref_clk; + clk_t apb_clk; + clk_t pipe_clk; + hwreset_t phy_reset; + int mode; +}; + +#define PHYREG6 0x14 +#define PHYREG6_PLL_DIV_MASK 0xc0 +#define PHYREG6_PLL_DIV_2 (1 << 6) +#define PHYREG7 0x18 +#define PHYREG7_TX_RTERM_50OHM (8 << 4) +#define PHYREG7_RX_RTERM_44OHM (15 << 0) +#define PHYREG8 0x1c +#define PHYREG8_SSC_EN 0x10 +#define PHYREG11 0x28 +#define PHYREG11_SU_TRIM_0_7 0xf0 +#define PHYREG12 0x2c +#define PHYREG12_PLL_LPF_ADJ_VALUE 4 +#define PHYREG15 0x38 +#define PHYREG15_CTLE_EN 0x01 +#define PHYREG15_SSC_CNT_MASK 0xc0 +#define PHYREG15_SSC_CNT_VALUE (1 << 6) +#define PHYREG16 0x3c +#define PHYREG16_SSC_CNT_VALUE 0x5f +#define PHYREG18 0x44 +#define PHYREG18_PLL_LOOP 0x32 +#define PHYREG32 0x7c +#define PHYREG32_SSC_MASK 0xf0 +#define PHYREG32_SSC_UPWARD (0 << 4) +#define PHYREG32_SSC_DOWNWARD (1 << 4) +#define PHYREG32_SSC_OFFSET_500PPM (1 << 6) +#define PHYREG33 0x80 +#define PHYREG33_PLL_KVCO_MASK 0x1c +#define PHYREG33_PLL_KVCO_VALUE (2 << 2) + +#define PIPE_MASK_ALL (0xffff << 16) +#define PIPE_PHY_GRF_PIPE_CON0 0x00 +#define PIPE_DATABUSWIDTH_MASK 0x3 +#define PIPE_DATABUSWIDTH_32BIT 0 +#define PIPE_DATABUSWIDTH_16BIT 1 +#define PIPE_PHYMODE_MASK (3 << 2) +#define PIPE_PHYMODE_PCIE (0 << 2) +#define PIPE_PHYMODE_USB3 (1 << 2) +#define PIPE_PHYMODE_SATA (2 << 2) +#define PIPE_RATE_MASK (3 << 4) +#define PIPE_RATE_PCIE_2_5GBPS (0 << 4) +#define PIPE_RATE_PCIE_5GBPS (1 << 4) +#define PIPE_RATE_USB3_5GBPS (0 << 4) +#define PIPE_RATE_SATA_1GBPS5 (0 << 4) +#define PIPE_RATE_SATA_3GBPS (1 << 4) +#define PIPE_RATE_SATA_6GBPS (2 << 4) +#define PIPE_MAC_PCLKREQ_N (1 << 8) +#define PIPE_L1SUB_ENTREQ (1 << 9) +#define PIPE_RXTERM (1 << 12) +#define PIPE_PHY_GRF_PIPE_CON1 0x04 +#define PHY_CLK_SEL_MASK (3 << 13) +#define PHY_CLK_SEL_24M (0 << 13) +#define PHY_CLK_SEL_25M (1 << 13) +#define PHY_CLK_SEL_100M (2 << 13) +#define PIPE_PHY_GRF_PIPE_CON2 0x08 +#define SEL_PIPE_TXCOMPLIANCE_I (1 << 15) +#define SEL_PIPE_TXELECIDLE (1 << 12) +#define SEL_PIPE_RXTERM (1 << 8) +#define SEL_PIPE_BYPASS_CODEC (1 << 7) +#define SEL_PIPE_PIPE_EBUF (1 << 6) +#define SEL_PIPE_PIPE_PHYMODE (1 << 1) +#define SEL_PIPE_DATABUSWIDTH (1 << 0) +#define PIPE_PHY_GRF_PIPE_CON3 0x0c +#define PIPE_SEL_MASK (3 << 13) +#define PIPE_SEL_PCIE (0 << 13) +#define PIPE_SEL_USB3 (1 << 13) +#define PIPE_SEL_SATA (2 << 13) +#define PIPE_CLK_REF_SRC_I_MASK (3 << 8) +#define PIPE_CLK_REF_SRC_I_PLL_CKREF_INNER (2 << 8) +#define PIPE_RXELECIDLE (1 << 10) +#define PIPE_FROM_PCIE_IO (1 << 11) + +#define PIPE_GRF_PIPE_CON0 0x00 +#define SATA2_PHY_SPDMODE_1GBPS5 (0 << 12) +#define SATA2_PHY_SPDMODE_3GBPS (1 << 12) +#define SATA2_PHY_SPDMODE_6GBPS (2 << 12) +#define SATA1_PHY_SPDMODE_1GBPS5 (0 << 8) +#define SATA1_PHY_SPDMODE_3GBPS (1 << 8) +#define SATA1_PHY_SPDMODE_6GBPS (2 << 8) +#define SATA0_PHY_SPDMODE_1GBPS5 (0 << 4) +#define SATA0_PHY_SPDMODE_3GBPS (1 << 4) +#define SATA0_PHY_SPDMODE_6GBPS (2 << 4) + +#define PIPE_GRF_SATA_CON0 0x10 +#define PIPE_GRF_SATA_CON1 0x14 +#define PIPE_GRF_SATA_CON2 0x18 +#define PIPE_GRF_XPCS_CON0 0x40 + + +/* PHY class and methods */ +static int +rk3568_combphy_enable(struct phynode *phynode, bool enable) +{ + device_t dev = phynode_get_device(phynode); + struct rk3568_combphy_softc *sc = device_get_softc(dev); + uint64_t rate; + + if (enable == false) + return (0); + + switch (sc->mode) { + case PHY_TYPE_SATA: + device_printf(dev, "configuring for SATA"); + + /* tx_rterm 50 ohm & rx_rterm 44 ohm */ + bus_write_4(sc->mem, PHYREG7, + PHYREG7_TX_RTERM_50OHM | PHYREG7_RX_RTERM_44OHM); + + /* Adaptive CTLE */ + bus_write_4(sc->mem, PHYREG15, + bus_read_4(sc->mem, PHYREG15) | PHYREG15_CTLE_EN); + + /* config grf_pipe for PCIe */ + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON3, + PIPE_MASK_ALL | PIPE_SEL_SATA | PIPE_RXELECIDLE | 0x7); + + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON2, + PIPE_MASK_ALL | SEL_PIPE_TXCOMPLIANCE_I | + SEL_PIPE_DATABUSWIDTH | 0xc3); + + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON0, + PIPE_MASK_ALL | PIPE_RXTERM | PIPE_DATABUSWIDTH_16BIT | + PIPE_RATE_SATA_3GBPS | PIPE_PHYMODE_SATA); + + SYSCON_WRITE_4(sc->pipe_grf, PIPE_GRF_PIPE_CON0, + PIPE_MASK_ALL | SATA0_PHY_SPDMODE_6GBPS | + SATA1_PHY_SPDMODE_6GBPS | SATA2_PHY_SPDMODE_6GBPS); + break; + + case PHY_TYPE_PCIE: + device_printf(dev, "configuring for PCIe"); + + /* Set SSC downward spread spectrum */ + bus_write_4(sc->mem, PHYREG32, + (bus_read_4(sc->mem, PHYREG32) & PHYREG32_SSC_MASK) | + PHYREG32_SSC_DOWNWARD); + + /* config grf_pipe for PCIe */ + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON3, + PIPE_MASK_ALL | PIPE_SEL_PCIE | + PIPE_CLK_REF_SRC_I_PLL_CKREF_INNER); + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON2, + PIPE_MASK_ALL | SEL_PIPE_RXTERM | SEL_PIPE_DATABUSWIDTH); + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON0, + PIPE_MASK_ALL | PIPE_RXTERM | PIPE_DATABUSWIDTH_32BIT | + PIPE_RATE_PCIE_2_5GBPS | PIPE_PHYMODE_PCIE); + break; + + case PHY_TYPE_USB3: + device_printf(dev, "configuring for USB3"); + + /* Set SSC downward spread spectrum */ + bus_write_4(sc->mem, PHYREG32, + (bus_read_4(sc->mem, PHYREG32) & PHYREG32_SSC_MASK) | + PHYREG32_SSC_DOWNWARD); + + /* Adaptive CTLE */ + bus_write_4(sc->mem, PHYREG15, + bus_read_4(sc->mem, PHYREG15) | PHYREG15_CTLE_EN); + + /* Set PLL KVCO fine tuning signals */ + bus_write_4(sc->mem, PHYREG33, + (bus_read_4(sc->mem, PHYREG33) & PHYREG33_PLL_KVCO_MASK) | + PHYREG33_PLL_KVCO_VALUE); + + /* Enable controlling random jitter. */ + bus_write_4(sc->mem, PHYREG12, PHYREG12_PLL_LPF_ADJ_VALUE); + + /* Set PLL input clock divider 1/2 */ + bus_write_4(sc->mem, PHYREG6, + (bus_read_4(sc->mem, PHYREG6) & PHYREG6_PLL_DIV_MASK) | + PHYREG6_PLL_DIV_2); + + /* Set PLL loop divider */ + bus_write_4(sc->mem, PHYREG18, PHYREG18_PLL_LOOP); + + /* Set PLL LPF R1 to su_trim[0:7] */ + bus_write_4(sc->mem, PHYREG11, PHYREG11_SU_TRIM_0_7); + + /* config grf_pipe for USB3 */ + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON3, + PIPE_MASK_ALL | PIPE_SEL_USB3); + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON2, + PIPE_MASK_ALL); + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON0, + PIPE_MASK_ALL | PIPE_DATABUSWIDTH_16BIT | + PIPE_PHYMODE_USB3 | PIPE_RATE_USB3_5GBPS); + break; + + default: + printf("Unsupported mode=%d\n", sc->mode); + return (-1); + } + + clk_get_freq(sc->ref_clk, &rate); + printf(" ref_clk=%lu\n", rate); + + switch (rate) { + case 24000000: + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON1, + (PHY_CLK_SEL_MASK << 16) | PHY_CLK_SEL_24M); + + if (sc->mode == PHY_TYPE_USB3 || sc->mode == PHY_TYPE_SATA) { + /* Adaptive CTLE */ + bus_write_4(sc->mem, PHYREG15, + (bus_read_4(sc->mem, PHYREG15) & + PHYREG15_SSC_CNT_MASK) | PHYREG15_SSC_CNT_VALUE); + + /* SSC control period */ + bus_write_4(sc->mem, PHYREG16, PHYREG16_SSC_CNT_VALUE); + } + break; + + case 25000000: + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON1, + (PHY_CLK_SEL_MASK << 16) | PHY_CLK_SEL_25M); + break; + + case 100000000: + SYSCON_WRITE_4(sc->pipe_phy_grf, PIPE_PHY_GRF_PIPE_CON1, + (PHY_CLK_SEL_MASK << 16) | PHY_CLK_SEL_100M); + + if (sc->mode == PHY_TYPE_PCIE) { + /* Set PLL KVCO fine tuning signals */ + bus_write_4(sc->mem, PHYREG33, + (bus_read_4(sc->mem, PHYREG33) & + PHYREG33_PLL_KVCO_MASK) | PHYREG33_PLL_KVCO_VALUE); + + /* Enable controlling random jitter. */ + bus_write_4(sc->mem, PHYREG12, + PHYREG12_PLL_LPF_ADJ_VALUE); + + /* Set PLL input clock divider 1/2 */ + bus_write_4(sc->mem, PHYREG6, + (bus_read_4(sc->mem, PHYREG6) & + PHYREG6_PLL_DIV_MASK) | PHYREG6_PLL_DIV_2); + + /* Set PLL loop divider */ + bus_write_4(sc->mem, PHYREG18, PHYREG18_PLL_LOOP); + + /* Set PLL LPF R1 to su_trim[0:7] */ + bus_write_4(sc->mem, PHYREG11, PHYREG11_SU_TRIM_0_7); + } + if (sc->mode == PHY_TYPE_SATA) { + /* Set SSC downward spread spectrum */ + bus_write_4(sc->mem, PHYREG32, + (bus_read_4(sc->mem, PHYREG32) & ~0x000000f0) | + PHYREG32_SSC_DOWNWARD | PHYREG32_SSC_OFFSET_500PPM); + } + break; + + default: + device_printf(dev, "unknown ref rate=%lu\n", rate); + break; + } + + if (OF_hasprop(sc->node, "rockchip,ext-refclk")) { + device_printf(dev, "UNSUPPORTED rockchip,ext-refclk\n"); + } + if (OF_hasprop(sc->node, "rockchip,enable-ssc")) { + device_printf(dev, "setting rockchip,enable-ssc\n"); + bus_write_4(sc->mem, PHYREG8, + bus_read_4(sc->mem, PHYREG8) | PHYREG8_SSC_EN); + } + + if (hwreset_deassert(sc->phy_reset)) + device_printf(dev, "phy_reset failed to clear\n"); + + return (0); +} + +static phynode_method_t rk3568_combphy_phynode_methods[] = { + PHYNODEMETHOD(phynode_enable, rk3568_combphy_enable), + + PHYNODEMETHOD_END +}; +DEFINE_CLASS_1(rk3568_combphy_phynode, rk3568_combphy_phynode_class, + rk3568_combphy_phynode_methods, 0, phynode_class); + + +/* Device class and methods */ +static int +rk3568_combphy_probe(device_t dev) +{ + + if (!ofw_bus_status_okay(dev)) + return (ENXIO); + if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0) + return (ENXIO); + device_set_desc(dev, "RockChip combo PHY"); + return (BUS_PROBE_DEFAULT); +} + +static int +rk3568_combphy_attach(device_t dev) +{ + struct rk3568_combphy_softc *sc = device_get_softc(dev); + struct phynode_init_def phy_init; + struct phynode *phynode; + int rid = 0; + + sc->dev = dev; + sc->node = ofw_bus_get_node(dev); + + /* Get memory resource */ + if (!(sc->mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, + &rid, RF_ACTIVE))) { + device_printf(dev, "Cannot allocate memory resources\n"); + return (ENXIO); + } + + /* Get syncons handles */ + if (OF_hasprop(sc->node, "rockchip,pipe-grf") && + syscon_get_by_ofw_property(dev, sc->node, "rockchip,pipe-grf", + &sc->pipe_grf)) + return (ENXIO); + if (OF_hasprop(sc->node, "rockchip,pipe-phy-grf") && + syscon_get_by_ofw_property(dev, sc->node, "rockchip,pipe-phy-grf", + &sc->pipe_phy_grf)) + return (ENXIO); + + /* Get & enable clocks */ + if (clk_get_by_ofw_name(dev, 0, "ref", &sc->ref_clk)) { + device_printf(dev, "getting ref failed\n"); + return (ENXIO); + } + if (clk_enable(sc->ref_clk)) + device_printf(dev, "enable ref failed\n"); + if (clk_get_by_ofw_name(dev, 0, "apb", &sc->apb_clk)) { + device_printf(dev, "getting apb failed\n"); + return (ENXIO); + } + if (clk_enable(sc->apb_clk)) + device_printf(dev, "enable apb failed\n"); + if (clk_get_by_ofw_name(dev, 0, "pipe", &sc->pipe_clk)) { + device_printf(dev, "getting pipe failed\n"); + return (ENXIO); + } + if (clk_enable(sc->pipe_clk)) + device_printf(dev, "enable pipe failed\n"); + + /* get & assert reset */ + if (hwreset_get_by_ofw_idx(dev, sc->node, 0, &sc->phy_reset)) { + device_printf(dev, "Cannot get reset\n"); + return (ENXIO); + } + hwreset_assert(sc->phy_reset); + + bzero(&phy_init, sizeof(phy_init)); + phy_init.id = 0; + phy_init.ofw_node = sc->node; + if (!(phynode = phynode_create(dev, &rk3568_combphy_phynode_class, + &phy_init))) { + device_printf(dev, "failed to create combphy PHY\n"); + return (ENXIO); + } + if (!phynode_register(phynode)) { + device_printf(dev, "failed to register combphy PHY\n"); + return (ENXIO); + } + sc->phynode = phynode; + sc->mode = 0; + + return (0); +} + +static int +rk3568_combphy_map(device_t dev, phandle_t xref, int ncells, pcell_t *cells, + intptr_t *id) +{ + struct rk3568_combphy_softc *sc = device_get_softc(dev); + + if (phydev_default_ofw_map(dev, xref, ncells, cells, id)) + return (ERANGE); + + /* Store the phy mode that is handed to us in id */ + sc->mode = *id; + + /* Set our id to 0 so the std phy_get_*() works as usual */ + *id = 0; + + return (0); +} + +static device_method_t rk3568_combphy_methods[] = { + DEVMETHOD(device_probe, rk3568_combphy_probe), + DEVMETHOD(device_attach, rk3568_combphy_attach), + DEVMETHOD(phydev_map, rk3568_combphy_map), + + DEVMETHOD_END +}; + +DEFINE_CLASS_1(rk3568_combphy, rk3568_combphy_driver, rk3568_combphy_methods, + sizeof(struct simple_mfd_softc), simple_mfd_driver); +EARLY_DRIVER_MODULE(rk3568_combphy, simplebus, rk3568_combphy_driver, + 0, 0, BUS_PASS_RESOURCE + BUS_PASS_ORDER_LATE); diff --git a/sys/conf/files.arm64 b/sys/conf/files.arm64 index df39a408867d..6c42812fcc42 100644 --- a/sys/conf/files.arm64 +++ b/sys/conf/files.arm64 @@ -622,6 +622,7 @@ arm64/qualcomm/qcom_gcc.c optional qcom_gcc fdt # RockChip Drivers arm64/rockchip/rk3328_codec.c optional fdt rk3328codec soc_rockchip_rk3328 arm64/rockchip/rk3399_emmcphy.c optional fdt rk_emmcphy soc_rockchip_rk3399 +arm64/rockchip/rk3568_combphy.c optional fdt rk_combphy soc_rockchip_rk3568 arm64/rockchip/rk3568_pcie.c optional fdt pci soc_rockchip_rk3568 arm64/rockchip/rk3568_pciephy.c optional fdt pci soc_rockchip_rk3568 arm64/rockchip/rk_dwc3.c optional fdt rk_dwc3 soc_rockchip_rk3399 | fdt rk_dwc3 soc_rockchip_rk3568