1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
|
// 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");
|
