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#include <linux/kernel.h>
47#include <linux/init.h>
48#include <linux/interrupt.h>
49#include <linux/device.h>
50#include <linux/platform_device.h>
51#include <linux/ktime.h>
52#include <linux/slab.h>
53#include <linux/kmod.h>
54#include <linux/module.h>
55#include <linux/mod_devicetable.h>
56#include <linux/gpio/consumer.h>
57#include <linux/reboot.h>
58#include <linux/property.h>
59
60struct ltc2952_poweroff {
61 struct hrtimer timer_trigger;
62 struct hrtimer timer_wde;
63
64 ktime_t trigger_delay;
65 ktime_t wde_interval;
66
67 struct device *dev;
68
69 struct gpio_desc *gpio_trigger;
70 struct gpio_desc *gpio_watchdog;
71 struct gpio_desc *gpio_kill;
72
73 bool kernel_panic;
74 struct notifier_block panic_notifier;
75};
76
77#define to_ltc2952(p, m) container_of(p, struct ltc2952_poweroff, m)
78
79
80
81
82
83static struct ltc2952_poweroff *ltc2952_data;
84
85
86
87
88
89
90
91
92
93
94static enum hrtimer_restart ltc2952_poweroff_timer_wde(struct hrtimer *timer)
95{
96 ktime_t now;
97 int state;
98 struct ltc2952_poweroff *data = to_ltc2952(timer, timer_wde);
99
100 if (data->kernel_panic)
101 return HRTIMER_NORESTART;
102
103 state = gpiod_get_value(data->gpio_watchdog);
104 gpiod_set_value(data->gpio_watchdog, !state);
105
106 now = hrtimer_cb_get_time(timer);
107 hrtimer_forward(timer, now, data->wde_interval);
108
109 return HRTIMER_RESTART;
110}
111
112static void ltc2952_poweroff_start_wde(struct ltc2952_poweroff *data)
113{
114 hrtimer_start(&data->timer_wde, data->wde_interval, HRTIMER_MODE_REL);
115}
116
117static enum hrtimer_restart
118ltc2952_poweroff_timer_trigger(struct hrtimer *timer)
119{
120 struct ltc2952_poweroff *data = to_ltc2952(timer, timer_trigger);
121
122 ltc2952_poweroff_start_wde(data);
123 dev_info(data->dev, "executing shutdown\n");
124 orderly_poweroff(true);
125
126 return HRTIMER_NORESTART;
127}
128
129
130
131
132
133
134
135
136
137
138static irqreturn_t ltc2952_poweroff_handler(int irq, void *dev_id)
139{
140 struct ltc2952_poweroff *data = dev_id;
141
142 if (data->kernel_panic || hrtimer_active(&data->timer_wde)) {
143
144 return IRQ_HANDLED;
145 }
146
147 if (gpiod_get_value(data->gpio_trigger)) {
148 hrtimer_start(&data->timer_trigger, data->trigger_delay,
149 HRTIMER_MODE_REL);
150 } else {
151 hrtimer_cancel(&data->timer_trigger);
152 }
153 return IRQ_HANDLED;
154}
155
156static void ltc2952_poweroff_kill(void)
157{
158 gpiod_set_value(ltc2952_data->gpio_kill, 1);
159}
160
161static void ltc2952_poweroff_default(struct ltc2952_poweroff *data)
162{
163 data->wde_interval = 300L * 1E6L;
164 data->trigger_delay = ktime_set(2, 500L*1E6L);
165
166 hrtimer_init(&data->timer_trigger, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
167 data->timer_trigger.function = ltc2952_poweroff_timer_trigger;
168
169 hrtimer_init(&data->timer_wde, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
170 data->timer_wde.function = ltc2952_poweroff_timer_wde;
171}
172
173static int ltc2952_poweroff_init(struct platform_device *pdev)
174{
175 int ret;
176 u32 trigger_delay_ms;
177 struct ltc2952_poweroff *data = platform_get_drvdata(pdev);
178
179 ltc2952_poweroff_default(data);
180
181 if (!device_property_read_u32(&pdev->dev, "trigger-delay-ms",
182 &trigger_delay_ms)) {
183 data->trigger_delay = ktime_set(trigger_delay_ms / MSEC_PER_SEC,
184 (trigger_delay_ms % MSEC_PER_SEC) * NSEC_PER_MSEC);
185 }
186
187 data->gpio_watchdog = devm_gpiod_get(&pdev->dev, "watchdog",
188 GPIOD_OUT_LOW);
189 if (IS_ERR(data->gpio_watchdog)) {
190 ret = PTR_ERR(data->gpio_watchdog);
191 dev_err(&pdev->dev, "unable to claim gpio \"watchdog\"\n");
192 return ret;
193 }
194
195 data->gpio_kill = devm_gpiod_get(&pdev->dev, "kill", GPIOD_OUT_LOW);
196 if (IS_ERR(data->gpio_kill)) {
197 ret = PTR_ERR(data->gpio_kill);
198 dev_err(&pdev->dev, "unable to claim gpio \"kill\"\n");
199 return ret;
200 }
201
202 data->gpio_trigger = devm_gpiod_get_optional(&pdev->dev, "trigger",
203 GPIOD_IN);
204 if (IS_ERR(data->gpio_trigger)) {
205
206
207
208
209
210 dev_err(&pdev->dev, "unable to claim gpio \"trigger\"\n");
211 data->gpio_trigger = NULL;
212 }
213
214 if (devm_request_irq(&pdev->dev, gpiod_to_irq(data->gpio_trigger),
215 ltc2952_poweroff_handler,
216 (IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING),
217 "ltc2952-poweroff",
218 data)) {
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234 if (data->gpio_trigger) {
235 dev_warn(&pdev->dev,
236 "unable to configure the trigger interrupt\n");
237 devm_gpiod_put(&pdev->dev, data->gpio_trigger);
238 data->gpio_trigger = NULL;
239 }
240 dev_info(&pdev->dev,
241 "power down trigger input will not be used\n");
242 ltc2952_poweroff_start_wde(data);
243 }
244
245 return 0;
246}
247
248static int ltc2952_poweroff_notify_panic(struct notifier_block *nb,
249 unsigned long code, void *unused)
250{
251 struct ltc2952_poweroff *data = to_ltc2952(nb, panic_notifier);
252
253 data->kernel_panic = true;
254 return NOTIFY_DONE;
255}
256
257static int ltc2952_poweroff_probe(struct platform_device *pdev)
258{
259 int ret;
260 struct ltc2952_poweroff *data;
261
262 if (pm_power_off) {
263 dev_err(&pdev->dev, "pm_power_off already registered");
264 return -EBUSY;
265 }
266
267 data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
268 if (!data)
269 return -ENOMEM;
270
271 data->dev = &pdev->dev;
272 platform_set_drvdata(pdev, data);
273
274 ret = ltc2952_poweroff_init(pdev);
275 if (ret)
276 return ret;
277
278
279 ltc2952_data = data;
280 pm_power_off = ltc2952_poweroff_kill;
281
282 data->panic_notifier.notifier_call = ltc2952_poweroff_notify_panic;
283 atomic_notifier_chain_register(&panic_notifier_list,
284 &data->panic_notifier);
285 dev_info(&pdev->dev, "probe successful\n");
286
287 return 0;
288}
289
290static int ltc2952_poweroff_remove(struct platform_device *pdev)
291{
292 struct ltc2952_poweroff *data = platform_get_drvdata(pdev);
293
294 pm_power_off = NULL;
295 hrtimer_cancel(&data->timer_trigger);
296 hrtimer_cancel(&data->timer_wde);
297 atomic_notifier_chain_unregister(&panic_notifier_list,
298 &data->panic_notifier);
299 return 0;
300}
301
302static const struct of_device_id of_ltc2952_poweroff_match[] = {
303 { .compatible = "lltc,ltc2952"},
304 {},
305};
306MODULE_DEVICE_TABLE(of, of_ltc2952_poweroff_match);
307
308static struct platform_driver ltc2952_poweroff_driver = {
309 .probe = ltc2952_poweroff_probe,
310 .remove = ltc2952_poweroff_remove,
311 .driver = {
312 .name = "ltc2952-poweroff",
313 .of_match_table = of_ltc2952_poweroff_match,
314 },
315};
316
317module_platform_driver(ltc2952_poweroff_driver);
318
319MODULE_AUTHOR("Ren\xC3\xA9 Moll <rene.moll@xsens.com>");
320MODULE_DESCRIPTION("LTC PowerPath power-off driver");
321MODULE_LICENSE("GPL v2");
322