From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from phobos.denx.de (phobos.denx.de [85.214.62.61]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id EAB81C433F5 for ; Fri, 17 Dec 2021 15:21:54 +0000 (UTC) Received: from h2850616.stratoserver.net (localhost [IPv6:::1]) by phobos.denx.de (Postfix) with ESMTP id 6981583104; Fri, 17 Dec 2021 16:21:29 +0100 (CET) Authentication-Results: phobos.denx.de; dmarc=none (p=none dis=none) header.from=akkea.ca Authentication-Results: phobos.denx.de; spf=pass smtp.mailfrom=u-boot-bounces@lists.denx.de Authentication-Results: phobos.denx.de; dkim=pass (1024-bit key; unprotected) header.d=akkea.ca header.i=@akkea.ca header.b="l6qh/ksd"; dkim=pass (1024-bit key) header.d=akkea.ca header.i=@akkea.ca header.b="tGTbSnKn"; dkim-atps=neutral Received: by phobos.denx.de (Postfix, from userid 109) id D7BC48304C; Fri, 17 Dec 2021 16:21:17 +0100 (CET) Received: from node.akkea.ca (li1434-30.members.linode.com [45.33.107.30]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits)) (No client certificate requested) by phobos.denx.de (Postfix) with ESMTPS id ACC688309D for ; Fri, 17 Dec 2021 16:21:09 +0100 (CET) Authentication-Results: phobos.denx.de; dmarc=none (p=none dis=none) header.from=akkea.ca Authentication-Results: phobos.denx.de; spf=pass smtp.mailfrom=angus@akkea.ca Received: from localhost (localhost [127.0.0.1]) by node.akkea.ca (Postfix) with ESMTP id D73F04E200C; Fri, 17 Dec 2021 15:21:07 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=akkea.ca; s=mail; t=1639754467; bh=kafonc8NxJVPRN77vjNcruWnBmDAcBLE6TBnv4QZlIk=; h=From:To:Cc:Subject:Date:In-Reply-To:References; b=l6qh/ksd3F7kEtGyww7MaOmqlgCya8z6ncTSYVcpXA3AkJNcDjB6sXlHonGdMcF1A 8SUnUx40xXvyawhkU8zLZ0ZJxBYrZoxwfgt8/a+36e8y+17Qk3Qp18vATb+nf/rJwy 1LDNqFmHyQpVk2F8lV/IQqaiYzhS3CZ/ObG5YdWQ= Received: from node.akkea.ca ([127.0.0.1]) by localhost (mail.akkea.ca [127.0.0.1]) (amavisd-new, port 10024) with ESMTP id fJuxQMMUZ4QM; Fri, 17 Dec 2021 15:21:07 +0000 (UTC) Received: from midas.localdomain (S0106788a2041785e.gv.shawcable.net [24.108.106.191]) by node.akkea.ca (Postfix) with ESMTPSA id 3212D4E200E; Fri, 17 Dec 2021 15:21:04 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=akkea.ca; s=mail; t=1639754464; bh=kafonc8NxJVPRN77vjNcruWnBmDAcBLE6TBnv4QZlIk=; h=From:To:Cc:Subject:Date:In-Reply-To:References; b=tGTbSnKn22MbGfMJVKChz+7Eltw1oVpglOY3QeJvZsVnQ/lY330QdKZdZlN4ofM6g aAVkUITpWpKLeRRUQAl5XjMPw9ipPz67P3CZHg7RPYmWnPASO53zl7EcjBnCnkjRSw I17ttUihAyVL0JGuSj/KUHwSSoGVhE0qRID6s8gE= From: Angus Ainslie To: u-boot@lists.denx.de, "NXP i.MX U-Boot Team" Cc: Stefano Babic , Fabio Estevam , Peng Fan , Angus Ainslie , Marek Vasut , Ye Li , Alice Guo , Patrick Wildt , Simon Glass , Frieder Schrempf , =?UTF-8?q?Marek=20Beh=C3=BAn?= , "Ying-Chun Liu (PaulLiu)" , kernel@puri.sm Subject: [PATCH 3/3] arch: imx8m: Add USB power control Date: Fri, 17 Dec 2021 07:20:40 -0800 Message-Id: <20211217152040.324803-4-angus@akkea.ca> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20211217152040.324803-1-angus@akkea.ca> References: <20211217152040.324803-1-angus@akkea.ca> MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-BeenThere: u-boot@lists.denx.de X-Mailman-Version: 2.1.38 Precedence: list List-Id: U-Boot discussion List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Errors-To: u-boot-bounces@lists.denx.de Sender: "U-Boot" X-Virus-Scanned: clamav-milter 0.103.2 at phobos.denx.de X-Virus-Status: Clean Enable turning on USB power for SDP mode Signed-off-by: Angus Ainslie --- arch/arm/include/asm/arch-imx8m/sys_proto.h | 1 + arch/arm/mach-imx/imx8m/soc.c | 57 +++++++++++++++++++++ 2 files changed, 58 insertions(+) diff --git a/arch/arm/include/asm/arch-imx8m/sys_proto.h b/arch/arm/include/asm/arch-imx8m/sys_proto.h index d328542ece..98a958166a 100644 --- a/arch/arm/include/asm/arch-imx8m/sys_proto.h +++ b/arch/arm/include/asm/arch-imx8m/sys_proto.h @@ -14,4 +14,5 @@ void restore_boot_params(void); extern unsigned long rom_pointer[]; enum boot_device get_boot_device(void); bool is_usb_boot(void); +int imx8m_usb_power(int usb_id, bool on); #endif diff --git a/arch/arm/mach-imx/imx8m/soc.c b/arch/arm/mach-imx/imx8m/soc.c index 863508776d..a43075e1c6 100644 --- a/arch/arm/mach-imx/imx8m/soc.c +++ b/arch/arm/mach-imx/imx8m/soc.c @@ -1203,6 +1203,63 @@ int arch_misc_init(void) } #endif +#ifdef CONFIG_SPL_BUILD +static u32 gpc_pu_m_core_offset[11] = { + 0xc00, 0xc40, 0xc80, 0xcc0, + 0xdc0, 0xe00, 0xe40, 0xe80, + 0xec0, 0xf00, 0xf40, +}; + +#define PGC_PCR 0 + +void imx_gpc_set_m_core_pgc(unsigned int offset, bool pdn) +{ + u32 val; + uintptr_t reg = GPC_BASE_ADDR + offset; + + val = readl(reg); + val &= ~(0x1 << PGC_PCR); + + if (pdn) + val |= 0x1 << PGC_PCR; + writel(val, reg); +} + +void imx8m_usb_power_domain(u32 domain_id, bool on) +{ + u32 val; + uintptr_t reg; + + imx_gpc_set_m_core_pgc(gpc_pu_m_core_offset[domain_id], true); + + reg = GPC_BASE_ADDR + (on ? 0xf8 : 0x104); + val = 1 << (domain_id > 3 ? (domain_id + 3) : domain_id); + writel(val, reg); + while (readl(reg) & val) + ; + imx_gpc_set_m_core_pgc(gpc_pu_m_core_offset[domain_id], false); +} +#endif + +int imx8m_usb_power(int usb_id, bool on) +{ + struct arm_smccc_res res; + + if (usb_id > 1) + return -EINVAL; + +#ifdef CONFIG_SPL_BUILD + imx8m_usb_power_domain(2 + usb_id, on); +#else + arm_smccc_smc(IMX_SIP_GPC, IMX_SIP_GPC_PM_DOMAIN, + 2 + usb_id, on, 0, 0, 0, 0, &res); + if (res.a0) + return -EPERM; +#endif + + return 0; +} + void imx_tmu_arch_init(void *reg_base) { if (is_imx8mm() || is_imx8mn()) { -- 2.25.1