From nobody Fri Oct 2 02:30:45 2026 Received: from smtp.kernel.org (aws-us-west-2-korg-mail-alma10-1.taild15c8.ts.net [100.103.45.18]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 6D0D935966; Thu, 6 Aug 2026 02:56:53 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=100.103.45.18 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785985014; cv=none; b=N8jhKkPOmDlftJUCCl4nalSGV5isz3jPZdhTajWnXjYV0/iEyYhXI8XXii73tc34dd0Byg9ZtknPREEzJFO7JtRq4hQIv9H93BP72RK0CFEYbo51DarFkY7AwmI/IukMho6+hfNNhV3DO8PHsnSbmNxjy4CRBTV/CyX3tN9iAs0= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785985014; c=relaxed/simple; bh=rk95kKGG/SkoEMHzqicwZcRd7bMRmZDFgL6+fZ2Pbbc=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=p07JrxYKBRv83C3DpBkqdDhjUuX9iJJPnLp3O4AXd8XU7sZjU1tyZVstPOEQWktawCzG1mmws965rH7COGMLWPIryTPWJPqVi3UkatzuWqN7DlxfvoRd8SoHilpoxuS1bbFz0QH3lTO4DlPiG5+JnSib9/qhUI71Ov/Nf216QJQ= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b=XDj0gAuL; arc=none smtp.client-ip=100.103.45.18 Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b="XDj0gAuL" Received: by smtp.kernel.org (Postfix) with ESMTPSA id 5C0411F00A3A; Thu, 6 Aug 2026 02:56:48 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=kernel.org; s=k20260515; t=1785985013; bh=tV9IUwoo59NJmLmcHHMkUhsXWOY7J5vyTiJOpbYBP9Y=; h=From:Date:Subject:References:In-Reply-To:To:Cc; b=XDj0gAuLeC7MWqW0c2SPca4DFPqtpXvoT6kiBqmELVYSiyTl26bLuDtjnl2ENpAhp 4koH9qxhY0nFlJW89y1J4C1yoQH2TidTqrlTiQIAxHOF5QYguO1IWjQFeFZO7gfAIj lHRgNa37wJCqI0xlbn2F1JjCoNPGEpxGJAAVBNRuEY5bR85ezwnFOgZQKJzBnMf8F6 ZyvQ2ToRLi4JqFaltpKi/MUQMRm57+Ziu4V8WCp2UysHi58i6FDT4LPr/vr5+GZK4L ig7JxbuBMjkyQq0FtBjG/9oLXvRsYaFfgVK4Q44eJhaH+bQ4ndQRwLqPMPvEgGw1z8 gEmK+8FfpoQRA== From: Yixun Lan Date: Thu, 06 Aug 2026 02:56:18 +0000 Subject: [PATCH v3 1/3] scsi: ufs: spacemit: dt-bindings: Add UFS controller for K3 SoC Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20260806-08-k3-ufs-support-v3-1-037fb322acdb@kernel.org> References: <20260806-08-k3-ufs-support-v3-0-037fb322acdb@kernel.org> In-Reply-To: <20260806-08-k3-ufs-support-v3-0-037fb322acdb@kernel.org> To: Alim Akhtar , Avri Altman , Bart Van Assche , Rob Herring , Krzysztof Kozlowski , Conor Dooley , "James E.J. Bottomley" , "Martin K. Petersen" , Philipp Zabel , Paul Walmsley , Palmer Dabbelt , Albert Ou , Alexandre Ghiti Cc: Anirudh Srinivasan , Aurelien Jarno , Jennifer Berringer , linux-scsi@vger.kernel.org, devicetree@vger.kernel.org, linux-riscv@lists.infradead.org, spacemit@lists.linux.dev, linux-kernel@vger.kernel.org, Yixun Lan X-Mailer: b4 0.15.2 X-Developer-Signature: v=1; a=openpgp-sha256; l=2205; i=dlan@kernel.org; h=from:subject:message-id; bh=rk95kKGG/SkoEMHzqicwZcRd7bMRmZDFgL6+fZ2Pbbc=; b=owEB6QIW/ZANAwAKATGq6kdZTbvtAcsmYgBqc/fgPHVxzfEDiS3x9/JzjpYht0L6ZNUIuFsUp njnGrXusRqJAq8EAAEKAJkWIQS1urjJwxtxFWcCI9wxqupHWU277QUCanP34BsUgAAAAAAEAA5t YW51MiwyLjUrMS4xMiwyLDJfFIAAAAAALgAoaXNzdWVyLWZwckBub3RhdGlvbnMub3BlbnBncC5 maWZ0aGhvcnNlbWFuLm5ldEI1QkFCOEM5QzMxQjcxMTU2NzAyMjNEQzMxQUFFQTQ3NTk0REJCRU QACgkQMarqR1lNu+0FcA//X/edkMvgnBJ9mmIDmNZRE6x1/7phE7/KKhVlb1iWHZm1Ukg8Olf6x RI/0q5d/hXtIy3X/fcA6Cgfc/4fADVq23JkTRkPIHbuGF842tzIlHoejejnJToT9eUS3jEjtjFx 77L69uC766l6a1R30I+7nulgnkntrBzc7TynMuDYXrT7XQ1DG2Pzj0IcYmP2+bm+UdEQ0SKQg8k 2aJH5K8mylqC1R7SIf9sPgkldXmVrjNju7JL8ynUe4ta1tjM/bZ2A7GL5kUT5pi2gLGGe3ka1SB T/wlWfprSXIH+2PpUly0+1BE+X7OdPN4uVtYVL2FRBPuFDitAp86yBVOTbkn7UhcK3U4FN0B1z2 APnkj4eYxG2ejcoM+iTFXEPQ4/lY1XSB38GYo5GJ1w7vssM2/i/oIWjsnXSvACWRKmdrmIbiK32 ZxUmA93hHrRMbv0xo1WJz8S9tNCEEKPN2yI+rU9qcksL/FF4OGuhbvMbHWsiwQVEwn17ae7bHGt sh5st7a4Xl4tWd4kXDj3VqCuAs5lTzsFW9YobsFwOExSEiTRPJJPzfspzKiM+Il5HIIu4vlaYWc LsmovfFab9hLMM4N0NZbc+2aONOnV05sPADnAzGWx5KI9FYyVjtCxV5fdccxM527+pZ7rNVbO8l XOZcQBkJ1brXoWE0XE7NnRytVI9oug= X-Developer-Key: i=dlan@kernel.org; a=openpgp; fpr=50B03A1A5CBCD33576EF8CD7920C0DBCAABEFD55 Document the compatible for UFS (Universal Flash Storage) Host Controller which found in SpacemiT K3 SoC chip. Its features are listed below: - Compliant with MIPI UniPro v1.61 specification. - Compliant with M-PHY v3.0 specification. - Compliant with UFS HCI v2.1 specification. - Supports up to 2 Tx and 2 Rx lanes, up to HS-GEAR3 5.8 Gbps per lane. - Supports standard low-power hibernate to reduce power consumption. Signed-off-by: Yixun Lan Tested-by: Aurelien Jarno --- .../devicetree/bindings/ufs/spacemit,k3-ufshc.yaml | 56 ++++++++++++++++++= ++++ 1 file changed, 56 insertions(+) diff --git a/Documentation/devicetree/bindings/ufs/spacemit,k3-ufshc.yaml b= /Documentation/devicetree/bindings/ufs/spacemit,k3-ufshc.yaml new file mode 100644 index 000000000000..dda533c852e8 --- /dev/null +++ b/Documentation/devicetree/bindings/ufs/spacemit,k3-ufshc.yaml @@ -0,0 +1,56 @@ +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/ufs/spacemit,k3-ufshc.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: SpacemiT K3 SoC UFS Host Controller + +maintainers: + - Yixun Lan + +properties: + compatible: + const: spacemit,k3-ufshc + + reg: + maxItems: 1 + + clocks: + maxItems: 2 + + clock-names: + items: + - const: aclk + - const: ref_clk + + resets: + maxItems: 1 + +required: + - compatible + - reg + - clocks + - clock-names + - resets + +allOf: + - $ref: ufs-common.yaml + +unevaluatedProperties: false + +examples: + - | + #include + #include + #include + ufs@c0e00000 { + compatible =3D "spacemit,k3-ufshc"; + reg =3D <0xc0e00000 0x40000>; + clocks =3D <&syscon_apmu CLK_APMU_UFS_ACLK>, + <&syscon_apmu CLK_APMU_UFS_REFCLK>; + clock-names =3D "aclk", "ref_clk"; + resets =3D <&syscon_apmu RESET_APMU_UFS_ACLK>; + interrupts =3D <135 IRQ_TYPE_LEVEL_HIGH>; + lanes-per-direction =3D <2>; + }; --=20 2.55.0 From nobody Fri Oct 2 02:30:45 2026 Received: from smtp.kernel.org (aws-us-west-2-korg-mail-alma10-1.taild15c8.ts.net [100.103.45.18]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 57F4E35966; Thu, 6 Aug 2026 02:56:58 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=100.103.45.18 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785985021; cv=none; b=U4ndwYdppo6StwwXEQoZJfv6ktOMk1rwPoK7vVS7VT3o3183W7/C6i5aDFVjQcEBTv4CyCeRNjhKgqmCe5sOFJRdlpaBgP46bY0NgklVxFI10Q+/RVu1iv9nyjd5+Un8X02hrxsGtJ15m+fkSkEvZ+23KHSvePG0CJ4YcpU8pmI= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785985021; c=relaxed/simple; bh=QzNS899iOE4tNYLtLo5TlZvjSN0YAgHFx8uslDx5F1M=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=nebUe/f/hHtb2x+QgtWCJy+7pHRMxhzTFh5AkUO6MTDbmZ7zcYyLkyH0nztGHIhhgE7gYAe0iBpHCVEHVpyW6u7mWLjJtV+283XCcWZli9mH8Cfuq8bQo5bWDX2M9KVpTWW0+zKspvGWkvw7WtSGbOdPgUGIdGEBYCTIz9FpNIM= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b=Au2MIKRi; arc=none smtp.client-ip=100.103.45.18 Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b="Au2MIKRi" Received: by smtp.kernel.org (Postfix) with ESMTPSA id A8FCF1F000E9; Thu, 6 Aug 2026 02:56:53 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=kernel.org; s=k20260515; t=1785985018; bh=wftLR0CsijQ9R6L35Yunc29aD4SXE8XSkw3J+c+6ams=; h=From:Date:Subject:References:In-Reply-To:To:Cc; b=Au2MIKRiL+5r+VlyKMMSY7w6sitXlkPfBXZqwyzvrMwr7SIaKeWtso1vdY3tOqKyt t70+scXj90lt1PBQsU4aeBkhjyHWseDChJr8ybkjbQOquAubwY8UxbZrBE6ZlyhBdi LfeVxAINpXtz1wUJ1eWLrrLsQ51LCPhDFMlok3YSi8/Y5v1fvQiOzWOLcZ9KGd85sQ Rbwb7ZTPqdkmH6OIBFNe7xZ2gJL5ZFXoCdZEBb8/FyqyGS1T2beSEA6sGgfaNdb/Be /DNYsXsdNizUe2tomhUl19hnWw/6CDbrMGTNN2AHsZZT2+xJ2Ell35y8TC8My5R/ku S7bplbICAk29g== From: Yixun Lan Date: Thu, 06 Aug 2026 02:56:19 +0000 Subject: [PATCH v3 2/3] scsi: ufs: spacemit: k3: Add UFS Host Controller driver Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20260806-08-k3-ufs-support-v3-2-037fb322acdb@kernel.org> References: <20260806-08-k3-ufs-support-v3-0-037fb322acdb@kernel.org> In-Reply-To: <20260806-08-k3-ufs-support-v3-0-037fb322acdb@kernel.org> To: Alim Akhtar , Avri Altman , Bart Van Assche , Rob Herring , Krzysztof Kozlowski , Conor Dooley , "James E.J. Bottomley" , "Martin K. Petersen" , Philipp Zabel , Paul Walmsley , Palmer Dabbelt , Albert Ou , Alexandre Ghiti Cc: Anirudh Srinivasan , Aurelien Jarno , Jennifer Berringer , linux-scsi@vger.kernel.org, devicetree@vger.kernel.org, linux-riscv@lists.infradead.org, spacemit@lists.linux.dev, linux-kernel@vger.kernel.org, Yixun Lan X-Mailer: b4 0.15.2 X-Developer-Signature: v=1; a=openpgp-sha256; l=26566; i=dlan@kernel.org; h=from:subject:message-id; bh=QzNS899iOE4tNYLtLo5TlZvjSN0YAgHFx8uslDx5F1M=; b=owEB6QIW/ZANAwAKATGq6kdZTbvtAcsmYgBqc/fjLLDtHEtmlB++1FCb0jDNbpQyjArnwq0Z5 /hQej4E7YCJAq8EAAEKAJkWIQS1urjJwxtxFWcCI9wxqupHWU277QUCanP34xsUgAAAAAAEAA5t YW51MiwyLjUrMS4xMiwyLDJfFIAAAAAALgAoaXNzdWVyLWZwckBub3RhdGlvbnMub3BlbnBncC5 maWZ0aGhvcnNlbWFuLm5ldEI1QkFCOEM5QzMxQjcxMTU2NzAyMjNEQzMxQUFFQTQ3NTk0REJCRU QACgkQMarqR1lNu+0tCxAAi5C7pTBWmdXF+LeREraJv5TTaED8xisOdw63bvWZOdCXl/lCPrysn kgaJmyS6txqvgJ7mMiyWbJQqEgfn3CflvShpecYpJu0p/cD7wHi6VLhnwC9a+Nq9iHE7/RpK+je 2kToJ1/zPzoQe7w26suOuIB+sJ4fDwaJGwhU/Cb0Yiov6pg/GDqu53IYrICDx+wmeN2hRNSmJk2 ZCEG9O5jEsYChNy8B1CkwGlkxf0/uHq6LXh2BMbf2YO2DS1OD31denC2Bb1MdE29E2JtxMU3yT9 gcLndWFk+GEZw3ow+Rtz0sPVSL+0lJc8UOOvfBiyCpdUKVFenIW96817C9rTWPfs9/GQ8X39tw9 2wTPv+c6chuWXdAb+zTNajWjmMOuCK9s82n9huodjWy5/KwkdT5xGJWnKE77CvOXztIo/woxM2L 8HT3+RRdvJj7iUAESWDIQ4zUs+PT1zgUIwRWp1P4RIOamx7dys6MHybFvpUWe/fAFgKgO0LsL/A ZV/wfaRR2aFScftJxtYnJf5r4ig91yKkzL7LnzouSg211dZgv19ay/Xbq3yGK1OUU4bBhAfSMGc +ya9Taz/rIiPhSj5tEib2xZ37F+7EkY+5i+g1zB7Hw3DD33V7bNiAaickbL69UohqUtihFdvF1L bFlbWf4dm2V0snDRz+HUIpg1OvfIjQ= X-Developer-Key: i=dlan@kernel.org; a=openpgp; fpr=50B03A1A5CBCD33576EF8CD7920C0DBCAABEFD55 SpacemiT K3 SoC consist of UFS (Universal Flash Storage) Host Controller which has features compatible with JEDEC UFS 2.2, MIPI UniPro v1.61 and M-PHY v3.0 standard. Signed-off-by: Yixun Lan Tested-by: Aurelien Jarno --- drivers/ufs/host/Kconfig | 12 + drivers/ufs/host/Makefile | 1 + drivers/ufs/host/ufs-spacemit.c | 687 ++++++++++++++++++++++++++++++++++++= ++++ drivers/ufs/host/ufs-spacemit.h | 79 +++++ 4 files changed, 779 insertions(+) diff --git a/drivers/ufs/host/Kconfig b/drivers/ufs/host/Kconfig index ff170c0b6da0..6146872fcecc 100644 --- a/drivers/ufs/host/Kconfig +++ b/drivers/ufs/host/Kconfig @@ -132,6 +132,18 @@ config SCSI_UFS_VARIABLE_SG_ENTRY_SIZE bool default y if SCSI_UFS_EXYNOS && SCSI_UFS_CRYPTO =20 +config SCSI_UFS_SPACEMIT + tristate "SpacemiT UFS controller driver" + depends on SCSI_UFSHCD_PLATFORM && (ARCH_SPACEMIT || COMPILE_TEST) + help + This selects the SpacemiT specific additions to UFSHCD platform driver. + UFS host on SpacemiT needs some vendor specific configuration before + accessing the hardware which includes PHY configuration and vendor + specific registers. + + Select this if you have UFS controller on SpacemiT chipset. + If unsure, say N. + config SCSI_UFS_SPRD tristate "Unisoc specific hooks to UFS controller platform driver" depends on SCSI_UFSHCD_PLATFORM && (ARCH_SPRD || COMPILE_TEST) diff --git a/drivers/ufs/host/Makefile b/drivers/ufs/host/Makefile index 65d8bb23ab7b..151bf43dfba7 100644 --- a/drivers/ufs/host/Makefile +++ b/drivers/ufs/host/Makefile @@ -11,6 +11,7 @@ obj-$(CONFIG_SCSI_UFS_HISI) +=3D ufs-hisi.o obj-$(CONFIG_SCSI_UFS_MEDIATEK) +=3D ufs-mediatek.o obj-$(CONFIG_SCSI_UFS_RENESAS) +=3D ufs-renesas.o obj-$(CONFIG_SCSI_UFS_ROCKCHIP) +=3D ufs-rockchip.o +obj-$(CONFIG_SCSI_UFS_SPACEMIT) +=3D ufs-spacemit.o obj-$(CONFIG_SCSI_UFS_SPRD) +=3D ufs-sprd.o obj-$(CONFIG_SCSI_UFS_TI_J721E) +=3D ti-j721e-ufs.o obj-$(CONFIG_SCSI_UFS_AMD_VERSAL2) +=3D ufs-amd-versal2.o ufshcd-dwc.o diff --git a/drivers/ufs/host/ufs-spacemit.c b/drivers/ufs/host/ufs-spacemi= t.c new file mode 100644 index 000000000000..94942ea27fb7 --- /dev/null +++ b/drivers/ufs/host/ufs-spacemit.c @@ -0,0 +1,687 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Copyright (c) 2026 SpacemiT (Hangzhou) Technology Co. Ltd + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include + +#include "ufshcd-pltfrm.h" +#include "ufs-spacemit.h" + +/* PA Layer Gettable and settable M-PHY Specific Attributes */ +#define PA_TXHSG1SYNCLENGTH 0x1552 +#define PA_TXHSG1PREPARELENGTH 0x1553 +#define PA_TXHSG2SYNCLENGTH 0x1554 +#define PA_TXHSG2PREPARELENGTH 0x1555 +#define PA_TXHSG3SYNCLENGTH 0x1556 +#define PA_TXHSG3PREPARELENGTH 0x1557 +#define PA_TXMK2EXTENSION 0x155A +#define PA_PEERSCRAMBLING 0x155B +#define PA_TXSKIP 0x155C +#define PA_TXSKIPPERIOD 0x155D +#define PA_PEER_TX_LCC_ENABLE 0x155F + +#define PA_SCRAMBLING 0x1585 +#define PA_MK2EXTENSIONGUARDBAND 0x15AB + +/* Special TX/RX Configuration Attributes */ +#define RX_LS_PRE_LEN_CAP 0x008D +#define RX_LANE_HB8_BKDOOR_ATTR 0x00F4 +#define RX_PWRM_CLOSURE_LEN_CAP 0x008E +#define RX_MIN_STALL_CAP 0x0088 +#define RX_LANE_SOF_BKDOOR_ATT 0x00F2 +#define RX_GARBAGE_COUNT_OFFSET 0x00F2 + +/* Special analog register */ +#define ANA_EQ_CTRL_REG_ATTR 0x00CD +#define ANA_HSGEAR_CTRL_ATTR 0x00C1 + +/* + * Keep UFS ACLK at a lower parent rate (409.6MHz) for stable init. + * This mirrors the "ufs-low-aclk-freq" change from the other environment. + */ +#define UFS_ACLK_LOW_FREQ_HZ 409600000UL + +/* PHY register magic values */ +#define MPHY_PU_ALL 0x87f +#define MPHY_PU_WITH_HB8_RESET 0xb7f +#define MPHY_DEVICE_RESET_DEASSERT 0x101 +#define MPHY_DEVICE_RESET_ASSERT 0x001 +#define MPHY_PLL_LOCK_BIT BIT(31) +#define MPHY_PLL_LOCK_TIMEOUT_US 10000 + +/* FSM states */ +#define FSM_STATE_HIBERN8 0x1 +#define FSM_STATE_ACTIVE 0x3 +#define FSM_STATE_LS_BURST 0x5 + +#define VENDOR_DUMP_BUF_SIZE 2048 +#define VENDOR_MAX_OFFSET 0xE0 + +/* M-PHY FSM states */ +#define MPHY_RX_FSM_STATE 0xC1 +#define MPHY_TX_FSM_STATE 0x41 + +static int ufs_spacemit_dme_set(struct ufs_hba *hba, + const struct ufshcd_dme_attr_val *v, int n) +{ + int ret =3D 0; + int attr_node =3D 0; + + for (attr_node =3D 0; attr_node < n; attr_node++) { + ret =3D ufshcd_dme_set(hba, v[attr_node].attr_sel, + v[attr_node].mib_val); + + if (ret) + return ret; + } + + return 0; +} + +static int ufs_spacemit_check_hibern8(struct ufs_hba *hba) +{ + u32 tx_fsm_val_0 =3D 0; + u32 tx_fsm_val_1 =3D 0; + int retries =3D DIV_ROUND_UP(HBRN8_POLL_TOUT_MS * 1000, 100); + int err =3D 0; + + do { + err =3D ufshcd_dme_get(hba, + UIC_ARG_MIB_SEL(MPHY_TX_FSM_STATE, + UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0)), + &tx_fsm_val_0); + if (err) + break; + + err =3D ufshcd_dme_get(hba, + UIC_ARG_MIB_SEL(MPHY_TX_FSM_STATE, + UIC_ARG_MPHY_TX_GEN_SEL_INDEX(1)), + &tx_fsm_val_1); + if (err || (tx_fsm_val_0 =3D=3D TX_FSM_HIBERN8 && + tx_fsm_val_1 =3D=3D TX_FSM_HIBERN8)) + break; + + usleep_range(100, 200); + } while (--retries > 0); + + if (err) { + dev_err(hba->dev, "%s: unable to get TX_FSM_STATE, err %d\n", + __func__, err); + } else if (tx_fsm_val_0 !=3D TX_FSM_HIBERN8 || + tx_fsm_val_1 !=3D TX_FSM_HIBERN8) { + err =3D -ETIMEDOUT; + dev_err(hba->dev, + "%s: invalid TX_FSM_STATE, lane0 =3D %u, lane1 =3D %u\n", + __func__, tx_fsm_val_0, tx_fsm_val_1); + } + + return err; +} + +static int ufs_spacemit_get_connected_tx_lanes(struct ufs_hba *hba, u32 *t= x_lanes) +{ + int err; + + err =3D ufshcd_dme_get(hba, UIC_ARG_MIB(PA_CONNECTEDTXDATALANES), tx_lane= s); + if (err) + dev_err(hba->dev, "%s: couldn't read PA_CONNECTEDTXDATALANES %d\n", __fu= nc__, err); + + return err; +} + +static u32 ufs_spacemit_get_sys1clk_1us(struct ufs_hba *hba) +{ + struct ufs_clk_info *clki, *ufs_aclk =3D NULL; + struct list_head *head =3D &hba->clk_list_head; + unsigned long rate_hz =3D 0; + + if (!list_empty(head)) { + list_for_each_entry(clki, head, list) { + if (clki->name && !strcmp(clki->name, "aclk") && clki->clk) { + ufs_aclk =3D clki; + break; + } + } + } + + if (ufs_aclk && ufs_aclk->clk) + rate_hz =3D clk_get_rate(ufs_aclk->clk); + + if (!rate_hz) + return 0; + + return DIV_ROUND_CLOSEST(rate_hz, 1000000); +} + +static int ufs_spacemit_wait_mphy_pll_lock(struct ufs_hba *hba) +{ + u32 val; + int err; + + err =3D read_poll_timeout(ufshcd_readl, val, val & MPHY_PLL_LOCK_BIT, + 10, MPHY_PLL_LOCK_TIMEOUT_US, false, hba, + UFS_PHY_MNG_BASE + UFS_MPHY_PU_CTRL); + + if (err) + dev_err(hba->dev, "M-PHY PLL lock timeout\n"); + + return err; +} + +/** + * ufs_spacemit_mphy_init + * @hba: host controller instance + */ +static int ufs_spacemit_mphy_init(struct ufs_hba *hba) +{ + int ret; + + /* reset all mphy logical */ + ufshcd_writel(hba, 0x003, UFS_PHY_MNG_BASE + 0x0); + + /* power up all */ + ufshcd_writel(hba, MPHY_PU_ALL, UFS_PHY_MNG_BASE + 0x4); + + /* asserted ana_rx_hb8_reset */ + ufshcd_writel(hba, 0xb7f, UFS_PHY_MNG_BASE + 0x4); + fsleep(500); + + /* deasserted ana_rx_hb8_reset */ + ufshcd_writel(hba, MPHY_PU_ALL, UFS_PHY_MNG_BASE + 0x4); + + /* deasserted ufs device reset & refer clk output enable */ + ufshcd_writel(hba, 0x101, UFS_PHY_MNG_BASE + 0xC); + fsleep(1000); + + ret =3D ufs_spacemit_wait_mphy_pll_lock(hba); + if (ret < 0) + return ret; + + dev_dbg(hba->dev, "M-PHY PLL locked successfully\n"); + + ufshcd_writel(hba, 0x1, UFS_PHY_MNG_BASE + 0x08); + + ufshcd_writel(hba, 0x40, UFS_ATOP_BASE + (0xC2 << 2)); + + ufshcd_writel(hba, 0x0, UFS_PHY_MNG_BASE + 0x08); + + fsleep(2000); + + dev_dbg(hba->dev, "M-PHY init completed\n"); + + return 0; +} + +static int ufs_spacemit_uniprov1p6_init(struct ufs_hba *hba) +{ + static const struct ufshcd_dme_attr_val setup_attrs[] =3D { + { UIC_ARG_MIB(0x1552), 0x4f }, /* PA_TXHSG1SYNCLENGTH */ + { UIC_ARG_MIB(0x1553), 0xf }, /* PA_TXHSG1PREPARELENGTH */ + { UIC_ARG_MIB(0x1554), 0x4f }, /* PA_TXHSG2SYNCLENGTH */ + { UIC_ARG_MIB(0x1555), 0xf }, /* PA_TXHSG2PREPARELENGTH */ + { UIC_ARG_MIB(0x1556), 0x4f }, /* PA_TXHSG3SYNCLENGTH */ + { UIC_ARG_MIB(0x1557), 0xf }, /* PA_TXHSG3PREPARELENGTH */ + { UIC_ARG_MIB(0x155A), 0x0 }, /* PA_TXMK2EXTENSION */ + { UIC_ARG_MIB(0x155B), 0x1}, /* PA_PEERSCRAMBLING */ + { UIC_ARG_MIB(0x155C), 0x1 }, /* PA_TXSKIP */ + { UIC_ARG_MIB(0x155D), 250 }, /* PA_TXSKIPPERIOD */ + { UIC_ARG_MIB(0x155E), 0x0 }, /* PA_LOCAL_TX_LCC_ENABLE */ + { UIC_ARG_MIB(0x155F), 0x0 }, /* PA_PEER_TX_LCC_ENABLE */ + { UIC_ARG_MIB(0x1585), 0x1 }, /* PA_SCRAMBLING */ + { UIC_ARG_MIB(0x15AA), 0x1 }, /* PA_GRANULARITY */ + { UIC_ARG_MIB(0x15AB), 0x0 }, /* PA_MK2EXTENSIONGUARDBAND */ + { UIC_ARG_MIB(0x15A3), 15 }, /* PA_STALLNOCONFIGTIME */ + { UIC_ARG_MIB(0x15A8), 0x64 }, /* PA_TACTIVATE */ + { UIC_ARG_MIB(0x1564), 0x64 }, /* PA_TXTRAILINGCLOCKS */ + { UIC_ARG_MIB_SEL(0x008D, 4), 0x0B }, /* RX_LS_PREPARELEN_TIME RX0 */ + { UIC_ARG_MIB_SEL(0x008D, 5), 0x0B }, /* RX_LS_PREPARELEN_TIME RX1 */ + + /* RX_HIBERNATE_BKEN RX0 */ + { UIC_ARG_MIB_SEL(0x00F4, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0x9F }, + /* RX_HIBERNATE_BKEN RX1 */ + { UIC_ARG_MIB_SEL(0x00F4, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0x9F }, + /* PWM_BURST_closure_length */ + { UIC_ARG_MIB_SEL(0x008E, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 15 }, + { UIC_ARG_MIB_SEL(0x008E, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 15 }, + /* min_stall_not_config_time */ + { UIC_ARG_MIB_SEL(0x0088, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0xFF }, + { UIC_ARG_MIB_SEL(0x0088, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0xFF }, + /* TX HB8_TIME CAP */ + { UIC_ARG_MIB_SEL(0x000F, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0)), 0x64 }, + { UIC_ARG_MIB_SEL(0x000F, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(1)), 0x64 }, + /* RX HB8_TIME CAP */ + { UIC_ARG_MIB_SEL(0x0092, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0x64 }, + { UIC_ARG_MIB_SEL(0x0092, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0x64 }, + /* TX EQ 3DB */ + { UIC_ARG_MIB_SEL(0x00CD, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0)), 0x5 }, + /* RX garbage cnt =3D 32 SI */ + { UIC_ARG_MIB_SEL(0x00F2, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0x9F }, + { UIC_ARG_MIB_SEL(0x00F2, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0x9F }, + }; + + return ufs_spacemit_dme_set(hba, setup_attrs, ARRAY_SIZE(setup_attrs)); +} + +static void ufs_spacemit_set_dev_cap(struct ufs_host_params *host_params, = u32 pwr_hs) +{ + if (!host_params) + return; + + memset(host_params, 0, sizeof(struct ufs_host_params)); + host_params->tx_lanes =3D UFS_SPACEMIT_K3_LIMIT_NUM_LANES_TX; + host_params->rx_lanes =3D UFS_SPACEMIT_K3_LIMIT_NUM_LANES_RX; + host_params->hs_rx_gear =3D UFS_SPACEMIT_K3_LIMIT_HSGEAR_RX; + host_params->hs_tx_gear =3D UFS_SPACEMIT_K3_LIMIT_HSGEAR_TX; + host_params->pwm_rx_gear =3D UFS_SPACEMIT_K3_LIMIT_PWMGEAR_RX; + host_params->pwm_tx_gear =3D UFS_SPACEMIT_K3_LIMIT_PWMGEAR_TX; + host_params->rx_pwr_pwm =3D UFS_SPACEMIT_K3_LIMIT_RX_PWR_PWM; + host_params->tx_pwr_pwm =3D UFS_SPACEMIT_K3_LIMIT_TX_PWR_PWM; + host_params->rx_pwr_hs =3D pwr_hs; + host_params->tx_pwr_hs =3D pwr_hs; + host_params->hs_rate =3D UFS_SPACEMIT_K3_LIMIT_HS_RATE; + host_params->desired_working_mode =3D UFS_HS_MODE; +} + +static int ufs_spacemit_link_startup_pre_change(struct ufs_hba *hba) +{ + u32 value, sys1clk_1us; + int err; + + err =3D ufs_spacemit_mphy_init(hba); + if (err < 0) + return err; + + err =3D ufs_spacemit_uniprov1p6_init(hba); + if (err < 0) + return err; + + /* config sysclk and tx symbol clk before link startup */ + value =3D UFS_MAX_LINKSTARTUP_TIMER; + + /* clear bit0~bit3, select b0 design */ + value &=3D ~0xf; + + ufshcd_writel(hba, value, UFS_PA_LINK_STARTUP_TIMER); + + sys1clk_1us =3D ufs_spacemit_get_sys1clk_1us(hba); + if (!sys1clk_1us) + sys1clk_1us =3D DIV_ROUND_CLOSEST(UFS_ACLK_LOW_FREQ_HZ, 1000000); + ufshcd_writel(hba, sys1clk_1us, UFS_SYS1CLK_1US); + ufshcd_writel(hba, UFS_TX_SYMBO_CLK, UFS_TX_SYMBOL_CLK_NS_US); + + dev_dbg(hba->dev, "REG_UFS_SYS1CLK_1US: 0x%x\n", + ufshcd_readl(hba, UFS_SYS1CLK_1US)); + dev_dbg(hba->dev, "REG_UFS_TX_SYMBOL_CLK_NS_US: 0x%x\n", + ufshcd_readl(hba, UFS_TX_SYMBOL_CLK_NS_US)); + + return 0; +} + +static int ufs_spacemit_link_startup_post_change(struct ufs_hba *hba) +{ + /* Add 0xe8 make UFS2.1 run GEAR3 + 2Lane@409M */ + static const struct ufshcd_dme_attr_val setup_attrs[] =3D { + { UIC_ARG_MIB_SEL(0xe8, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0)), 0x97 }, + { UIC_ARG_MIB_SEL(0xe8, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0)), 0xd7 }, + { UIC_ARG_MIB_SEL(0xe8, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0)), 0x17 }, + { UIC_ARG_MIB(DL_AFC0REQTIMEOUTVAL), UFS_DL_AFC0REQTIMEOUTVAL_MAX }, + }; + u32 tx_lanes; + int err; + + err =3D ufs_spacemit_dme_set(hba, setup_attrs, ARRAY_SIZE(setup_attrs)); + if (err < 0) + return err; + + return ufs_spacemit_get_connected_tx_lanes(hba, &tx_lanes); +} + +static int ufs_spacemit_link_startup_notify(struct ufs_hba *hba, + enum ufs_notify_change_status status) +{ + int err =3D 0; + + switch (status) { + case PRE_CHANGE: + err =3D ufs_spacemit_link_startup_pre_change(hba); + break; + case POST_CHANGE: + err =3D ufs_spacemit_link_startup_post_change(hba); + break; + default: + break; + } + + return err; +} + +static int ufs_spacemit_negotiate_pwr_mode(struct ufs_hba *hba, + const struct ufs_pa_layer_attr *dev_max_params, + struct ufs_pa_layer_attr *dev_req_params) +{ + struct ufs_host_params host_params; + int ret; + + ufs_spacemit_set_dev_cap(&host_params, FAST_MODE); + ret =3D ufshcd_negotiate_pwr_params(&host_params, dev_max_params, + dev_req_params); + if (ret) { + dev_err(hba->dev, "Failed to negotiate power params: %d\n", ret); + return ret; + } + + dev_dbg(hba->dev, + "Power mode config - gear_rx:%d, gear_tx:%d, lane_rx:%d, lane_tx:%d, pwr= _rx:%d, pwr_tx:%d, hs_rate:%d\n", + dev_req_params->gear_rx, dev_req_params->gear_tx, dev_req_params->lane_r= x, + dev_req_params->lane_tx, dev_req_params->pwr_rx, dev_req_params->pwr_tx, + dev_req_params->hs_rate); + + return ret; +} + +static int ufs_spacemit_pwr_change_notify(struct ufs_hba *hba, + enum ufs_notify_change_status status, + struct ufs_pa_layer_attr *dev_req_params) +{ + struct ufs_spacemit_host *host =3D ufshcd_get_variant(hba); + int ret =3D 0; + + if (!dev_req_params) { + dev_err(hba->dev, "Invalid Parameters\n"); + return -EINVAL; + } + + switch (status) { + case PRE_CHANGE: + break; + case POST_CHANGE: + /* Cache the power mode parameters to use internally */ + memcpy(&host->dev_req_params, dev_req_params, sizeof(*dev_req_params)); + ret =3D ufs_spacemit_wait_mphy_pll_lock(hba); + if (ret < 0) + return ret; + + dev_dbg(hba->dev, "M-PHY PLL locked after power mode change\n"); + /* Set ANA_HSGEAR_CTRL_ATTR back to default value */ + ufshcd_dme_set(hba, UIC_ARG_MIB(ANA_HSGEAR_CTRL_ATTR), 0x00); + break; + default: + return -EINVAL; + } + + return ret; +} + +static int ufs_spacemit_quirk_host_pa_saveconfigtime(struct ufs_hba *hba) +{ + int err; + u32 pa_vs_config_reg1; + + err =3D ufshcd_dme_get(hba, UIC_ARG_MIB(UFS_PA_VS_CONFIG_REG1), &pa_vs_co= nfig_reg1); + if (err) + return err; + + /* Allow extension of MSB bits of PA_SaveConfigTime attribute */ + return ufshcd_dme_set(hba, UIC_ARG_MIB(UFS_PA_VS_CONFIG_REG1), + (pa_vs_config_reg1 | (1 << 12))); +} + +static int ufs_spacemit_apply_dev_quirks(struct ufs_hba *hba) +{ + static const struct ufshcd_dme_attr_val setup_attrs[] =3D { + /* LCC_DISABLE */ + { UIC_ARG_MIB_SEL(TX_LCC_ENABLE, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0)), 0 }, + { UIC_ARG_MIB_SEL(TX_LCC_ENABLE, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(1)), 0 }, + /* TX_Min_ActivateTime */ + { UIC_ARG_MIB_SEL(TX_MIN_ACTIVATETIME, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(0))= , 0x0 }, + { UIC_ARG_MIB_SEL(TX_MIN_ACTIVATETIME, UIC_ARG_MPHY_TX_GEN_SEL_INDEX(1))= , 0x0 }, + { UIC_ARG_MIB(ANA_HSGEAR_CTRL_ATTR), 0x25 }, + }; + + if (hba->dev_quirks & UFS_DEVICE_QUIRK_HOST_PA_SAVECONFIGTIME) + ufs_spacemit_quirk_host_pa_saveconfigtime(hba); + + if (hba->dev_info.wmanufacturerid =3D=3D UFS_VENDOR_WDC) + hba->dev_quirks |=3D UFS_DEVICE_QUIRK_HOST_PA_TACTIVATE; + + ufs_spacemit_dme_set(hba, setup_attrs, ARRAY_SIZE(setup_attrs)); + + return ufs_spacemit_wait_mphy_pll_lock(hba); +} + +/** + * ufs_spacemit_advertise_quirks - advertise the known Spacemit UFS contro= ller quirks + * @hba: host controller instance + * + * Spacemit UFS host controller might have some non standard behaviours (q= uirks) + * than what is specified by UFSHCI specification. Advertise all such + * quirks to standard UFS host controller driver so standard takes them in= to + * account. + */ +static void ufs_spacemit_advertise_quirks(struct ufs_hba *hba) +{ + hba->quirks |=3D UFSHCD_QUIRK_BROKEN_AUTO_HIBERN8; +} + +/** + * ufs_spacemit_init - init phy and prepare clk + * @hba: host controller instance + */ +static int ufs_spacemit_init(struct ufs_hba *hba) +{ + int err =3D 0; + struct device *dev =3D hba->dev; + struct ufs_spacemit_host *host; + struct reset_control *rst; + + host =3D devm_kzalloc(dev, sizeof(*host), GFP_KERNEL); + if (!host) + return -ENOMEM; + + rst =3D devm_reset_control_get_exclusive_deasserted(dev, NULL); + if (IS_ERR(rst)) + return dev_err_probe(dev, PTR_ERR(rst), "Failed to get reset control\n"); + + host->hba =3D hba; + ufshcd_set_variant(hba, host); + ufs_spacemit_advertise_quirks(hba); + + err =3D ufshcd_vops_phy_initialization(host->hba); + return err; +} + +/** + * ufs_spacemit_device_reset - Toggle device reset line + * @hba: per-adapter instance + * + * Toggles the reset line to reset the attached UFS device. + * + * Returns: 0 on success + */ +static int ufs_spacemit_device_reset(struct ufs_hba *hba) +{ + /* Stop device ref_clk & asserted ufs device reset */ + ufshcd_writel(hba, 0x000, UFS_PHY_MNG_BASE + UFS_DEVICE_IO_CTRL); + usleep_range(10, 15); + + /* Enable device ref_clk & de-asserted ufs device reset */ + ufshcd_writel(hba, MPHY_DEVICE_RESET_DEASSERT, UFS_PHY_MNG_BASE + UFS_DEV= ICE_IO_CTRL); + usleep_range(10, 15); + + return 0; +} + +/** + * ufs_spacemit_event_notify - Handle UFS error events + * @hba: host controller instance + * @evt: event type + * @data: event-specific data + * + * Handles error events from UFS core, print warning messages + */ +static void ufs_spacemit_event_notify(struct ufs_hba *hba, enum ufs_event_= type evt, void *data) +{ + switch (evt) { + case UFS_EVT_PA_ERR: + if (data) + dev_warn(hba->dev, "PA error event, INT errors:0x%x, PA_ERR_CODE:0x%x\n= ", + hba->errors, *(u32 *)data); + + break; + case UFS_EVT_DL_ERR: + if (data) + dev_warn(hba->dev, "DL error event, INT errors:0x%x, DL_ERR:0x%x\n", + hba->errors, *(u32 *)data); + + break; + case UFS_EVT_ABORT: + dev_warn(hba->dev, "Abort event, INT errors:0x%x\n", hba->errors); + break; + default: + break; + } +} + +static void ufs_spacemit_pre_hibern8(struct ufs_hba *hba, enum uic_cmd_dme= cmd) +{ + static const struct ufshcd_dme_attr_val setup_attrs[] =3D { + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0x84 }, + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0x84 }, + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0x85 }, + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0x85 }, + }; + int ret; + + if (cmd =3D=3D UIC_CMD_DME_HIBER_EXIT) { + /* Enable reference clock */ + ufshcd_writel(hba, MPHY_DEVICE_RESET_DEASSERT, + UFS_PHY_MNG_BASE + UFS_DEVICE_IO_CTRL); + + /* Power up all */ + ufshcd_writel(hba, MPHY_PU_ALL, UFS_PHY_MNG_BASE + UFS_MPHY_PU_CTRL); + + /* Assert ana_rx_hb8_reset */ + ufshcd_writel(hba, MPHY_PU_WITH_HB8_RESET, + UFS_PHY_MNG_BASE + UFS_MPHY_PU_CTRL); + fsleep(500); + + /* Deassert ana_rx_hb8_reset */ + ufshcd_writel(hba, MPHY_PU_ALL, UFS_PHY_MNG_BASE + UFS_MPHY_PU_CTRL); + + ret =3D ufs_spacemit_wait_mphy_pll_lock(hba); + if (ret < 0) + return; + + ufshcd_dme_set(hba, UIC_ARG_MIB(0xdd), 0x57); + ufshcd_dme_set(hba, UIC_ARG_MIB(0xe8), 0x57); + } + + if (cmd =3D=3D UIC_CMD_DME_HIBER_ENTER) + ufs_spacemit_dme_set(hba, setup_attrs, ARRAY_SIZE(setup_attrs)); +} + +static void ufs_spacemit_post_hibern8(struct ufs_hba *hba, enum uic_cmd_dm= e cmd) +{ + static const struct ufshcd_dme_attr_val setup_attrs[] =3D { + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0x84 }, + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0x84 }, + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)), 0x80 }, + { UIC_ARG_MIB_SEL(0xf1, UIC_ARG_MPHY_RX_GEN_SEL_INDEX(1)), 0x80 }, + { UIC_ARG_MIB(0xdd), 0x57 }, + { UIC_ARG_MIB(0xdd), 0xd7 }, + { UIC_ARG_MIB(0xe8), 0x57 }, + { UIC_ARG_MIB(0xe8), 0xd7 }, + }; + + if (cmd =3D=3D UIC_CMD_DME_HIBER_ENTER) { + ufs_spacemit_check_hibern8(hba); + + ufs_spacemit_dme_set(hba, setup_attrs, ARRAY_SIZE(setup_attrs)); + + /* Power down M-PHY */ + ufshcd_writel(hba, 0x0, UFS_PHY_MNG_BASE + UFS_MPHY_PU_CTRL); + + /* Keep reference clock enabled, assert device reset */ + ufshcd_writel(hba, MPHY_DEVICE_RESET_ASSERT, + UFS_PHY_MNG_BASE + UFS_DEVICE_IO_CTRL); + } +} + +/** + * ufs_spacemit_hibern8_notify - Handle hibernate enter/exit + * @hba: host controller instance + * @cmd: UIC command (HIBER_ENTER or HIBER_EXIT) + * @status: notification status + * + * Manages M-PHY power state during hibernate transitions. + */ +static void ufs_spacemit_hibern8_notify(struct ufs_hba *hba, enum uic_cmd_= dme cmd, + enum ufs_notify_change_status status) +{ + if (status =3D=3D PRE_CHANGE) + ufs_spacemit_pre_hibern8(hba, cmd); + + if (status =3D=3D POST_CHANGE) + ufs_spacemit_post_hibern8(hba, cmd); +} + +/** + * struct ufs_hba_spacemit_vops - UFS Spacemit specific variant operations + * + * The variant operations configure the necessary controller and PHY + * handshake during initialization. + */ +static const struct ufs_hba_variant_ops ufs_hba_spacemit_vops =3D { + .name =3D "ufshcd-spacemit", + .init =3D ufs_spacemit_init, + .link_startup_notify =3D ufs_spacemit_link_startup_notify, + .negotiate_pwr_mode =3D ufs_spacemit_negotiate_pwr_mode, + .pwr_change_notify =3D ufs_spacemit_pwr_change_notify, + .device_reset =3D ufs_spacemit_device_reset, + .event_notify =3D ufs_spacemit_event_notify, + .apply_dev_quirks =3D ufs_spacemit_apply_dev_quirks, + .hibern8_notify =3D ufs_spacemit_hibern8_notify, +}; + +static const struct of_device_id ufs_spacemit_of_match[] =3D { + { .compatible =3D "spacemit,k3-ufshc" }, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(of, ufs_spacemit_of_match); + +static int ufs_spacemit_probe(struct platform_device *pdev) +{ + return ufshcd_pltfrm_init(pdev, &ufs_hba_spacemit_vops); +} + +static void ufs_spacemit_remove(struct platform_device *pdev) +{ + ufshcd_pltfrm_remove(pdev); +} + +static struct platform_driver ufs_spacemit_pltform =3D { + .probe =3D ufs_spacemit_probe, + .remove =3D ufs_spacemit_remove, + .driver =3D { + .name =3D "ufshcd-spacemit", + .of_match_table =3D of_match_ptr(ufs_spacemit_of_match), + }, +}; +module_platform_driver(ufs_spacemit_pltform); + +MODULE_DESCRIPTION("SpacemiT UFS Host Driver"); +MODULE_LICENSE("GPL"); diff --git a/drivers/ufs/host/ufs-spacemit.h b/drivers/ufs/host/ufs-spacemi= t.h new file mode 100644 index 000000000000..5e459f6ba243 --- /dev/null +++ b/drivers/ufs/host/ufs-spacemit.h @@ -0,0 +1,79 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ +/* + * SpacemiT UFS Host Controller driver + * + * Copyright (c) 2026 SpacemiT (Hangzhou) Technology Co. Ltd + */ + +#ifndef _UFS_SPACEMIT_H_ +#define _UFS_SPACEMIT_H_ + +#include +#include +#include + +/* Spacemit K3 UFS host controller vendor specific registers */ +#define UFS_SYS1CLK_1US 0xC0 +#define UFS_TX_SYMBOL_CLK_NS_US 0xC4 +#define UFS_LOCAL_PORT_ID_REG 0xC8 +#define UFS_PA_ERR_CODE 0xCC +#define UFS_RETRY_TIMER_REG 0xD0 +#define UFS_PA_LINK_STARTUP_TIMER 0xD8 +#define UFS_CFG1 0xDC + +/* MPHY control registers */ +#define UFS_PHY_MNG_BASE 0x1B00 +#define UFS_MPHY_RST_CTRL 0x0 +#define UFS_MPHY_PU_CTRL 0x4 +#define UFS_MPHY_BKDR_CTRL 0x8 +#define UFS_DEVICE_IO_CTRL 0xC + +/* ATOP base*/ +#define UFS_ATOP_BASE 0x1C00 + +#define UFS_SYSCLK 499 +#define UFS_TX_SYMBO_CLK 0x800 +#define UFS_MAX_LINKSTARTUP_TIMER 0xFFFFFFFF +#define UFS_DL_AFC0REQTIMEOUTVAL_MAX 0xFFFF + +#define MPHY_TX_FSM_STATE 0x41 +#define TX_FSM_HIBERN8 0x1 +#define HBRN8_POLL_TOUT_MS 100 +#define DEFAULT_CLK_RATE_HZ 1000000 +#define BUS_VECTOR_NAME_LEN 32 + +#define UFS_HW_VER_MAJOR_SHFT 28 +#define UFS_HW_VER_MAJOR_MASK (0x000F << UFS_HW_VER_MAJOR_SHFT) +#define UFS_HW_VER_MINOR_SHFT 16 +#define UFS_HW_VER_MINOR_MASK (0x0FFF << UFS_HW_VER_MINOR_SHFT) +#define UFS_HW_VER_STEP_SHFT 0 +#define UFS_HW_VER_STEP_MASK (0xFFFF << UFS_HW_VER_STEP_SHFT) + +#define UFS_SPACEMIT_K3_LIMIT_NUM_LANES_RX 2 +#define UFS_SPACEMIT_K3_LIMIT_NUM_LANES_TX 2 +#define UFS_SPACEMIT_K3_LIMIT_HSGEAR_RX UFS_HS_G3 +#define UFS_SPACEMIT_K3_LIMIT_HSGEAR_TX UFS_HS_G3 +#define UFS_SPACEMIT_K3_LIMIT_PWMGEAR_RX UFS_PWM_G4 +#define UFS_SPACEMIT_K3_LIMIT_PWMGEAR_TX UFS_PWM_G4 +#define UFS_SPACEMIT_K3_LIMIT_RX_PWR_PWM SLOW_MODE +#define UFS_SPACEMIT_K3_LIMIT_TX_PWR_PWM SLOW_MODE +#define UFS_SPACEMIT_K3_LIMIT_RX_PWR_HS FAST_MODE +#define UFS_SPACEMIT_K3_LIMIT_TX_PWR_HS FAST_MODE +#define UFS_SPACEMIT_K3_LIMIT_HS_RATE PA_HS_MODE_B +#define UFS_SPACEMIT_K3_LIMIT_DESIRED_MODE 2 + +#define UFS_PA_VS_CONFIG_REG1 0x9000 +#define UFS_DME_VS_CORE_CLK_CTRL 0xD002 + +#define UFS_HCLKDIV_REG 0xFC + +struct ufs_spacemit_host { + struct ufs_hba *hba; + struct ufs_pa_layer_attr dev_req_params; +}; + +struct ufshcd_dme_attr_val { + u32 attr_sel; + u32 mib_val; +}; +#endif /* _UFS_SPACEMIT_H_ */ --=20 2.55.0 From nobody Fri Oct 2 02:30:45 2026 Received: from smtp.kernel.org (aws-us-west-2-korg-mail-alma10-1.taild15c8.ts.net [100.103.45.18]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 9203B32B108; Thu, 6 Aug 2026 02:57:04 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=100.103.45.18 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785985026; cv=none; b=Dw2+FOE1MbBHSpg8Actf7QKLI6Vtvrj88tUqQ11w91430QMyVbdBD9n6tGm1aGhVFBi8x3ICxXJf6cYAKc8QvJSGfhFD01hL2tzFwowVnH2je6pFVIQHH5p4Um6nNN3vzq1vfs/BG+74xeoK5fRaKJHxjgNab/vHwHTxKw2oKdg= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785985026; c=relaxed/simple; bh=nykwdQ1lawCD1f20Ut4zh5W92JnzXk/8R4UaYQSg1nY=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=O3VkzBu6EyhWKDTvl2FNhFkfXvYiuHN/OHVeFASvXKesC0Nwz1J6fB8H7JARnT2XwdZ32oeJXY/NX/bsnzTd+7DooAwsMGRRKMRtdLjvhzsnwoexSLerN9/EIXuSanO45r4cFJgYpIdVJ5bDRJbLoadU/6mKUBSXDarqveHtfKc= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b=J1nq3RSl; arc=none smtp.client-ip=100.103.45.18 Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b="J1nq3RSl" Received: by smtp.kernel.org (Postfix) with ESMTPSA id 2F17C1F00A3A; Thu, 6 Aug 2026 02:56:58 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=kernel.org; s=k20260515; t=1785985024; bh=6SPLTG/S37Iver7+JwBm2lv7CYLiHOhuP0JvkwUs67g=; h=From:Date:Subject:References:In-Reply-To:To:Cc; b=J1nq3RSlYZ0Od/xggdNb+RJu/lCz+yHP/s8prjKqx21lu7ZUtPi9duBjgFYiUVesW eckWckziyXrla5fTr3D8YZxoJMB7hYa2o5DtlU6Y67S75OnSRO/TyQnGXhaKmX2gZI KoDxNULrOtM6+e4thG8Br+YHGDJXARuokwVzXTU2ZKCOzG1FWLTUErRkzZKhVPZz0M HgTvP3yqNGeqZx+K/KLXE3X0I3CZB1PwrpviJHTNtB/9I5pQV+kPXT6c2gqdQegucT WwjhQToYxl/jxxePbXo+bZFVVYBw9ck+sw8cRgRJV2xg+DPh5B2DI1UthSE6o83dXc jAPbH0eJxhiJA== From: Yixun Lan Date: Thu, 06 Aug 2026 02:56:20 +0000 Subject: [PATCH v3 3/3] riscv: dts: spacemit: k3: Add UFS support Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20260806-08-k3-ufs-support-v3-3-037fb322acdb@kernel.org> References: <20260806-08-k3-ufs-support-v3-0-037fb322acdb@kernel.org> In-Reply-To: <20260806-08-k3-ufs-support-v3-0-037fb322acdb@kernel.org> To: Alim Akhtar , Avri Altman , Bart Van Assche , Rob Herring , Krzysztof Kozlowski , Conor Dooley , "James E.J. Bottomley" , "Martin K. Petersen" , Philipp Zabel , Paul Walmsley , Palmer Dabbelt , Albert Ou , Alexandre Ghiti Cc: Anirudh Srinivasan , Aurelien Jarno , Jennifer Berringer , linux-scsi@vger.kernel.org, devicetree@vger.kernel.org, linux-riscv@lists.infradead.org, spacemit@lists.linux.dev, linux-kernel@vger.kernel.org, Yixun Lan X-Mailer: b4 0.15.2 X-Developer-Signature: v=1; a=openpgp-sha256; l=2242; i=dlan@kernel.org; h=from:subject:message-id; bh=nykwdQ1lawCD1f20Ut4zh5W92JnzXk/8R4UaYQSg1nY=; b=owEB6QIW/ZANAwAKATGq6kdZTbvtAcsmYgBqc/fndJ7/EeUC+XIA/eUWldubrWY86RP/a3Fel YWRpm92LwCJAq8EAAEKAJkWIQS1urjJwxtxFWcCI9wxqupHWU277QUCanP35xsUgAAAAAAEAA5t YW51MiwyLjUrMS4xMiwyLDJfFIAAAAAALgAoaXNzdWVyLWZwckBub3RhdGlvbnMub3BlbnBncC5 maWZ0aGhvcnNlbWFuLm5ldEI1QkFCOEM5QzMxQjcxMTU2NzAyMjNEQzMxQUFFQTQ3NTk0REJCRU QACgkQMarqR1lNu+0sjg/7BVVMRhGnGCTJ3fekrosx7d8WIatRibuXkAVtm+A5JOSlgmfeoifbv tG6RVNFJvcFPjqbPtXY+rkMraE+Tp+xdzm7wsO4T7LBwJvi+HIeqvzxiCZsynp1xmMWlJltIetA peWlxkaK/1B14+57ufCP9lEV6PNj5ByremvBdcoyZOWMoyLGWjP3DC8r5BYUqJCRcrtLRR+n+gs 787l97wRcxMPc9BaWRQB+6U4DriabY54YaG7Mn1QIjdseL1nMktNEjy42mOMFhXhoYLlRzXxeiM aZbXXH9qbhe/Yr9Co1DbmJ4c3i9C9l9R5WhiBcYbPbXGT+/9cotUK2vtk3bN4nVQc85xwGekgPZ FaV8U2cg7dp14X0sGi+cpa9ooXLLF4dUFQKAkw5nqpnjQCVgB5dzTA0+0cPgkpLdYdUjPxLlMjp BLwJzeg5pXMRTqy0BGu17r9RmdFgPRWrRONU7RqPOfCE6SmdGAmFbJNVKye0pIlZx0PLGbv7raz EHXs3hL3MIjVH6DLhab3kBkST2GV9V2cCEP6wCn1RvkKSc8T0oNNduEMQ7LiHKSDbqANUBa23R1 fueHp5Ga2Lk5HDcBjhlvJhCeZT1VoVuqRG3w/t1yqxtA2wPMwSDRhDCuZJxgzU/zFctJsnGOmq6 3z/qA+P3EePNhco6Xoa9LUb4XUA9FU= X-Developer-Key: i=dlan@kernel.org; a=openpgp; fpr=50B03A1A5CBCD33576EF8CD7920C0DBCAABEFD55 Add UFS Host Controller support for SpacemiT K3 SoC, and enable it both on Pico-ITX and CoM260-IFX boards. Signed-off-by: Yixun Lan Tested-by: Aurelien Jarno --- arch/riscv/boot/dts/spacemit/k3-com260.dtsi | 4 ++++ arch/riscv/boot/dts/spacemit/k3-pico-itx.dts | 4 ++++ arch/riscv/boot/dts/spacemit/k3.dtsi | 22 ++++++++++++++++++++++ 3 files changed, 30 insertions(+) diff --git a/arch/riscv/boot/dts/spacemit/k3-com260.dtsi b/arch/riscv/boot/= dts/spacemit/k3-com260.dtsi index a38d7b738258..a68a55c8e73d 100644 --- a/arch/riscv/boot/dts/spacemit/k3-com260.dtsi +++ b/arch/riscv/boot/dts/spacemit/k3-com260.dtsi @@ -188,3 +188,7 @@ &uart0 { pinctrl-0 =3D <&uart0_0_cfg>; status =3D "okay"; }; + +&ufshc { + status =3D "okay"; +}; diff --git a/arch/riscv/boot/dts/spacemit/k3-pico-itx.dts b/arch/riscv/boot= /dts/spacemit/k3-pico-itx.dts index b89c1521e664..eab8c430f2d1 100644 --- a/arch/riscv/boot/dts/spacemit/k3-pico-itx.dts +++ b/arch/riscv/boot/dts/spacemit/k3-pico-itx.dts @@ -206,6 +206,10 @@ &uart0 { status =3D "okay"; }; =20 +&ufshc { + status =3D "okay"; +}; + &usb2_host { #address-cells =3D <1>; #size-cells =3D <0>; diff --git a/arch/riscv/boot/dts/spacemit/k3.dtsi b/arch/riscv/boot/dts/spa= cemit/k3.dtsi index 19fc9b49668e..cee1569608ea 100644 --- a/arch/riscv/boot/dts/spacemit/k3.dtsi +++ b/arch/riscv/boot/dts/spacemit/k3.dtsi @@ -469,6 +469,28 @@ usb2_phy: phy@c0a20000 { status =3D "disabled"; }; =20 + ufshc: ufshc@c0e00000 { + compatible =3D "spacemit,k3-ufshc"; + reg =3D <0x0 0xc0e00000 0x0 0x40000>; + clocks =3D <&syscon_apmu CLK_APMU_UFS_ACLK>, + <&syscon_apmu CLK_APMU_UFS_REFCLK>; + clock-names =3D "aclk", "ref_clk"; + resets =3D <&syscon_apmu RESET_APMU_UFS_ACLK>; + interrupts =3D <135 IRQ_TYPE_LEVEL_HIGH>; + lanes-per-direction =3D <2>; + operating-points-v2 =3D <&ufs_opp_table>; + status =3D "disabled"; + + ufs_opp_table: opp-table { + compatible =3D "operating-points-v2"; + + opp-1 { + opp-hz =3D /bits/ 64 <491520000>, + /bits/ 64 <19200000>; + }; + }; + }; + eth0: ethernet@cac80000 { compatible =3D "spacemit,k3-dwmac", "snps,dwmac-5.40a"; reg =3D <0x0 0xcac80000 0x0 0x2000>; --=20 2.55.0