1
2
3
4
5
6
7
8
9
10
11#include <common.h>
12#include <dm.h>
13#include <errno.h>
14#include <log.h>
15#include <malloc.h>
16#include <reset-uclass.h>
17#include <dm/device_compat.h>
18#include <linux/err.h>
19#include <linux/soc/ti/ti_sci_protocol.h>
20
21
22
23
24
25struct ti_sci_reset_data {
26 const struct ti_sci_handle *sci;
27};
28
29static int ti_sci_reset_probe(struct udevice *dev)
30{
31 struct ti_sci_reset_data *data = dev_get_priv(dev);
32
33 debug("%s(dev=%p)\n", __func__, dev);
34
35 if (!data)
36 return -ENOMEM;
37
38
39 data->sci = ti_sci_get_handle(dev);
40 if (IS_ERR(data->sci))
41 return PTR_ERR(data->sci);
42
43 return 0;
44}
45
46static int ti_sci_reset_of_xlate(struct reset_ctl *rst,
47 struct ofnode_phandle_args *args)
48{
49 debug("%s(rst=%p, args_count=%d)\n", __func__, rst, args->args_count);
50
51 if (args->args_count != 2) {
52 debug("Invalid args_count: %d\n", args->args_count);
53 return -EINVAL;
54 }
55
56
57
58
59
60 rst->id = args->args[0];
61 rst->data = args->args[1];
62
63 return 0;
64}
65
66static int ti_sci_reset_request(struct reset_ctl *rst)
67{
68 debug("%s(rst=%p)\n", __func__, rst);
69 return 0;
70}
71
72static int ti_sci_reset_free(struct reset_ctl *rst)
73{
74 debug("%s(rst=%p)\n", __func__, rst);
75 return 0;
76}
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93static int ti_sci_reset_set(struct reset_ctl *rst, bool assert)
94{
95 struct ti_sci_reset_data *data = dev_get_priv(rst->dev);
96 const struct ti_sci_handle *sci = data->sci;
97 const struct ti_sci_dev_ops *dops = &sci->ops.dev_ops;
98 u32 reset_state;
99 int ret;
100
101 ret = dops->get_device_resets(sci, rst->id, &reset_state);
102 if (ret) {
103 dev_err(rst->dev, "%s: get_device_resets failed (%d)\n",
104 __func__, ret);
105 return ret;
106 }
107
108 if (assert)
109 reset_state |= rst->data;
110 else
111 reset_state &= ~rst->data;
112
113 ret = dops->set_device_resets(sci, rst->id, reset_state);
114 if (ret) {
115 dev_err(rst->dev, "%s: set_device_resets failed (%d)\n",
116 __func__, ret);
117 return ret;
118 }
119
120 return 0;
121}
122
123
124
125
126
127
128
129
130
131
132
133
134static int ti_sci_reset_assert(struct reset_ctl *rst)
135{
136 debug("%s(rst=%p)\n", __func__, rst);
137 return ti_sci_reset_set(rst, true);
138}
139
140
141
142
143
144
145
146
147
148
149
150
151static int ti_sci_reset_deassert(struct reset_ctl *rst)
152{
153 debug("%s(rst=%p)\n", __func__, rst);
154 return ti_sci_reset_set(rst, false);
155}
156
157
158
159
160
161
162
163
164
165
166
167
168
169static int ti_sci_reset_status(struct reset_ctl *rst)
170{
171 struct ti_sci_reset_data *data = dev_get_priv(rst->dev);
172 const struct ti_sci_handle *sci = data->sci;
173 const struct ti_sci_dev_ops *dops = &sci->ops.dev_ops;
174 u32 reset_state;
175 int ret;
176
177 debug("%s(rst=%p)\n", __func__, rst);
178
179 ret = dops->get_device_resets(sci, rst->id, &reset_state);
180 if (ret) {
181 dev_err(rst->dev, "%s: get_device_resets failed (%d)\n",
182 __func__, ret);
183 return ret;
184 }
185
186 return reset_state & rst->data;
187}
188
189static const struct udevice_id ti_sci_reset_of_match[] = {
190 { .compatible = "ti,sci-reset", },
191 { },
192};
193
194static struct reset_ops ti_sci_reset_ops = {
195 .of_xlate = ti_sci_reset_of_xlate,
196 .request = ti_sci_reset_request,
197 .rfree = ti_sci_reset_free,
198 .rst_assert = ti_sci_reset_assert,
199 .rst_deassert = ti_sci_reset_deassert,
200 .rst_status = ti_sci_reset_status,
201};
202
203U_BOOT_DRIVER(ti_sci_reset) = {
204 .name = "ti-sci-reset",
205 .id = UCLASS_RESET,
206 .of_match = ti_sci_reset_of_match,
207 .probe = ti_sci_reset_probe,
208 .priv_auto_alloc_size = sizeof(struct ti_sci_reset_data),
209 .ops = &ti_sci_reset_ops,
210};
211