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
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
|
/*
* Copyright (c) 2006-2023, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2023-02-25 GuEe-GUI the first version
*/
#include "reboot-mode.h"
#define MODE_SUFFIXE "mode-"
struct mode_info
{
rt_slist_t list;
const char *mode;
rt_uint32_t magic;
};
static rt_err_t reboot_mode_work(struct rt_device *dev, char *cmd)
{
struct mode_info *info;
struct reboot_mode *reboot = (void *)dev;
cmd = cmd ? : "normal";
rt_slist_for_each_entry(info, &reboot->mode_nodes, list)
{
if (!rt_strcmp(info->mode, cmd))
{
reboot->write(reboot, info->magic);
break;
}
}
return RT_EOK;
}
rt_err_t reboot_mode_register(struct reboot_mode *reboot)
{
rt_err_t err;
struct mode_info *info;
struct rt_ofw_prop *prop;
struct rt_ofw_node *np = reboot->dev->ofw_node;
const int mode_suffixe_len = sizeof(MODE_SUFFIXE) - 1;
if (!reboot || !reboot->dev)
{
return -RT_EINVAL;
}
rt_slist_init(&reboot->mode_nodes);
rt_ofw_foreach_prop(np, prop)
{
if (rt_strncmp(prop->name, MODE_SUFFIXE, mode_suffixe_len))
{
continue;
}
info = rt_malloc(sizeof(*info));
if (!info)
{
err = -RT_ENOMEM;
goto _end;
}
info->mode = prop->name + mode_suffixe_len;
info->magic = fdt32_to_cpu(*(const fdt32_t *)prop->value);
rt_slist_init(&info->list);
rt_slist_insert(&reboot->mode_nodes, &info->list);
}
err = rt_dm_reboot_mode_register((void *)reboot, &reboot_mode_work);
_end:
if (err)
{
struct mode_info *prev_info = RT_NULL;
rt_slist_for_each_entry(info, &reboot->mode_nodes, list)
{
if (prev_info)
{
rt_free(prev_info);
}
prev_info = info;
}
if (prev_info)
{
rt_free(prev_info);
}
}
return err;
}
|
