From patchwork Fri Feb 10 10:03:36 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Neil Armstrong X-Patchwork-Id: 652622 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 vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 6B887C636CD for ; Fri, 10 Feb 2023 10:03:49 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231500AbjBJKDs (ORCPT ); Fri, 10 Feb 2023 05:03:48 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:54986 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231584AbjBJKDo (ORCPT ); Fri, 10 Feb 2023 05:03:44 -0500 Received: from mail-wm1-x335.google.com (mail-wm1-x335.google.com [IPv6:2a00:1450:4864:20::335]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 00E595B97 for ; Fri, 10 Feb 2023 02:03:38 -0800 (PST) Received: by mail-wm1-x335.google.com with SMTP id n28-20020a05600c3b9c00b003ddca7a2bcbso3639027wms.3 for ; Fri, 10 Feb 2023 02:03:38 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=cc:to:message-id:content-transfer-encoding:mime-version:subject :date:from:from:to:cc:subject:date:message-id:reply-to; bh=CcTE7Ppu1Qxne0SZcZTjlUbPtfCn/g9rR5zUNgG16g4=; b=Hc3fknhUMbVneTKjraZ+g46rUWDHI2lvZjGbZEh1Hy/0LdbNA4LdXr2hZOyoUuzt/9 pCY0JpINBJSJL3yiFSEAgmXsJQzOvHF2fFH5PzH5eQ+vUcO0PGw4Y74cJoH9yf6b5YX4 6+fP/lUyVKHiLJG3WPf51SBswP+4PsIuV2yteBY0q5ec551+EMvFYEGfew5CzMnaDuo5 goxl6WXFpgFOIRv1nacrouhtCo10fEjk5/pEJ9+lCGqVbk229X/I+lCYf6qi1vFq2Uwt SYLn8Ye2h8Ux6z9s20QgHhsPdr37s4Vakrc0ZzLPU1Ci7ZS4oI3VRZ2Ouw0s//YW25Rs 7Egg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=cc:to:message-id:content-transfer-encoding:mime-version:subject :date:from:x-gm-message-state:from:to:cc:subject:date:message-id :reply-to; bh=CcTE7Ppu1Qxne0SZcZTjlUbPtfCn/g9rR5zUNgG16g4=; b=N1es5rJH63GiIJosrEQtT++z3xsWyHXsO5QYqoc9/6VoFn40eFrVeK7WuxFWZmNHHD KAlhllfYF3JRRom+85f8lf/M/7sBhlQ7okwDgPQGIyfZ9L+R8j0wuMZHO7QwOoXcSca5 zf6DtmMnnOdjZh4p2jTz5P2W3nX9p0gIUmxbQJiv4WKn00KfvR+GRK02lRY8EFvz8oz4 3YajqRkF3ddk4v3/azyFx7krhUcGk8wicmhGKHKV+JekSxTHcU7yowU1IlglYrvL9QRR KqaxMfnHRnFKkOU5CsSxWN3UfbQFYjlPjhzB3SPRh13KeIo9cnQ3irngNah0h+enKPgY AU8w== X-Gm-Message-State: AO0yUKWW70hC/Bvdh+/8GQ6U1CitJ2iVnbIW+WtT9h5TgYZRGk8UF9+h Uw2CG+ArbhFQJzgw7u7Mazlcrw== X-Google-Smtp-Source: AK7set8lWTrd03g7f1A8KR3a/AUZcvS8psu+cSQ8ebQhVwLFR1GsKjEPXxYA+ltMpyypbIk+QedBRQ== X-Received: by 2002:a05:600c:4d21:b0:3dc:3398:cf87 with SMTP id u33-20020a05600c4d2100b003dc3398cf87mr12411181wmp.11.1676023417579; Fri, 10 Feb 2023 02:03:37 -0800 (PST) Received: from arrakeen.starnux.net ([2a01:e0a:982:cbb0:8261:5fff:fe11:bdda]) by smtp.gmail.com with ESMTPSA id c63-20020a1c3542000000b003df14531724sm7959820wma.21.2023.02.10.02.03.36 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Fri, 10 Feb 2023 02:03:37 -0800 (PST) From: Neil Armstrong Date: Fri, 10 Feb 2023 11:03:36 +0100 Subject: [PATCH v3] power: reset: add Odroid Go Ultra poweroff driver MIME-Version: 1.0 Message-Id: <20230126-b4-odroid-go-ultra-poweroff-v3-1-0a7fd3d5c4b3@linaro.org> X-B4-Tracking: v=1; b=H4sIAHcW5mMC/42OTQ6CMBBGr0K6dgy2SNCV9zAs+jOFJk2HTAE1h LtbOYHL9xbf+zaRkQNmca82wbiGHCgVUKdK2FGnASG4wkLWUtUX2YJpgBxTcDAQLHFmDRO9kMl 7sJ13Vt+UV2hEWTA6IxjWyY5lIy0xFjkx+vA+ks++8BjyTPw5HqzyZ/+LrRIuoDt7rbu29Y22j xiSZjoTD6Lf9/0LZsbnltwAAAA= To: Sebastian Reichel Cc: linux-kernel@vger.kernel.org, linux-pm@vger.kernel.org, linux-amlogic@lists.infradead.org, Neil Armstrong X-Mailer: b4 0.12.0 Precedence: bulk List-ID: X-Mailing-List: linux-pm@vger.kernel.org The Hardkernel Odroid Go Ultra poweroff scheme requires requesting a poweroff to its two PMICs in order, this represents the poweroff scheme needed to complete a clean poweroff of the system. This implement this scheme by implementing a self registering driver to permit using probe defer until both pmics are finally probed. Signed-off-by: Neil Armstrong --- Previous submission was at [1], but I converted it to an independent platform device with device auto registration to permit waiting for both the PMICs drivers to probe. [1] https://lore.kernel.org/all/20221031-b4-odroid-go-ultra-initial-v1-2-42e3dbea86d5@linaro.org/ --- Changes in v3: - Removed dependency with rk08 - Switched to storing struct device of pmics - Fixed module init/exit - Link to v2: https://lore.kernel.org/r/20230126-b4-odroid-go-ultra-poweroff-v2-1-a8c50866f4ac@linaro.org Changes in v2: - Switched to devm_register_sys_off_handler() - Link to v1: https://lore.kernel.org/r/20221031-b4-odroid-go-ultra-initial-v1-2-42e3dbea86d5@linaro.org --- drivers/power/reset/Kconfig | 7 + drivers/power/reset/Makefile | 1 + drivers/power/reset/odroid-go-ultra-poweroff.c | 193 +++++++++++++++++++++++++ 3 files changed, 201 insertions(+) --- base-commit: 38d2b86a665b5e86371a1a30228bce259aa6c101 change-id: 20230126-b4-odroid-go-ultra-poweroff-c8fdca93f3eb Best regards, diff --git a/drivers/power/reset/Kconfig b/drivers/power/reset/Kconfig index a8c46ba5878f..a47ef7a9fc13 100644 --- a/drivers/power/reset/Kconfig +++ b/drivers/power/reset/Kconfig @@ -141,6 +141,13 @@ config POWER_RESET_OCELOT_RESET help This driver supports restart for Microsemi Ocelot SoC and similar. +config POWER_RESET_ODROID_GO_ULTRA_POWEROFF + bool "Odroid Go Ultra power-off driver" + depends on ARCH_MESON || COMPILE_TEST + depends on OF + help + This driver supports Power off for Odroid Go Ultra device. + config POWER_RESET_OXNAS bool "OXNAS SoC restart driver" depends on ARCH_OXNAS diff --git a/drivers/power/reset/Makefile b/drivers/power/reset/Makefile index 0a39424fc558..d763e6735ee3 100644 --- a/drivers/power/reset/Makefile +++ b/drivers/power/reset/Makefile @@ -17,6 +17,7 @@ obj-$(CONFIG_POWER_RESET_MT6323) += mt6323-poweroff.o obj-$(CONFIG_POWER_RESET_OXNAS) += oxnas-restart.o obj-$(CONFIG_POWER_RESET_QCOM_PON) += qcom-pon.o obj-$(CONFIG_POWER_RESET_OCELOT_RESET) += ocelot-reset.o +obj-$(CONFIG_POWER_RESET_ODROID_GO_ULTRA_POWEROFF) += odroid-go-ultra-poweroff.o obj-$(CONFIG_POWER_RESET_PIIX4_POWEROFF) += piix4-poweroff.o obj-$(CONFIG_POWER_RESET_LTC2952) += ltc2952-poweroff.o obj-$(CONFIG_POWER_RESET_QNAP) += qnap-poweroff.o diff --git a/drivers/power/reset/odroid-go-ultra-poweroff.c b/drivers/power/reset/odroid-go-ultra-poweroff.c new file mode 100644 index 000000000000..30a005088fbe --- /dev/null +++ b/drivers/power/reset/odroid-go-ultra-poweroff.c @@ -0,0 +1,193 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Copyright (c) 2023 Neil Armstrong + */ +#include +#include +#include +#include +#include +#include +#include +#include + +/* + * The Odroid Go Ultra has 2 PMICs: + * - RK818 (manages the battery and USB-C power supply) + * - RK817 + * Both PMICs feeds power to the S922X SoC, so they must be powered-off in sequence. + * Vendor does power-off the RK817 first, then the RK818 so here we follow this sequence. + */ + +struct odroid_go_ultra_poweroff_data { + struct device *dev; + struct device *rk817; + struct device *rk818; +}; + +static int odroid_go_ultra_poweroff_prepare(struct sys_off_data *data) +{ + struct odroid_go_ultra_poweroff_data *poweroff_data = data->cb_data; + struct regmap *rk817, *rk818; + int ret; + + /* RK817 Regmap */ + rk817 = dev_get_regmap(poweroff_data->rk817, NULL); + if (!rk817) { + dev_err(poweroff_data->dev, "failed to get rk817 regmap\n"); + return notifier_from_errno(-EINVAL); + } + + /* RK818 Regmap */ + rk818 = dev_get_regmap(poweroff_data->rk818, NULL); + if (!rk818) { + dev_err(poweroff_data->dev, "failed to get rk818 regmap\n"); + return notifier_from_errno(-EINVAL); + } + + dev_info(poweroff_data->dev, "Setting PMICs for power off"); + + /* RK817 */ + ret = regmap_update_bits(rk817, RK817_SYS_CFG(3), DEV_OFF, DEV_OFF); + if (ret) { + dev_err(poweroff_data->dev, "failed to poweroff rk817\n"); + return notifier_from_errno(ret); + } + + /* RK818 */ + ret = regmap_update_bits(rk818, RK818_DEVCTRL_REG, DEV_OFF, DEV_OFF); + if (ret) { + dev_err(poweroff_data->dev, "failed to poweroff rk818\n"); + return notifier_from_errno(ret); + } + + return NOTIFY_OK; +} + +static int odroid_go_ultra_poweroff_get_pmic_device(const char *compatible, struct device **pmic) +{ + struct device_node *pmic_node; + struct i2c_client *pmic_client; + + pmic_node = of_find_compatible_node(NULL, NULL, compatible); + if (!pmic_node) + return -ENODEV; + + pmic_client = of_find_i2c_device_by_node(pmic_node); + of_node_put(pmic_node); + if (!pmic_client) + return -EPROBE_DEFER; + + *pmic = &pmic_client->dev; + + return 0; +} + +static int odroid_go_ultra_poweroff_probe(struct platform_device *pdev) +{ + struct odroid_go_ultra_poweroff_data *poweroff_data; + int ret; + + poweroff_data = devm_kzalloc(&pdev->dev, sizeof(*poweroff_data), GFP_KERNEL); + if (!poweroff_data) + return -ENOMEM; + + dev_set_drvdata(&pdev->dev, poweroff_data); + + /* RK818 PMIC Device */ + ret = odroid_go_ultra_poweroff_get_pmic_device("rockchip,rk818", + &poweroff_data->rk818); + if (ret) + return dev_err_probe(&pdev->dev, ret, "failed to get rk818 mfd data\n"); + + /* RK817 PMIC Device */ + ret = odroid_go_ultra_poweroff_get_pmic_device("rockchip,rk817", + &poweroff_data->rk817); + if (ret) { + ret = dev_err_probe(&pdev->dev, ret, "failed to get rk817 mfd data\n"); + goto put_rk818_device; + } + + /* Register as SYS_OFF_MODE_POWER_OFF_PREPARE because regmap_update_bits may sleep */ + ret = devm_register_sys_off_handler(&pdev->dev, + SYS_OFF_MODE_POWER_OFF_PREPARE, + SYS_OFF_PRIO_DEFAULT, + odroid_go_ultra_poweroff_prepare, + poweroff_data); + if (ret) { + ret = dev_err_probe(&pdev->dev, ret, "failed to register sys-off handler\n"); + goto put_rk817_device; + } + + dev_info(&pdev->dev, "Registered Power-Off handler\n"); + + return 0; + +put_rk817_device: + put_device(poweroff_data->rk817); + +put_rk818_device: + put_device(poweroff_data->rk818); + + return ret; +} + +static int odroid_go_ultra_poweroff_remove(struct platform_device *pdev) +{ + struct odroid_go_ultra_poweroff_data *poweroff_data = dev_get_drvdata(&pdev->dev); + + put_device(poweroff_data->rk818); + put_device(poweroff_data->rk817); + + return 0; +} + +static struct platform_device *pdev; + +static struct platform_driver odroid_go_ultra_poweroff_driver = { + .driver = { + .name = "odroid-go-ultra-poweroff", + }, + .probe = odroid_go_ultra_poweroff_probe, + .remove = odroid_go_ultra_poweroff_remove, +}; + +static int __init odroid_go_ultra_poweroff_init(void) +{ + int ret; + + /* Only create when running on the Odroid Go Ultra device */ + if (!of_device_is_compatible(of_root, "hardkernel,odroid-go-ultra")) + return -ENODEV; + + ret = platform_driver_register(&odroid_go_ultra_poweroff_driver); + if (ret) + return ret; + + pdev = platform_device_register_resndata(NULL, "odroid-go-ultra-poweroff", -1, + NULL, 0, NULL, 0); + + if (IS_ERR(pdev)) { + platform_driver_unregister(&odroid_go_ultra_poweroff_driver); + return PTR_ERR(pdev); + } + + return 0; +} + +static void __exit odroid_go_ultra_poweroff_exit(void) +{ + /* Only delete when running on the Odroid Go Ultra device */ + if (!of_device_is_compatible(of_root, "hardkernel,odroid-go-ultra")) + return; + + platform_device_unregister(pdev); + platform_driver_unregister(&odroid_go_ultra_poweroff_driver); +} + +module_init(odroid_go_ultra_poweroff_init); +module_exit(odroid_go_ultra_poweroff_exit); + +MODULE_AUTHOR("Neil Armstrong "); +MODULE_DESCRIPTION("Odroid Go Ultra poweroff driver"); +MODULE_LICENSE("GPL");