From mboxrd@z Thu Jan 1 00:00:00 1970 Received: from mail-wm1-f47.google.com (mail-wm1-f47.google.com [209.85.128.47]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id EA85179EA for ; Wed, 20 Mar 2024 02:05:54 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.128.47 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1710900357; cv=none; b=Wha9OXVjIi95fyq8z/wFj6ue0vKID6OyhzZSivHaeiQZNczntAxtPp9pQ0s5FmL4jyLY3jEWDj0i8ZRkNiDUeFLuJOl5BhMXSO1BPYT9aOkcXn/l2E2g/0BTF0W48rQPXizKnaM3n95iFMpO2v2Oxe7Jzo+MjB1xqq1A6f83ug0= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1710900357; c=relaxed/simple; bh=vaa+2ijoVtcb7E9zbnqicdNU3+R9K/2vv81NGhoGNJQ=; h=From:To:Cc:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version; b=aejisIeGtXJTwcez1opQ55Fpj5j5NfM0ZuZAljFA4h7vwxRwiefjttMFjYqJWQ/jTrhTocDAAMYu+fh0i7rGxPxfqfgTWGX3xgmeRiB/NeByIwgE60BhllAgO1k2sjVq1zeBrgnq1cystydmp+xDaXn6BfHwK9DxYszM1hkp4zI= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=VeMfMQhy; arc=none smtp.client-ip=209.85.128.47 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="VeMfMQhy" Received: by mail-wm1-f47.google.com with SMTP id 5b1f17b1804b1-414633f7a52so15335365e9.0 for ; Tue, 19 Mar 2024 19:05:54 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1710900353; x=1711505153; darn=vger.kernel.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=8onlL6eaVMOKsrmQglnPXgtQA9k3jRb7PbaPmYQjRaA=; b=VeMfMQhyd1flff19ahd//yu2uFX5lOoIBkB3kbvVDYBqagSSdFXYj/v1gdrPiZfloG FD2u3PfLTlkBaDb0FBaA722yjgfB9ENmAK+6vZo7I27GP4/T5kp8UqV9qqJlzWy+mWn4 AKtvNVlTtL6t2XDhHXUmZjwwVkvvD9jfjGF9lozY/GegaztbztDYg2sLOMleUrJvIEyr 3r20lpldv/XgARSDDIP5E5E8a6ZPBskZ1YxBPS95abD60ERKvtFc2zYt2JOxu/XSgCpO OohigjPAGGYBawXB1mOAFDUc87Gtnqzf0+ME2LI/Ig2zY5RL6uQMv8N/SIB4C7W+pd1b OOEw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1710900353; x=1711505153; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=8onlL6eaVMOKsrmQglnPXgtQA9k3jRb7PbaPmYQjRaA=; b=PMU/mgsUcakBL99nsz00CyuIdDtDMlxe1GXMMmkoE25F4gZfQ2S5LoUEEx+rNwcEhl FM5tD9Lv1DVRAKlzntaAukKU3H7rg77+MlPHnQS25fSP97ioDnllSly9Gvda5Avys7Af KRPQ2/g5MtI0fdAGg4koL6Esc8Ic8FpH8JnacuC6CtU1R72JfWWSpAZBSEKrD72NVCDb I+N6/mhZ85axfQK5iSUppRHbP4hzzDcVLEJa2VcGC9WIJNPksNabPj8Ov3+0pUrRm6q+ 3kh7jD+HoYmsK0OUfQQ22txAwGQVKJyqcF8tX4olBFfJMygqFk73qFovUCTYGxcdCDmj 7s1w== X-Forwarded-Encrypted: i=1; AJvYcCWck03MjjBvCK3yvucuLUz5wvWef2lfM7RZye7ipKnKBOkg6+ii0XSQjdVM112Pw4FBX+UwUKv4toxoKIaw+L3K6WA4Ge9OibBF2xQp X-Gm-Message-State: AOJu0Yyd+JAdU9bhUh+ZxsblERGVB9T7nlRLA1bHSULR/e+yOYoBoGFA FbDnGDjvurWnwzTEGakBf6eECkTknMHmyfduCSlAL1O2fd0MuBpTvJYJJ/EsnjE= X-Google-Smtp-Source: AGHT+IE68IgbQV2m5xaeAAIsPInh5pDFP6u6jfPE18/dwJApj36Y7blQSDKqq5/s9aU2fs3UkSbn8Q== X-Received: by 2002:adf:f292:0:b0:33d:1eea:4346 with SMTP id k18-20020adff292000000b0033d1eea4346mr10012461wro.37.1710900353298; Tue, 19 Mar 2024 19:05:53 -0700 (PDT) Received: from localhost.localdomain ([2a02:c7c:7213:c700:e992:6869:474c:a63f]) by smtp.gmail.com with ESMTPSA id u14-20020a056000038e00b0033e34c53354sm9209295wrf.56.2024.03.19.19.05.52 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 19 Mar 2024 19:05:52 -0700 (PDT) From: Alexey Klimov To: sre@kernel.org, robh@kernel.org, krzysztof.kozlowski+dt@linaro.org, linux-pm@vger.kernel.org, devicetree@vger.kernel.org, peter.griffin@linaro.org, robh+dt@kernel.org Cc: conor+dt@kernel.org, linux-samsung-soc@vger.kernel.org, semen.protsenko@linaro.org, linux-kernel@vger.kernel.org, klimov.linux@gmail.com, kernel-team@android.com, tudor.ambarus@linaro.org, andre.draszik@linaro.org, saravanak@google.com, willmcvicker@google.com, alexey.klimov@linaro.org, alim.akhtar@samsung.com, linux-arm-kernel@lists.infradead.org, elder@linaro.org Subject: [PATCH 3/3] power: reset: add new gs101-poweroff driver Date: Wed, 20 Mar 2024 02:05:49 +0000 Message-ID: <20240320020549.71810-3-alexey.klimov@linaro.org> X-Mailer: git-send-email 2.43.0 In-Reply-To: <20240320020549.71810-1-alexey.klimov@linaro.org> References: <20240320020549.71810-1-alexey.klimov@linaro.org> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Transfer-Encoding: 8bit The driver allows switching off the Google gs101 SoC (Pixel6 family of mobile phones). The syscon-poweroff cannot be used since gs101 requires smc-based regmap i.e. a write to PMU register done from EL3 is required. Additionally the power off write should be performed when power button is not pressed. When USB charging cable is connected then this leads to a reboot of a device initiated by bootloader/firmware. Signed-off-by: Alexey Klimov --- drivers/power/reset/Kconfig | 7 ++ drivers/power/reset/Makefile | 1 + drivers/power/reset/gs101-poweroff.c | 157 +++++++++++++++++++++++++++ 3 files changed, 165 insertions(+) create mode 100644 drivers/power/reset/gs101-poweroff.c diff --git a/drivers/power/reset/Kconfig b/drivers/power/reset/Kconfig index fece990af4a7..e7323b3b4a61 100644 --- a/drivers/power/reset/Kconfig +++ b/drivers/power/reset/Kconfig @@ -100,6 +100,13 @@ config POWER_RESET_GPIO_RESTART If your board needs a GPIO high/low to restart, say Y and create a binding in your devicetree. +config POWER_RESET_GS101_POWEROFF + tristate "GS101 power-off driver" + depends on ARCH_EXYNOS || COMPILE_TEST + help + This driver supports turning off the Google Tensor Pixel6 GS101 phones. + Select this if you're building a kernel with Google Tensor SoC support. + config POWER_RESET_HISI bool "Hisilicon power-off driver" depends on ARCH_HISI diff --git a/drivers/power/reset/Makefile b/drivers/power/reset/Makefile index a95d1bd275d1..7065b7e4ce77 100644 --- a/drivers/power/reset/Makefile +++ b/drivers/power/reset/Makefile @@ -10,6 +10,7 @@ obj-$(CONFIG_POWER_RESET_BRCMSTB) += brcmstb-reboot.o obj-$(CONFIG_POWER_RESET_GEMINI_POWEROFF) += gemini-poweroff.o obj-$(CONFIG_POWER_RESET_GPIO) += gpio-poweroff.o obj-$(CONFIG_POWER_RESET_GPIO_RESTART) += gpio-restart.o +obj-$(CONFIG_POWER_RESET_GS101_POWEROFF) += gs101-poweroff.o obj-$(CONFIG_POWER_RESET_HISI) += hisi-reboot.o obj-$(CONFIG_POWER_RESET_LINKSTATION) += linkstation-poweroff.o obj-$(CONFIG_POWER_RESET_MSM) += msm-poweroff.o diff --git a/drivers/power/reset/gs101-poweroff.c b/drivers/power/reset/gs101-poweroff.c new file mode 100644 index 000000000000..2be903de16a1 --- /dev/null +++ b/drivers/power/reset/gs101-poweroff.c @@ -0,0 +1,157 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * GS101 Poweroff Driver + * + * Copyright (c) 2024, Linaro Ltd. + * Author: Alexey Klimov + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define shwork_to_poweroff(x) \ + container_of(x, struct gs101_poweroff, shutdown_work) + +#define keyboard_nb_to_poweroff(x) \ + container_of(x, struct gs101_poweroff, keyboard_nb) + +struct gs101_poweroff { + struct notifier_block keyboard_nb; + bool power_key_pressed; + struct work_struct shutdown_work; + struct regmap *map; + u32 offset; + u32 mask; +}; + +static struct gs101_poweroff *gs101_poweroff_ctx; + +static void gs101_shutdown_work_fn(struct work_struct *work) +{ + struct gs101_poweroff *gs101 = shwork_to_poweroff(work); + + while (1) { + /* wait for power button release */ + if (!gs101->power_key_pressed) { + /* Issue the poweroff */ + regmap_update_bits(gs101->map, + gs101->offset, + gs101->mask, 0); + } else { + /* + * if power button is not released, + * wait and check TA again + */ + pr_info("power key is not released.\n"); + } + mdelay(1000); + } +} + +static int gs101_keyboard_notifier_call(struct notifier_block *nb, + unsigned long code, void *_param) +{ + struct keyboard_notifier_param *param = _param; + + if (param->value == KEY_POWER) { + struct gs101_poweroff *gs101 = keyboard_nb_to_poweroff(nb); + + gs101->power_key_pressed = param->down; + } + + return NOTIFY_OK; +} + +static void gs101_poweroff(void) +{ + schedule_work(&gs101_poweroff_ctx->shutdown_work); +} + +static int gs101_poweroff_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct gs101_poweroff *gs101; + int ret; + + gs101 = devm_kzalloc(dev, sizeof(*gs101), GFP_KERNEL); + if (!gs101) + return -ENOMEM; + + gs101->map = exynos_get_pmu_regmap_by_phandle(dev->of_node, + "samsung,syscon-phandle"); + if (IS_ERR(gs101->map)) + return PTR_ERR(gs101->map); + + if (of_property_read_u32(dev->of_node, "offset", &gs101->offset)) { + dev_err(dev, "unable to read 'offset' from DT\n"); + return -EINVAL; + } + + if (of_property_read_u32(dev->of_node, "mask", &gs101->mask)) { + dev_err(dev, "unable to read 'mask' from DT\n"); + return -EINVAL; + } + + gs101->keyboard_nb.notifier_call = gs101_keyboard_notifier_call; + ret = register_keyboard_notifier(&gs101->keyboard_nb); + if (ret) { + dev_err(dev, "failed to register keyboard notifier: %i\n", ret); + return ret; + } + + ret = devm_work_autocancel(dev, &gs101->shutdown_work, + gs101_shutdown_work_fn); + if (ret) { + dev_err(dev, "failed to register gs101 shutdown_work: %i\n", ret); + unregister_keyboard_notifier(&gs101->keyboard_nb); + return ret; + } + + gs101_poweroff_ctx = gs101; + platform_set_drvdata(pdev, gs101); + + /* + * At this point there is a chance that psci_sys_poweroff already + * registered as pm_power_off hook but unfortunately it cannot power + * off the gs101 SoC hence we are rewriting it here just as is. + */ + pm_power_off = gs101_poweroff; + + return 0; +} + +static void gs101_poweroff_remove(struct platform_device *pdev) +{ + struct gs101_poweroff *gs101 = platform_get_drvdata(pdev); + + if (pm_power_off == gs101_poweroff) + pm_power_off = NULL; + + unregister_keyboard_notifier(&gs101->keyboard_nb); +} + +static const struct of_device_id gs101_poweroff_of_match[] = { + { .compatible = "google,gs101-poweroff" }, + {} +}; + +static struct platform_driver gs101_poweroff_driver = { + .probe = gs101_poweroff_probe, + .remove_new = gs101_poweroff_remove, + .driver = { + .name = "gs101-poweroff", + .of_match_table = gs101_poweroff_of_match, + }, +}; + +module_platform_driver(gs101_poweroff_driver); +MODULE_AUTHOR("Alexey Klimov "); +MODULE_DESCRIPTION("Google GS101 poweroff driver"); +MODULE_LICENSE("GPL v2"); -- 2.43.0