From patchwork Wed Sep 26 13:52:48 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Peng Fan X-Patchwork-Id: 975150 X-Patchwork-Delegate: sbabic@denx.de Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=lists.denx.de (client-ip=81.169.180.215; helo=lists.denx.de; envelope-from=u-boot-bounces@lists.denx.de; receiver=) Authentication-Results: ozlabs.org; dmarc=fail (p=none dis=none) header.from=nxp.com Authentication-Results: ozlabs.org; dkim=fail reason="signature verification failed" (1024-bit key; unprotected) header.d=nxp.com header.i=@nxp.com header.b="RgTegpK5"; dkim-atps=neutral Received: from lists.denx.de (dione.denx.de [81.169.180.215]) by ozlabs.org (Postfix) with ESMTP id 42L05j68Xdz9s4s for ; Thu, 27 Sep 2018 00:03:21 +1000 (AEST) Received: by lists.denx.de (Postfix, from userid 105) id 14C70C21E13; Wed, 26 Sep 2018 14:00:55 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on lists.denx.de X-Spam-Level: X-Spam-Status: No, score=0.0 required=5.0 tests=BAD_ENC_HEADER, SPF_HELO_PASS, T_DKIM_INVALID autolearn=unavailable autolearn_force=no version=3.4.0 Received: from lists.denx.de (localhost [IPv6:::1]) by lists.denx.de (Postfix) with ESMTP id A4A16C21F5B; Wed, 26 Sep 2018 13:48:45 +0000 (UTC) Received: by lists.denx.de (Postfix, from userid 105) id 7445EC21EF7; Wed, 26 Sep 2018 13:48:43 +0000 (UTC) Received: from EUR02-VE1-obe.outbound.protection.outlook.com (mail-eopbgr20073.outbound.protection.outlook.com [40.107.2.73]) by lists.denx.de (Postfix) with ESMTPS id 6C78CC21EF7 for ; Wed, 26 Sep 2018 13:48:22 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=nxp.com; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=hMShvolsWJ5hF02qPM7Rl2afC6+cCTBpIKkh5By8kgM=; b=RgTegpK5NMWNZtrlA1wNHAOs4oOUMoJoNUK40GA1Hmxg8VuP4f7ldpbm7Fhqi2t9fl3dbg0FRs5DWUqJWdKCh6f2XwTh/BarW7URZBMf/A0+bmF0MgDvrvKSxLX3PGQwUwYSwOGRUJ4hYn19mAW9KdbL1cRAlJzF2GibQZ+H6wU= Received: from linux-u7w5.ap.freescale.net.net (92.121.68.129) by AM0PR04MB4482.eurprd04.prod.outlook.com (2603:10a6:208:73::16) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.1164.22; Wed, 26 Sep 2018 13:48:19 +0000 From: Peng Fan To: sbabic@denx.de, agust@denx.de Date: Wed, 26 Sep 2018 21:52:48 +0800 Message-Id: <20180926135256.2098-25-peng.fan@nxp.com> X-Mailer: git-send-email 2.14.1 In-Reply-To: <20180926135256.2098-1-peng.fan@nxp.com> References: <20180926135256.2098-1-peng.fan@nxp.com> MIME-Version: 1.0 X-Originating-IP: [92.121.68.129] X-ClientProxiedBy: HK0PR01CA0053.apcprd01.prod.exchangelabs.com (2603:1096:203:a6::17) To AM0PR04MB4482.eurprd04.prod.outlook.com (2603:10a6:208:73::16) X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-Correlation-Id: 817500cd-1d55-453c-56c3-08d623b6b8fc X-MS-Office365-Filtering-HT: Tenant X-Microsoft-Antispam: BCL:0; PCL:0; RULEID:(7020095)(4652040)(8989299)(4534165)(4627221)(201703031133081)(201702281549075)(8990200)(5600074)(711020)(4618075)(2017052603328)(7153060)(7193020); SRVR:AM0PR04MB4482; X-Microsoft-Exchange-Diagnostics: 1; AM0PR04MB4482; 3:qzi2jmkdVkbTipa3UGt98A00PpRbLXZHqHpMCKwYF5OM1cokwvHP8SG1awQLBwMJewR5AOUEOyG3X5sqvIFu3UFRxZ5gCK7LQTcr3ZJZnyLddNkzCHOIy0wXMkxmNeYdesTweJUgumt6YvzqNYS51ClNCKxoupVeMFEqwDlP3SF4OAUraT51ko6Uonz6LHIKupwa8Omr+OjXcEeKdibf+BCJuvu2TUMXlbckgS+H1pCHmE8h6USKmeRBl1NIMVdS; 25:k8MWGvfiAI2J027ebAWQNhliBaxbZliV/hNU0yHvzX6f37xS9chhAWIRLePff75pM2wpzn9378tHJhE1JtMx+CzQdJleta7hvK40NJR1OM/StNm+sWVpkbLnweTlnWzvsRPbOPVRAACiYRt8HI5V93w9gFrc6xLYRMWBUe5ZMvgFlf2buATLEvS4e5drUSjRaj4qhlkgGsNMZ5BDBZ3XSVGodgDNKzJNiltd/eXpC3nzonGqrgzhwibRGnvPaRQHKd7W1CHDgzOlxSN8iuC31lfr5binyWS+mztBG4gSRvPRWZPlvFpOhRXG6nooLuaTYvkbULS8/X6Z1Td7CL5ghA==; 31:ZS4b7myDgPniew1uhV2D2YrKQUsZM/3+n4cipdxnVxAKxjOfX5mqZgvE2RaekJRBr3VefCQCoijVDrDJVL6gzjpefb0bbUFaisVdmZA4OliDhNZDB9OcGJxX5IhgAfCxE8jAQnFQdlyILtSCI3IbR7UCJKxB9Ml4mId0+H6mR30HXuWLPZ1kU8XSzw5zpTNVUFi2WViIhhOwEMwGQNDMSSzZBTwJfqVTuLa7H4pi2ZY= X-MS-TrafficTypeDiagnostic: AM0PR04MB4482: X-Microsoft-Exchange-Diagnostics: 1; AM0PR04MB4482; 20:anuXC3/jFuJjFLsRPTzMSWzXvYrXhBMv5UM5WugU+VvyVmiueSIu29RLyQRUhPoJMJXbVEuoxAE7gwlZey9UTlPSkd9oHg/mlJK/Dtt1o3eovSR5qR34bT4C6unMKOYt9EPcgemTjEUUKjUcP3yMTH9sY/b9LATi4EclNKzOcIxF1hfHTAV4FnIcYXgHckhHO+tV16yiaZaBpVSQvE6rPK1CcbRgMDGAm7QwpzJDGLn2j0y4MUNwPvLSNk3x/uiaW8iqVIQyNr9CENQhn8PIj4/xL6CkMkl5XynE0Rf/zmN+tPvKU3F+aFub3Kufe7gTfh788EyR3L8TjgYPEtBXFth/OynJvava8EkaYdGQriAvtjIWVS5GMmv307qX6DKJ/ocFTnOoXDZVNhxURoTyLtkCA5j6pOQDqbKSsetO0ZayxvHE8krVHJV+MvihVc1geRhPHkYNaHdvqpwLVGGHKf/eyttACy/Ybs2Lrt0uc4k0AAcDfhoBhfNEIZNcwkCP; 4:kMwWfYkcG/3PpYCw+W3yLkPMxjnwo+YzHMcYapNd8MFHK23L9/5k5M2xyuBvMizKBlWZyG7IqerKUiz2GJOr7Bg446KOcDEJxzFEGOboalNcNRh0Kws2xtuTWsr3fAUBjRl4UXwqXJ4Pa8L4BNGrd4Kd2rOgbUOBGY2ZE5RbDP2BhIi/3/dN/TzMF3LDVuJg/ubA04NTYUJhw8LpU+NtSwXM9Ih2d2aJNTLL2bfNGI5DbgmFvAwJ0zdZ2VDJophVH1unhQI9bc6ndN0WY/8mDyHMmkKLmmr3mbkS2diISp1WwZHYVHbwhU2ZCDZzG3viy7xBf1UJTsImUmMf1aPJeB4AbBq42hh3l1bcfSSzSgw= X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-Test: UriScan:(269456686620040)(185117386973197); X-MS-Exchange-SenderADCheck: 1 X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0; RULEID:(8211001083)(6040522)(2401047)(5005006)(8121501046)(10201501046)(3002001)(93006095)(93001095)(3231355)(944501410)(52105095)(6055026)(149066)(150057)(6041310)(20161123558120)(20161123562045)(20161123564045)(20161123560045)(201703131423095)(201702281528075)(20161123555045)(201703061421075)(201703061406153)(201708071742011)(7699051)(76991041); SRVR:AM0PR04MB4482; BCL:0; PCL:0; RULEID:; SRVR:AM0PR04MB4482; X-Forefront-PRVS: 08076ABC99 X-Forefront-Antispam-Report: SFV:NSPM; SFS:(10009020)(136003)(39860400002)(366004)(376002)(346002)(396003)(189003)(199004)(16586007)(34290500001)(3846002)(6116002)(76176011)(51416003)(52116002)(305945005)(7736002)(36756003)(47776003)(66066001)(6486002)(105586002)(53936002)(1076002)(386003)(6506007)(6512007)(106356001)(86362001)(50226002)(186003)(97736004)(478600001)(16526019)(48376002)(486006)(476003)(50466002)(2616005)(14444005)(446003)(11346002)(8676002)(8936002)(81166006)(44832011)(81156014)(4326008)(2906002)(25786009)(6666003)(5660300001)(6346003)(26005)(68736007)(316002)(956004); DIR:OUT; SFP:1101; SCL:1; SRVR:AM0PR04MB4482; H:linux-u7w5.ap.freescale.net.net; FPR:; SPF:None; LANG:en; PTR:InfoNoRecords; MX:1; A:1; Received-SPF: None (protection.outlook.com: nxp.com does not designate permitted sender hosts) Authentication-Results: spf=none (sender IP is ) smtp.mailfrom=peng.fan@nxp.com; X-Microsoft-Exchange-Diagnostics: =?us-ascii?Q?1; AM0PR04MB4482; 23:He+gb8S42MrmmU63zx7MberFdRRPaOrbc+L+Oj8ec?= 5Rn3GjsHPg+5dAMjr/Bf4+P7tQqaZrD1oBMDEjSIkrR+DDXnXTHt58n7AHoFZhpxHCyarNN3+BArot30XLA08EU/OQolGzacxIHWqf3OZXIYwlvpLuSnP2wOiqn7WbDj3bV39vC+Gzj6yi7EvFGK/H71x1rgNGebLejCdwz5CP5Uprz9q0NfsFRkTiojWFLNgfOONT+6nO78vmjKONDebKyYzcDhlOLnTMujtJEfPT8MbCVB5lMb7cGHnDMlh1mvjgxY9xDhFiPcVffyri/MYQoTrd6fSEYD1znN3mTekGQpU6C/lpbkEfFC1oXMn3wodMwgFcQNr1MHmm1Bg2kFmB7e7WyRs+LTCv23ucarkEcYffQvY/mACZaEc2kMB28lInqJp65avww37OvwdCV/W6Nr/DvduoTB2oPlaNjlns/faxmaUspiWe/5N6it1tDvQDfuljtIFW3GO0YuIvNQOjcVeBKMR5lVQt1WCh62dlbRGL/jYO245YWAUMw4fQVDQzZhyUXLIEnIByrxSOyL7n8+cKpzjB1DWx9AizK2d8crfVNmw/BMBD+4PjWjB88WyYIbeYqafdKnz+g4DdTFp3YmVao8lL6PdXNfQ4qsBZh1fL1TUeCU2pRlfiMtZzIN/vOVH/J1hiuSVkECPfnJODnM69ewhrGgaVpMFse7Ddvzi3xiK7FGp29SHSq5Z6YKEFFpiVBppwZIIU07ciVZwAeORrG9TwxSwrs2Mx0HpV84bgWWRQShpDKAjWjLNiLTaQ1A50P8S4ZZAkufbAyYpntrrWx/78DnYReR95anFQ7QuJzLgv3ba7em+xQjurGiHQR4SBOJocvQaxGby3FTSVSsTQyUYZhRQXrZ6/rix8kWuMbKgk2ssod6woSGYmlZE3CRoJN5O8aVQmoNZf9WouxGaTXmanrvZWbKL1b38Abf517Xc9IfK+W84HqmqFoj2txYzMmY6h/IFhbaA8oQSYJUuE3It3lo9RaJ8NpJwGBhBH0E+5Fpv86MMdMPL0AM3LENvmi2p55gmRdQqckvMU0WwpWudOzuOCbHfXsvtcZ98uDOGIuSe8p12Oyb4DTaEdcpn/kAkUhS/D23sN3+Rb7VJYxey1eTg/LEEBYnrzfmaOxbwESHhLcA7VGEVqqBFo2U0rNLG4iQifLeu60XKDBFDnDe2bMFuSqKaiYgyRTJAX4DRj3mCD8CpNfv1ZUkwc= X-Microsoft-Antispam-Message-Info: TlyhQRsXvb0sqs9PQbemv3HjtPSNtACMzqeTwn3IYO7oJadU+4DpH7KkJ/QC/ODnJSjbHoUYxVpuRQQm1YueXZ8AXvSDran/Fw6f3T9OvLeTo1WXHn650MHqoLPG8GmqqrUcAPTrMEuFZ2h3IoMkSfvAXoDjNkUYJqsDEddaJUqa5rDOxTFc1RVEN7B+xNRISmIQzPF/+VSvqrdKYIym0sOpMKVs4mGzUIXl80EMY7R1Owkl8ZpLJZEi2xQjT1B+jWwfZBGeZBHhbvpROd67KIqQ6LU6smvd91nrVeZolku+CLpM5op4MtCJqwF0BpVAoH/mNSbTR9SQUx//YC6iQbfoAxCgBzzjsc9N1BcfMbQ= X-Microsoft-Exchange-Diagnostics: 1; AM0PR04MB4482; 6:Zx6wRQ3w6n4mLW2bSWZXn6lW/6YjnQaCEJTsQuxM3rCgPwse/2JXAMC8UuqKBgDIma/2w2EemXWngFQCaaHejUKa3VuD0rw5rxQZrny2a6beo0//P54jugSHf5rndBOMb59/K9UR1V37+YQIkbDMGuc6GfrXnIiGXp9/t3NWeYub90T5qQdeS0h8VmSXmAykg4wBEquXjZvCXQpF6EoDU5Hs2RqD2kEuA5FxBZ5BE9mC0uy3PnTkKx3agJj/TGdOFwBMMGPADd6Z5MWYHm+qNx1ybSrdCLwCoL4k9v1NprXhFS+jbGrMHLkzSEDLdjb71+1qpqGlf0RJv4t35xy9wpOVoOcZgNYificqcDbJ+60Gz+ocaTXPZ/8gTijx0nt1BmsaIFVWB9+RS4n6gxtFHYBjsgqlHF62IOi664j2MzsszKAzd6rRmX5w9BHkz4dcdA86irEFWV2kR7/gh4GRnA==; 5:JOGpbTqCv5fLyCCokjtKIc73FA+VDTptea6gT7YCWTuXvvORD6XkXRWXlWD1EfmzBf04t+1JMpSeagJdi82wLsu0vqXyz/FKOTuixQD2w8qoIsNxgrAT5I2KobyCjnR3QA/bSieFbeBM4pSCdwsddoSJsnSsXEI5Ys+JS36IWl0=; 7:dLYXzPPSizoooS5avfaeQ6xYoBXaKL6E3vSvGnkz8JbMcgvMCl3rY0j8NNY8oCnHiamAd8dADAkJ7osltxcK5mq32zLTumCtK+cGO9V4npi1VjkgOiJJD7YbYV3aC9FHKV4TcyGvhgJOdHV+ZCcdShJKaTE1tT1UWKXzQqPe1ou7sdb9+QZKBc77a/tEU26E4LRFa3zwXgNH+bziKRAa2T16fFzy8MECNVm+vcuBk0pvJBwi00uG31PZgmZ+9+dz SpamDiagnosticOutput: 1:99 SpamDiagnosticMetadata: NSPM X-OriginatorOrg: nxp.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 26 Sep 2018 13:48:19.2506 (UTC) X-MS-Exchange-CrossTenant-Network-Message-Id: 817500cd-1d55-453c-56c3-08d623b6b8fc X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635 X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM0PR04MB4482 Cc: u-boot@lists.denx.de Subject: [U-Boot] [PATCH V5 24/32] power: Add power domain driver for i.MX8 X-BeenThere: u-boot@lists.denx.de X-Mailman-Version: 2.1.18 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" Add the power domain DM driver for i.MX8, that it depends on the DTB power domain trees to generate the power domain provider devices. Users needs add power domain trees with property "compatible = "nxp,imx8-pd";" When power on one PD device, the driver will power on its ancestor PD devices in power domain tree. When power off on PD device, the driver will check its child PD devices first, only all child PD devices are off, then power off the current PD device. Then the driver checks sibling PD devices. If sibling PD devices are off, then it will power off parent PD device. There is no counter maintained in this driver, but a state to hold current on/off state. So the request and free functions are empty. The power domain implementation in i.MX8 DTB set the "#power-domain-cells" to 0, so there is no ID binding with each PD device. We don't use "id" variable in struct power_domain. At same time, we have to set of_xlate to empty to bypass standard of_xlate in uclass driver. Signed-off-by: Peng Fan Cc: Stefano Babic --- arch/arm/include/asm/arch-imx8/power-domain.h | 15 ++ drivers/power/domain/Kconfig | 8 +- drivers/power/domain/Makefile | 1 + drivers/power/domain/imx8-power-domain.c | 315 ++++++++++++++++++++++++++ 4 files changed, 338 insertions(+), 1 deletion(-) create mode 100644 arch/arm/include/asm/arch-imx8/power-domain.h create mode 100644 drivers/power/domain/imx8-power-domain.c diff --git a/arch/arm/include/asm/arch-imx8/power-domain.h b/arch/arm/include/asm/arch-imx8/power-domain.h new file mode 100644 index 0000000000..1396008877 --- /dev/null +++ b/arch/arm/include/asm/arch-imx8/power-domain.h @@ -0,0 +1,15 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright 2017 NXP + */ + +#ifndef _ASM_ARCH_IMX8_POWER_DOMAIN_H +#define _ASM_ARCH_IMX8_POWER_DOMAIN_H + +#include + +struct imx8_power_domain_platdata { + sc_rsrc_t resource_id; +}; + +#endif diff --git a/drivers/power/domain/Kconfig b/drivers/power/domain/Kconfig index 2c344888ca..a08b4288b4 100644 --- a/drivers/power/domain/Kconfig +++ b/drivers/power/domain/Kconfig @@ -16,6 +16,13 @@ config BCM6328_POWER_DOMAIN Enable support for manipulating BCM6345 power domains via MMIO mapped registers. +config IMX8_POWER_DOMAIN + bool "Enable i.MX8 power domain driver" + depends on ARCH_IMX8 + help + Enable support for manipulating NXP i.MX8 on-SoC power domains via IPC + requests to the SCU. + config MESON_GX_VPU_POWER_DOMAIN bool "Enable Amlogic Meson GX VPU power domain driver" depends on ARCH_MESON @@ -44,5 +51,4 @@ config TI_SCI_POWER_DOMAIN help Generic power domain implementation for TI devices implementing the TI SCI protocol. - endmenu diff --git a/drivers/power/domain/Makefile b/drivers/power/domain/Makefile index 6bdaa175e9..23fb1ecede 100644 --- a/drivers/power/domain/Makefile +++ b/drivers/power/domain/Makefile @@ -4,6 +4,7 @@ obj-$(CONFIG_$(SPL_)POWER_DOMAIN) += power-domain-uclass.o obj-$(CONFIG_BCM6328_POWER_DOMAIN) += bcm6328-power-domain.o +obj-$(CONFIG_IMX8_POWER_DOMAIN) += imx8-power-domain.o obj-$(CONFIG_MESON_GX_VPU_POWER_DOMAIN) += meson-gx-pwrc-vpu.o obj-$(CONFIG_SANDBOX_POWER_DOMAIN) += sandbox-power-domain.o obj-$(CONFIG_SANDBOX_POWER_DOMAIN) += sandbox-power-domain-test.o diff --git a/drivers/power/domain/imx8-power-domain.c b/drivers/power/domain/imx8-power-domain.c new file mode 100644 index 0000000000..d51dbaa6c0 --- /dev/null +++ b/drivers/power/domain/imx8-power-domain.c @@ -0,0 +1,315 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright 2017 NXP + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +DECLARE_GLOBAL_DATA_PTR; + +struct imx8_power_domain_priv { + bool state_on; +}; + +static int imx8_power_domain_request(struct power_domain *power_domain) +{ + debug("%s(power_domain=%p)\n", __func__, power_domain); + + return 0; +} + +static int imx8_power_domain_free(struct power_domain *power_domain) +{ + debug("%s(power_domain=%p)\n", __func__, power_domain); + + return 0; +} + +static int imx8_power_domain_on(struct power_domain *power_domain) +{ + struct udevice *dev = power_domain->dev; + struct imx8_power_domain_platdata *pdata; + struct imx8_power_domain_priv *ppriv; + sc_err_t ret; + int err; + + struct power_domain parent_domain; + struct udevice *parent = dev_get_parent(dev); + + /* Need to power on parent node first */ + if (device_get_uclass_id(parent) == UCLASS_POWER_DOMAIN) { + parent_domain.dev = parent; + err = imx8_power_domain_on(&parent_domain); + if (err) + return err; + } + + pdata = (struct imx8_power_domain_platdata *)dev_get_platdata(dev); + ppriv = (struct imx8_power_domain_priv *)dev_get_priv(dev); + + debug("%s(power_domain=%s) resource_id %d\n", __func__, dev->name, + pdata->resource_id); + + /* Already powered on */ + if (ppriv->state_on) + return 0; + + if (pdata->resource_id != SC_R_LAST) { + ret = sc_pm_set_resource_power_mode(-1, pdata->resource_id, + SC_PM_PW_MODE_ON); + if (ret) { + printf("Error: %s Power up failed! (error = %d)\n", + dev->name, ret); + return -EIO; + } + } + + ppriv->state_on = true; + debug("%s is powered on\n", dev->name); + + return 0; +} + +static int imx8_power_domain_off_node(struct power_domain *power_domain) +{ + struct udevice *dev = power_domain->dev; + struct udevice *child; + struct imx8_power_domain_priv *ppriv; + struct imx8_power_domain_priv *child_ppriv; + struct imx8_power_domain_platdata *pdata; + sc_err_t ret; + + ppriv = dev_get_priv(dev); + pdata = dev_get_platdata(dev); + + debug("%s, %s, state_on %d\n", __func__, dev->name, ppriv->state_on); + + /* Already powered off */ + if (!ppriv->state_on) + return 0; + + /* Check if all subnodes are off */ + for (device_find_first_child(dev, &child); + child; + device_find_next_child(&child)) { + if (device_active(child)) { + child_ppriv = + (struct imx8_power_domain_priv *)dev_get_priv(child); + if (child_ppriv->state_on) + return -EPERM; + } + } + + if (pdata->resource_id != SC_R_LAST) { + if (!sc_rm_is_resource_owned(-1, pdata->resource_id)) { + printf("%s not owned by curr partition\n", dev->name); + return 0; + } + ret = sc_pm_set_resource_power_mode(-1, pdata->resource_id, + SC_PM_PW_MODE_OFF); + if (ret) { + printf("Error: %s Power off failed! (error = %d)\n", + dev->name, ret); + return -EIO; + } + } + + ppriv->state_on = false; + debug("%s is powered off\n", dev->name); + + return 0; +} + +static int imx8_power_domain_off_parentnodes(struct power_domain *power_domain) +{ + struct udevice *dev = power_domain->dev; + struct udevice *parent = dev_get_parent(dev); + struct udevice *child; + struct imx8_power_domain_priv *ppriv; + struct imx8_power_domain_priv *child_ppriv; + struct imx8_power_domain_platdata *pdata; + sc_err_t ret; + struct power_domain parent_pd; + + if (device_get_uclass_id(parent) == UCLASS_POWER_DOMAIN) { + pdata = + (struct imx8_power_domain_platdata *)dev_get_platdata(parent); + ppriv = (struct imx8_power_domain_priv *)dev_get_priv(parent); + + debug("%s, %s, state_on %d\n", __func__, parent->name, + ppriv->state_on); + + /* Already powered off */ + if (!ppriv->state_on) + return 0; + + /* + * Check if all sibling nodes are off. If yes, + * power off parent + */ + for (device_find_first_child(parent, &child); child; + device_find_next_child(&child)) { + if (device_active(child)) { + child_ppriv = (struct imx8_power_domain_priv *) + dev_get_priv(child); + /* Find a power on sibling */ + if (child_ppriv->state_on) { + debug("sibling %s, state_on %d\n", + child->name, + child_ppriv->state_on); + return 0; + } + } + } + + /* power off parent */ + if (pdata->resource_id != SC_R_LAST) { + ret = sc_pm_set_resource_power_mode(-1, + pdata->resource_id, + SC_PM_PW_MODE_OFF); + if (ret) { + printf("%s Power off failed! (error = %d)\n", + parent->name, ret); + return -EIO; + } + } + + ppriv->state_on = false; + debug("%s is powered off\n", parent->name); + + parent_pd.dev = parent; + imx8_power_domain_off_parentnodes(&parent_pd); + } + + return 0; +} + +static int imx8_power_domain_off(struct power_domain *power_domain) +{ + int ret; + + debug("%s(power_domain=%p)\n", __func__, power_domain); + + /* Turn off the node */ + ret = imx8_power_domain_off_node(power_domain); + if (ret) { + debug("Can't power off the node of dev %s, ret = %d\n", + power_domain->dev->name, ret); + return ret; + } + + /* Turn off parent nodes, if sibling nodes are all off */ + ret = imx8_power_domain_off_parentnodes(power_domain); + if (ret) { + printf("Failed to power off parent nodes of dev %s, ret = %d\n", + power_domain->dev->name, ret); + return ret; + } + + return 0; +} + +static int imx8_power_domain_of_xlate(struct power_domain *power_domain, + struct ofnode_phandle_args *args) +{ + debug("%s(power_domain=%p)\n", __func__, power_domain); + + /* Do nothing to the xlate, since we don't have args used */ + + return 0; +} + +static int imx8_power_domain_bind(struct udevice *dev) +{ + int offset; + const char *name; + int ret = 0; + + debug("%s(dev=%p)\n", __func__, dev); + + offset = dev_of_offset(dev); + for (offset = fdt_first_subnode(gd->fdt_blob, offset); offset > 0; + offset = fdt_next_subnode(gd->fdt_blob, offset)) { + /* Bind the subnode to this driver */ + name = fdt_get_name(gd->fdt_blob, offset, NULL); + + ret = device_bind_with_driver_data(dev, dev->driver, name, + dev->driver_data, + offset_to_ofnode(offset), + NULL); + + if (ret == -ENODEV) + printf("Driver '%s' refuses to bind\n", + dev->driver->name); + + if (ret) + printf("Error binding driver '%s': %d\n", + dev->driver->name, ret); + } + + return 0; +} + +static int imx8_power_domain_probe(struct udevice *dev) +{ + struct imx8_power_domain_priv *ppriv; + + debug("%s(dev=%s)\n", __func__, dev->name); + + ppriv = (struct imx8_power_domain_priv *)dev_get_priv(dev); + + /* Set default to power off */ + if (ppriv) + ppriv->state_on = false; + + return 0; +} + +static int imx8_power_domain_ofdata_to_platdata(struct udevice *dev) +{ + int reg; + struct imx8_power_domain_platdata *pdata = dev_get_platdata(dev); + + reg = fdtdec_get_int(gd->fdt_blob, dev_of_offset(dev), "reg", -1); + if (reg == -1) { + debug("%s: Invalid resource id %d\n", __func__, reg); + return -EINVAL; + } + pdata->resource_id = (sc_rsrc_t)reg; + + debug("%s resource_id %d\n", __func__, pdata->resource_id); + + return 0; +} + +static const struct udevice_id imx8_power_domain_ids[] = { + { .compatible = "nxp,imx8-pd" }, + { } +}; + +struct power_domain_ops imx8_power_domain_ops = { + .request = imx8_power_domain_request, + .free = imx8_power_domain_free, + .on = imx8_power_domain_on, + .off = imx8_power_domain_off, + .of_xlate = imx8_power_domain_of_xlate, +}; + +U_BOOT_DRIVER(imx8_power_domain) = { + .name = "imx8_power_domain", + .id = UCLASS_POWER_DOMAIN, + .of_match = imx8_power_domain_ids, + .bind = imx8_power_domain_bind, + .probe = imx8_power_domain_probe, + .ofdata_to_platdata = imx8_power_domain_ofdata_to_platdata, + .platdata_auto_alloc_size = sizeof(struct imx8_power_domain_platdata), + .priv_auto_alloc_size = sizeof(struct imx8_power_domain_priv), + .ops = &imx8_power_domain_ops, +};