1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
2 // Copyright(c) 2015-17 Intel Corporation.
3
4 /*
5 * MIPI Discovery And Configuration (DisCo) Specification for SoundWire
6 * specifies properties to be implemented for SoundWire Masters and Slaves.
7 * The DisCo spec doesn't mandate these properties. However, SDW bus cannot
8 * work without knowing these values.
9 *
10 * The helper functions read the Master and Slave properties. Implementers
11 * of Master or Slave drivers can use any of the below three mechanisms:
12 * a) Use these APIs here as .read_prop() callback for Master and Slave
13 * b) Implement own methods and set those as .read_prop(), but invoke
14 * APIs in this file for generic read and override the values with
15 * platform specific data
16 * c) Implement ones own methods which do not use anything provided
17 * here
18 */
19
20 #include <linux/device.h>
21 #include <linux/property.h>
22 #include <linux/mod_devicetable.h>
23 #include <linux/soundwire/sdw.h>
24 #include "bus.h"
25
26 /**
27 * sdw_master_read_prop() - Read Master properties
28 * @bus: SDW bus instance
29 */
sdw_master_read_prop(struct sdw_bus * bus)30 int sdw_master_read_prop(struct sdw_bus *bus)
31 {
32 struct sdw_master_prop *prop = &bus->prop;
33 struct fwnode_handle *link;
34 char name[32];
35 int nval, i;
36
37 device_property_read_u32(bus->dev,
38 "mipi-sdw-sw-interface-revision",
39 &prop->revision);
40
41 /* Find master handle */
42 snprintf(name, sizeof(name),
43 "mipi-sdw-link-%d-subproperties", bus->link_id);
44
45 link = device_get_named_child_node(bus->dev, name);
46 if (!link) {
47 dev_err(bus->dev, "Master node %s not found\n", name);
48 return -EIO;
49 }
50
51 if (fwnode_property_read_bool(link,
52 "mipi-sdw-clock-stop-mode0-supported"))
53 prop->clk_stop_modes |= BIT(SDW_CLK_STOP_MODE0);
54
55 if (fwnode_property_read_bool(link,
56 "mipi-sdw-clock-stop-mode1-supported"))
57 prop->clk_stop_modes |= BIT(SDW_CLK_STOP_MODE1);
58
59 fwnode_property_read_u32(link,
60 "mipi-sdw-max-clock-frequency",
61 &prop->max_clk_freq);
62
63 nval = fwnode_property_count_u32(link, "mipi-sdw-clock-frequencies-supported");
64 if (nval > 0) {
65 prop->num_clk_freq = nval;
66 prop->clk_freq = devm_kcalloc(bus->dev, prop->num_clk_freq,
67 sizeof(*prop->clk_freq),
68 GFP_KERNEL);
69 if (!prop->clk_freq) {
70 fwnode_handle_put(link);
71 return -ENOMEM;
72 }
73
74 fwnode_property_read_u32_array(link,
75 "mipi-sdw-clock-frequencies-supported",
76 prop->clk_freq, prop->num_clk_freq);
77 }
78
79 /*
80 * Check the frequencies supported. If FW doesn't provide max
81 * freq, then populate here by checking values.
82 */
83 if (!prop->max_clk_freq && prop->clk_freq) {
84 prop->max_clk_freq = prop->clk_freq[0];
85 for (i = 1; i < prop->num_clk_freq; i++) {
86 if (prop->clk_freq[i] > prop->max_clk_freq)
87 prop->max_clk_freq = prop->clk_freq[i];
88 }
89 }
90
91 nval = fwnode_property_count_u32(link, "mipi-sdw-supported-clock-gears");
92 if (nval > 0) {
93 prop->num_clk_gears = nval;
94 prop->clk_gears = devm_kcalloc(bus->dev, prop->num_clk_gears,
95 sizeof(*prop->clk_gears),
96 GFP_KERNEL);
97 if (!prop->clk_gears) {
98 fwnode_handle_put(link);
99 return -ENOMEM;
100 }
101
102 fwnode_property_read_u32_array(link,
103 "mipi-sdw-supported-clock-gears",
104 prop->clk_gears,
105 prop->num_clk_gears);
106 }
107
108 fwnode_property_read_u32(link, "mipi-sdw-default-frame-rate",
109 &prop->default_frame_rate);
110
111 fwnode_property_read_u32(link, "mipi-sdw-default-frame-row-size",
112 &prop->default_row);
113
114 fwnode_property_read_u32(link, "mipi-sdw-default-frame-col-size",
115 &prop->default_col);
116
117 prop->dynamic_frame = fwnode_property_read_bool(link,
118 "mipi-sdw-dynamic-frame-shape");
119
120 fwnode_property_read_u32(link, "mipi-sdw-command-error-threshold",
121 &prop->err_threshold);
122
123 fwnode_handle_put(link);
124
125 return 0;
126 }
127 EXPORT_SYMBOL(sdw_master_read_prop);
128
sdw_slave_read_dp0(struct sdw_slave * slave,struct fwnode_handle * port,struct sdw_dp0_prop * dp0)129 static int sdw_slave_read_dp0(struct sdw_slave *slave,
130 struct fwnode_handle *port,
131 struct sdw_dp0_prop *dp0)
132 {
133 int nval;
134
135 fwnode_property_read_u32(port, "mipi-sdw-port-max-wordlength",
136 &dp0->max_word);
137
138 fwnode_property_read_u32(port, "mipi-sdw-port-min-wordlength",
139 &dp0->min_word);
140
141 nval = fwnode_property_count_u32(port, "mipi-sdw-port-wordlength-configs");
142 if (nval > 0) {
143
144 dp0->num_words = nval;
145 dp0->words = devm_kcalloc(&slave->dev,
146 dp0->num_words, sizeof(*dp0->words),
147 GFP_KERNEL);
148 if (!dp0->words)
149 return -ENOMEM;
150
151 fwnode_property_read_u32_array(port,
152 "mipi-sdw-port-wordlength-configs",
153 dp0->words, dp0->num_words);
154 }
155
156 dp0->BRA_flow_controlled = fwnode_property_read_bool(port,
157 "mipi-sdw-bra-flow-controlled");
158
159 dp0->simple_ch_prep_sm = fwnode_property_read_bool(port,
160 "mipi-sdw-simplified-channel-prepare-sm");
161
162 dp0->imp_def_interrupts = fwnode_property_read_bool(port,
163 "mipi-sdw-imp-def-dp0-interrupts-supported");
164
165 return 0;
166 }
167
sdw_slave_read_dpn(struct sdw_slave * slave,struct sdw_dpn_prop * dpn,int count,int ports,char * type)168 static int sdw_slave_read_dpn(struct sdw_slave *slave,
169 struct sdw_dpn_prop *dpn, int count, int ports,
170 char *type)
171 {
172 struct fwnode_handle *node;
173 u32 bit, i = 0;
174 int nval;
175 unsigned long addr;
176 char name[40];
177
178 addr = ports;
179 /* valid ports are 1 to 14 so apply mask */
180 addr &= GENMASK(14, 1);
181
182 for_each_set_bit(bit, &addr, 32) {
183 snprintf(name, sizeof(name),
184 "mipi-sdw-dp-%d-%s-subproperties", bit, type);
185
186 dpn[i].num = bit;
187
188 node = device_get_named_child_node(&slave->dev, name);
189 if (!node) {
190 dev_err(&slave->dev, "%s dpN not found\n", name);
191 return -EIO;
192 }
193
194 fwnode_property_read_u32(node, "mipi-sdw-port-max-wordlength",
195 &dpn[i].max_word);
196 fwnode_property_read_u32(node, "mipi-sdw-port-min-wordlength",
197 &dpn[i].min_word);
198
199 nval = fwnode_property_count_u32(node, "mipi-sdw-port-wordlength-configs");
200 if (nval > 0) {
201 dpn[i].num_words = nval;
202 dpn[i].words = devm_kcalloc(&slave->dev,
203 dpn[i].num_words,
204 sizeof(*dpn[i].words),
205 GFP_KERNEL);
206 if (!dpn[i].words) {
207 fwnode_handle_put(node);
208 return -ENOMEM;
209 }
210
211 fwnode_property_read_u32_array(node,
212 "mipi-sdw-port-wordlength-configs",
213 dpn[i].words, dpn[i].num_words);
214 }
215
216 fwnode_property_read_u32(node, "mipi-sdw-data-port-type",
217 &dpn[i].type);
218
219 fwnode_property_read_u32(node,
220 "mipi-sdw-max-grouping-supported",
221 &dpn[i].max_grouping);
222
223 dpn[i].simple_ch_prep_sm = fwnode_property_read_bool(node,
224 "mipi-sdw-simplified-channelprepare-sm");
225
226 fwnode_property_read_u32(node,
227 "mipi-sdw-port-channelprepare-timeout",
228 &dpn[i].ch_prep_timeout);
229
230 fwnode_property_read_u32(node,
231 "mipi-sdw-imp-def-dpn-interrupts-supported",
232 &dpn[i].imp_def_interrupts);
233
234 fwnode_property_read_u32(node, "mipi-sdw-min-channel-number",
235 &dpn[i].min_ch);
236
237 fwnode_property_read_u32(node, "mipi-sdw-max-channel-number",
238 &dpn[i].max_ch);
239
240 nval = fwnode_property_count_u32(node, "mipi-sdw-channel-number-list");
241 if (nval > 0) {
242 dpn[i].num_channels = nval;
243 dpn[i].channels = devm_kcalloc(&slave->dev,
244 dpn[i].num_channels,
245 sizeof(*dpn[i].channels),
246 GFP_KERNEL);
247 if (!dpn[i].channels) {
248 fwnode_handle_put(node);
249 return -ENOMEM;
250 }
251
252 fwnode_property_read_u32_array(node,
253 "mipi-sdw-channel-number-list",
254 dpn[i].channels, dpn[i].num_channels);
255 }
256
257 nval = fwnode_property_count_u32(node, "mipi-sdw-channel-combination-list");
258 if (nval > 0) {
259 dpn[i].num_ch_combinations = nval;
260 dpn[i].ch_combinations = devm_kcalloc(&slave->dev,
261 dpn[i].num_ch_combinations,
262 sizeof(*dpn[i].ch_combinations),
263 GFP_KERNEL);
264 if (!dpn[i].ch_combinations) {
265 fwnode_handle_put(node);
266 return -ENOMEM;
267 }
268
269 fwnode_property_read_u32_array(node,
270 "mipi-sdw-channel-combination-list",
271 dpn[i].ch_combinations,
272 dpn[i].num_ch_combinations);
273 }
274
275 fwnode_property_read_u32(node,
276 "mipi-sdw-modes-supported", &dpn[i].modes);
277
278 fwnode_property_read_u32(node, "mipi-sdw-max-async-buffer",
279 &dpn[i].max_async_buffer);
280
281 dpn[i].block_pack_mode = fwnode_property_read_bool(node,
282 "mipi-sdw-block-packing-mode");
283
284 fwnode_property_read_u32(node, "mipi-sdw-port-encoding-type",
285 &dpn[i].port_encoding);
286
287 /* TODO: Read audio mode */
288
289 fwnode_handle_put(node);
290
291 i++;
292 }
293
294 return 0;
295 }
296
297 /**
298 * sdw_slave_read_prop() - Read Slave properties
299 * @slave: SDW Slave
300 */
sdw_slave_read_prop(struct sdw_slave * slave)301 int sdw_slave_read_prop(struct sdw_slave *slave)
302 {
303 struct sdw_slave_prop *prop = &slave->prop;
304 struct device *dev = &slave->dev;
305 struct fwnode_handle *port;
306 int nval;
307
308 device_property_read_u32(dev, "mipi-sdw-sw-interface-revision",
309 &prop->mipi_revision);
310
311 prop->wake_capable = device_property_read_bool(dev,
312 "mipi-sdw-wake-up-unavailable");
313 prop->wake_capable = !prop->wake_capable;
314
315 prop->test_mode_capable = device_property_read_bool(dev,
316 "mipi-sdw-test-mode-supported");
317
318 prop->clk_stop_mode1 = false;
319 if (device_property_read_bool(dev,
320 "mipi-sdw-clock-stop-mode1-supported"))
321 prop->clk_stop_mode1 = true;
322
323 prop->simple_clk_stop_capable = device_property_read_bool(dev,
324 "mipi-sdw-simplified-clockstopprepare-sm-supported");
325
326 device_property_read_u32(dev, "mipi-sdw-clockstopprepare-timeout",
327 &prop->clk_stop_timeout);
328
329 device_property_read_u32(dev, "mipi-sdw-slave-channelprepare-timeout",
330 &prop->ch_prep_timeout);
331
332 device_property_read_u32(dev,
333 "mipi-sdw-clockstopprepare-hard-reset-behavior",
334 &prop->reset_behave);
335
336 prop->high_PHY_capable = device_property_read_bool(dev,
337 "mipi-sdw-highPHY-capable");
338
339 prop->paging_support = device_property_read_bool(dev,
340 "mipi-sdw-paging-support");
341
342 prop->bank_delay_support = device_property_read_bool(dev,
343 "mipi-sdw-bank-delay-support");
344
345 device_property_read_u32(dev,
346 "mipi-sdw-port15-read-behavior", &prop->p15_behave);
347
348 device_property_read_u32(dev, "mipi-sdw-master-count",
349 &prop->master_count);
350
351 device_property_read_u32(dev, "mipi-sdw-source-port-list",
352 &prop->source_ports);
353
354 device_property_read_u32(dev, "mipi-sdw-sink-port-list",
355 &prop->sink_ports);
356
357 /* Read dp0 properties */
358 port = device_get_named_child_node(dev, "mipi-sdw-dp-0-subproperties");
359 if (!port) {
360 dev_dbg(dev, "DP0 node not found!!\n");
361 } else {
362 prop->dp0_prop = devm_kzalloc(&slave->dev,
363 sizeof(*prop->dp0_prop),
364 GFP_KERNEL);
365 if (!prop->dp0_prop) {
366 fwnode_handle_put(port);
367 return -ENOMEM;
368 }
369
370 sdw_slave_read_dp0(slave, port, prop->dp0_prop);
371
372 fwnode_handle_put(port);
373 }
374
375 /*
376 * Based on each DPn port, get source and sink dpn properties.
377 * Also, some ports can operate as both source or sink.
378 */
379
380 /* Allocate memory for set bits in port lists */
381 nval = hweight32(prop->source_ports);
382 prop->src_dpn_prop = devm_kcalloc(&slave->dev, nval,
383 sizeof(*prop->src_dpn_prop),
384 GFP_KERNEL);
385 if (!prop->src_dpn_prop)
386 return -ENOMEM;
387
388 /* Read dpn properties for source port(s) */
389 sdw_slave_read_dpn(slave, prop->src_dpn_prop, nval,
390 prop->source_ports, "source");
391
392 nval = hweight32(prop->sink_ports);
393 prop->sink_dpn_prop = devm_kcalloc(&slave->dev, nval,
394 sizeof(*prop->sink_dpn_prop),
395 GFP_KERNEL);
396 if (!prop->sink_dpn_prop)
397 return -ENOMEM;
398
399 /* Read dpn properties for sink port(s) */
400 sdw_slave_read_dpn(slave, prop->sink_dpn_prop, nval,
401 prop->sink_ports, "sink");
402
403 return 0;
404 }
405 EXPORT_SYMBOL(sdw_slave_read_prop);
406