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 */ 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 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 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 */ 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