ARK-OS/arkos/kernel/drivers/power/reset/spacemit-p1-reboot.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2025 by Aurelien Jarno
 */

#include <linux/bits.h>
#include <linux/mod_devicetable.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/reboot.h>

/* Power Control Register 2 */
#define PWR_CTRL2		0x7e
#define PWR_CTRL2_SHUTDOWN	BIT(2)	/* Shutdown request */
#define PWR_CTRL2_RST		BIT(1)	/* Reset request */

static int spacemit_p1_pwroff_handler(struct sys_off_data *data)
{
	struct regmap *regmap = data->cb_data;
	int ret;

	/* Put the PMIC into shutdown state */
	ret = regmap_set_bits(regmap, PWR_CTRL2, PWR_CTRL2_SHUTDOWN);
	if (ret) {
		dev_err(data->dev, "shutdown failed: %d\n", ret);
		return notifier_from_errno(ret);
	}

	return NOTIFY_DONE;
}

static int spacemit_p1_restart_handler(struct sys_off_data *data)
{
	struct regmap *regmap = data->cb_data;
	int ret;

	/* Put the PMIC into reset state */
	ret = regmap_set_bits(regmap, PWR_CTRL2, PWR_CTRL2_RST);
	if (ret) {
		dev_err(data->dev, "restart failed: %d\n", ret);
		return notifier_from_errno(ret);
	}

	return NOTIFY_DONE;
}

static int spacemit_p1_reboot_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct regmap *regmap;
	int ret;

	regmap = dev_get_regmap(dev->parent, NULL);
	if (!regmap)
		return -ENODEV;

	ret = devm_register_power_off_handler(dev, &spacemit_p1_pwroff_handler,
					      regmap);
	if (ret)
		return dev_err_probe(dev, ret,
				     "Failed to register power off handler\n");

	ret = devm_register_restart_handler(dev, spacemit_p1_restart_handler,
					    regmap);
	if (ret)
		return dev_err_probe(dev, ret,
				     "Failed to register restart handler\n");

	return 0;
}

static const struct platform_device_id spacemit_p1_reboot_id_table[] = {
	{ "spacemit-p1-reboot", },
	{ /* sentinel */ },
};
MODULE_DEVICE_TABLE(platform, spacemit_p1_reboot_id_table);

static struct platform_driver spacemit_p1_reboot_driver = {
	.driver = {
		.name = "spacemit-p1-reboot",
	},
	.probe = spacemit_p1_reboot_probe,
	.id_table = spacemit_p1_reboot_id_table,
};
module_platform_driver(spacemit_p1_reboot_driver);

MODULE_DESCRIPTION("SpacemiT P1 reboot/poweroff driver");
MODULE_LICENSE("GPL");