406 lines · c
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 SoundWire6 * specifies properties to be implemented for SoundWire Masters and Slaves.7 * The DisCo spec doesn't mandate these properties. However, SDW bus cannot8 * work without knowing these values.9 *10 * The helper functions read the Master and Slave properties. Implementers11 * 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 Slave13 * b) Implement own methods and set those as .read_prop(), but invoke14 * APIs in this file for generic read and override the values with15 * platform specific data16 * c) Implement ones own methods which do not use anything provided17 * here18 */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 properties28 * @bus: SDW bus instance29 */30int 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 max81 * 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}127EXPORT_SYMBOL(sdw_master_read_prop);128 129static 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 168static 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 properties299 * @slave: SDW Slave300 */301int 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}405EXPORT_SYMBOL(sdw_slave_read_prop);406