|  | // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause) | 
|  | // Copyright(c) 2015-17 Intel Corporation. | 
|  |  | 
|  | /* | 
|  | * MIPI Discovery And Configuration (DisCo) Specification for SoundWire | 
|  | * specifies properties to be implemented for SoundWire Masters and Slaves. | 
|  | * The DisCo spec doesn't mandate these properties. However, SDW bus cannot | 
|  | * work without knowing these values. | 
|  | * | 
|  | * The helper functions read the Master and Slave properties. Implementers | 
|  | * of Master or Slave drivers can use any of the below three mechanisms: | 
|  | *    a) Use these APIs here as .read_prop() callback for Master and Slave | 
|  | *    b) Implement own methods and set those as .read_prop(), but invoke | 
|  | *    APIs in this file for generic read and override the values with | 
|  | *    platform specific data | 
|  | *    c) Implement ones own methods which do not use anything provided | 
|  | *    here | 
|  | */ | 
|  |  | 
|  | #include <linux/device.h> | 
|  | #include <linux/property.h> | 
|  | #include <linux/mod_devicetable.h> | 
|  | #include <linux/soundwire/sdw.h> | 
|  | #include "bus.h" | 
|  |  | 
|  | /** | 
|  | * sdw_master_read_prop() - Read Master properties | 
|  | * @bus: SDW bus instance | 
|  | */ | 
|  | int sdw_master_read_prop(struct sdw_bus *bus) | 
|  | { | 
|  | struct sdw_master_prop *prop = &bus->prop; | 
|  | struct fwnode_handle *link; | 
|  | char name[32]; | 
|  | int nval, i; | 
|  |  | 
|  | device_property_read_u32(bus->dev, | 
|  | "mipi-sdw-sw-interface-revision", | 
|  | &prop->revision); | 
|  |  | 
|  | /* Find master handle */ | 
|  | snprintf(name, sizeof(name), | 
|  | "mipi-sdw-link-%d-subproperties", bus->link_id); | 
|  |  | 
|  | link = device_get_named_child_node(bus->dev, name); | 
|  | if (!link) { | 
|  | dev_err(bus->dev, "Master node %s not found\n", name); | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | if (fwnode_property_read_bool(link, | 
|  | "mipi-sdw-clock-stop-mode0-supported")) | 
|  | prop->clk_stop_modes |= BIT(SDW_CLK_STOP_MODE0); | 
|  |  | 
|  | if (fwnode_property_read_bool(link, | 
|  | "mipi-sdw-clock-stop-mode1-supported")) | 
|  | prop->clk_stop_modes |= BIT(SDW_CLK_STOP_MODE1); | 
|  |  | 
|  | fwnode_property_read_u32(link, | 
|  | "mipi-sdw-max-clock-frequency", | 
|  | &prop->max_clk_freq); | 
|  |  | 
|  | nval = fwnode_property_count_u32(link, "mipi-sdw-clock-frequencies-supported"); | 
|  | if (nval > 0) { | 
|  | prop->num_clk_freq = nval; | 
|  | prop->clk_freq = devm_kcalloc(bus->dev, prop->num_clk_freq, | 
|  | sizeof(*prop->clk_freq), | 
|  | GFP_KERNEL); | 
|  | if (!prop->clk_freq) { | 
|  | fwnode_handle_put(link); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32_array(link, | 
|  | "mipi-sdw-clock-frequencies-supported", | 
|  | prop->clk_freq, prop->num_clk_freq); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Check the frequencies supported. If FW doesn't provide max | 
|  | * freq, then populate here by checking values. | 
|  | */ | 
|  | if (!prop->max_clk_freq && prop->clk_freq) { | 
|  | prop->max_clk_freq = prop->clk_freq[0]; | 
|  | for (i = 1; i < prop->num_clk_freq; i++) { | 
|  | if (prop->clk_freq[i] > prop->max_clk_freq) | 
|  | prop->max_clk_freq = prop->clk_freq[i]; | 
|  | } | 
|  | } | 
|  |  | 
|  | nval = fwnode_property_count_u32(link, "mipi-sdw-supported-clock-gears"); | 
|  | if (nval > 0) { | 
|  | prop->num_clk_gears = nval; | 
|  | prop->clk_gears = devm_kcalloc(bus->dev, prop->num_clk_gears, | 
|  | sizeof(*prop->clk_gears), | 
|  | GFP_KERNEL); | 
|  | if (!prop->clk_gears) { | 
|  | fwnode_handle_put(link); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32_array(link, | 
|  | "mipi-sdw-supported-clock-gears", | 
|  | prop->clk_gears, | 
|  | prop->num_clk_gears); | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32(link, "mipi-sdw-default-frame-rate", | 
|  | &prop->default_frame_rate); | 
|  |  | 
|  | fwnode_property_read_u32(link, "mipi-sdw-default-frame-row-size", | 
|  | &prop->default_row); | 
|  |  | 
|  | fwnode_property_read_u32(link, "mipi-sdw-default-frame-col-size", | 
|  | &prop->default_col); | 
|  |  | 
|  | prop->dynamic_frame =  fwnode_property_read_bool(link, | 
|  | "mipi-sdw-dynamic-frame-shape"); | 
|  |  | 
|  | fwnode_property_read_u32(link, "mipi-sdw-command-error-threshold", | 
|  | &prop->err_threshold); | 
|  |  | 
|  | fwnode_handle_put(link); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL(sdw_master_read_prop); | 
|  |  | 
|  | static int sdw_slave_read_dp0(struct sdw_slave *slave, | 
|  | struct fwnode_handle *port, | 
|  | struct sdw_dp0_prop *dp0) | 
|  | { | 
|  | int nval; | 
|  |  | 
|  | fwnode_property_read_u32(port, "mipi-sdw-port-max-wordlength", | 
|  | &dp0->max_word); | 
|  |  | 
|  | fwnode_property_read_u32(port, "mipi-sdw-port-min-wordlength", | 
|  | &dp0->min_word); | 
|  |  | 
|  | nval = fwnode_property_count_u32(port, "mipi-sdw-port-wordlength-configs"); | 
|  | if (nval > 0) { | 
|  |  | 
|  | dp0->num_words = nval; | 
|  | dp0->words = devm_kcalloc(&slave->dev, | 
|  | dp0->num_words, sizeof(*dp0->words), | 
|  | GFP_KERNEL); | 
|  | if (!dp0->words) | 
|  | return -ENOMEM; | 
|  |  | 
|  | fwnode_property_read_u32_array(port, | 
|  | "mipi-sdw-port-wordlength-configs", | 
|  | dp0->words, dp0->num_words); | 
|  | } | 
|  |  | 
|  | dp0->BRA_flow_controlled = fwnode_property_read_bool(port, | 
|  | "mipi-sdw-bra-flow-controlled"); | 
|  |  | 
|  | dp0->simple_ch_prep_sm = fwnode_property_read_bool(port, | 
|  | "mipi-sdw-simplified-channel-prepare-sm"); | 
|  |  | 
|  | dp0->imp_def_interrupts = fwnode_property_read_bool(port, | 
|  | "mipi-sdw-imp-def-dp0-interrupts-supported"); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int sdw_slave_read_dpn(struct sdw_slave *slave, | 
|  | struct sdw_dpn_prop *dpn, int count, int ports, | 
|  | char *type) | 
|  | { | 
|  | struct fwnode_handle *node; | 
|  | u32 bit, i = 0; | 
|  | int nval; | 
|  | unsigned long addr; | 
|  | char name[40]; | 
|  |  | 
|  | addr = ports; | 
|  | /* valid ports are 1 to 14 so apply mask */ | 
|  | addr &= GENMASK(14, 1); | 
|  |  | 
|  | for_each_set_bit(bit, &addr, 32) { | 
|  | snprintf(name, sizeof(name), | 
|  | "mipi-sdw-dp-%d-%s-subproperties", bit, type); | 
|  |  | 
|  | dpn[i].num = bit; | 
|  |  | 
|  | node = device_get_named_child_node(&slave->dev, name); | 
|  | if (!node) { | 
|  | dev_err(&slave->dev, "%s dpN not found\n", name); | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32(node, "mipi-sdw-port-max-wordlength", | 
|  | &dpn[i].max_word); | 
|  | fwnode_property_read_u32(node, "mipi-sdw-port-min-wordlength", | 
|  | &dpn[i].min_word); | 
|  |  | 
|  | nval = fwnode_property_count_u32(node, "mipi-sdw-port-wordlength-configs"); | 
|  | if (nval > 0) { | 
|  | dpn[i].num_words = nval; | 
|  | dpn[i].words = devm_kcalloc(&slave->dev, | 
|  | dpn[i].num_words, | 
|  | sizeof(*dpn[i].words), | 
|  | GFP_KERNEL); | 
|  | if (!dpn[i].words) { | 
|  | fwnode_handle_put(node); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32_array(node, | 
|  | "mipi-sdw-port-wordlength-configs", | 
|  | dpn[i].words, dpn[i].num_words); | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32(node, "mipi-sdw-data-port-type", | 
|  | &dpn[i].type); | 
|  |  | 
|  | fwnode_property_read_u32(node, | 
|  | "mipi-sdw-max-grouping-supported", | 
|  | &dpn[i].max_grouping); | 
|  |  | 
|  | dpn[i].simple_ch_prep_sm = fwnode_property_read_bool(node, | 
|  | "mipi-sdw-simplified-channelprepare-sm"); | 
|  |  | 
|  | fwnode_property_read_u32(node, | 
|  | "mipi-sdw-port-channelprepare-timeout", | 
|  | &dpn[i].ch_prep_timeout); | 
|  |  | 
|  | fwnode_property_read_u32(node, | 
|  | "mipi-sdw-imp-def-dpn-interrupts-supported", | 
|  | &dpn[i].imp_def_interrupts); | 
|  |  | 
|  | fwnode_property_read_u32(node, "mipi-sdw-min-channel-number", | 
|  | &dpn[i].min_ch); | 
|  |  | 
|  | fwnode_property_read_u32(node, "mipi-sdw-max-channel-number", | 
|  | &dpn[i].max_ch); | 
|  |  | 
|  | nval = fwnode_property_count_u32(node, "mipi-sdw-channel-number-list"); | 
|  | if (nval > 0) { | 
|  | dpn[i].num_channels = nval; | 
|  | dpn[i].channels = devm_kcalloc(&slave->dev, | 
|  | dpn[i].num_channels, | 
|  | sizeof(*dpn[i].channels), | 
|  | GFP_KERNEL); | 
|  | if (!dpn[i].channels) { | 
|  | fwnode_handle_put(node); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32_array(node, | 
|  | "mipi-sdw-channel-number-list", | 
|  | dpn[i].channels, dpn[i].num_channels); | 
|  | } | 
|  |  | 
|  | nval = fwnode_property_count_u32(node, "mipi-sdw-channel-combination-list"); | 
|  | if (nval > 0) { | 
|  | dpn[i].num_ch_combinations = nval; | 
|  | dpn[i].ch_combinations = devm_kcalloc(&slave->dev, | 
|  | dpn[i].num_ch_combinations, | 
|  | sizeof(*dpn[i].ch_combinations), | 
|  | GFP_KERNEL); | 
|  | if (!dpn[i].ch_combinations) { | 
|  | fwnode_handle_put(node); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32_array(node, | 
|  | "mipi-sdw-channel-combination-list", | 
|  | dpn[i].ch_combinations, | 
|  | dpn[i].num_ch_combinations); | 
|  | } | 
|  |  | 
|  | fwnode_property_read_u32(node, | 
|  | "mipi-sdw-modes-supported", &dpn[i].modes); | 
|  |  | 
|  | fwnode_property_read_u32(node, "mipi-sdw-max-async-buffer", | 
|  | &dpn[i].max_async_buffer); | 
|  |  | 
|  | dpn[i].block_pack_mode = fwnode_property_read_bool(node, | 
|  | "mipi-sdw-block-packing-mode"); | 
|  |  | 
|  | fwnode_property_read_u32(node, "mipi-sdw-port-encoding-type", | 
|  | &dpn[i].port_encoding); | 
|  |  | 
|  | /* TODO: Read audio mode */ | 
|  |  | 
|  | fwnode_handle_put(node); | 
|  |  | 
|  | i++; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * sdw_slave_read_prop() - Read Slave properties | 
|  | * @slave: SDW Slave | 
|  | */ | 
|  | int sdw_slave_read_prop(struct sdw_slave *slave) | 
|  | { | 
|  | struct sdw_slave_prop *prop = &slave->prop; | 
|  | struct device *dev = &slave->dev; | 
|  | struct fwnode_handle *port; | 
|  | int nval; | 
|  |  | 
|  | device_property_read_u32(dev, "mipi-sdw-sw-interface-revision", | 
|  | &prop->mipi_revision); | 
|  |  | 
|  | prop->wake_capable = device_property_read_bool(dev, | 
|  | "mipi-sdw-wake-up-unavailable"); | 
|  | prop->wake_capable = !prop->wake_capable; | 
|  |  | 
|  | prop->test_mode_capable = device_property_read_bool(dev, | 
|  | "mipi-sdw-test-mode-supported"); | 
|  |  | 
|  | prop->clk_stop_mode1 = false; | 
|  | if (device_property_read_bool(dev, | 
|  | "mipi-sdw-clock-stop-mode1-supported")) | 
|  | prop->clk_stop_mode1 = true; | 
|  |  | 
|  | prop->simple_clk_stop_capable = device_property_read_bool(dev, | 
|  | "mipi-sdw-simplified-clockstopprepare-sm-supported"); | 
|  |  | 
|  | device_property_read_u32(dev, "mipi-sdw-clockstopprepare-timeout", | 
|  | &prop->clk_stop_timeout); | 
|  |  | 
|  | device_property_read_u32(dev, "mipi-sdw-slave-channelprepare-timeout", | 
|  | &prop->ch_prep_timeout); | 
|  |  | 
|  | device_property_read_u32(dev, | 
|  | "mipi-sdw-clockstopprepare-hard-reset-behavior", | 
|  | &prop->reset_behave); | 
|  |  | 
|  | prop->high_PHY_capable = device_property_read_bool(dev, | 
|  | "mipi-sdw-highPHY-capable"); | 
|  |  | 
|  | prop->paging_support = device_property_read_bool(dev, | 
|  | "mipi-sdw-paging-support"); | 
|  |  | 
|  | prop->bank_delay_support = device_property_read_bool(dev, | 
|  | "mipi-sdw-bank-delay-support"); | 
|  |  | 
|  | device_property_read_u32(dev, | 
|  | "mipi-sdw-port15-read-behavior", &prop->p15_behave); | 
|  |  | 
|  | device_property_read_u32(dev, "mipi-sdw-master-count", | 
|  | &prop->master_count); | 
|  |  | 
|  | device_property_read_u32(dev, "mipi-sdw-source-port-list", | 
|  | &prop->source_ports); | 
|  |  | 
|  | device_property_read_u32(dev, "mipi-sdw-sink-port-list", | 
|  | &prop->sink_ports); | 
|  |  | 
|  | /* Read dp0 properties */ | 
|  | port = device_get_named_child_node(dev, "mipi-sdw-dp-0-subproperties"); | 
|  | if (!port) { | 
|  | dev_dbg(dev, "DP0 node not found!!\n"); | 
|  | } else { | 
|  | prop->dp0_prop = devm_kzalloc(&slave->dev, | 
|  | sizeof(*prop->dp0_prop), | 
|  | GFP_KERNEL); | 
|  | if (!prop->dp0_prop) { | 
|  | fwnode_handle_put(port); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | sdw_slave_read_dp0(slave, port, prop->dp0_prop); | 
|  |  | 
|  | fwnode_handle_put(port); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Based on each DPn port, get source and sink dpn properties. | 
|  | * Also, some ports can operate as both source or sink. | 
|  | */ | 
|  |  | 
|  | /* Allocate memory for set bits in port lists */ | 
|  | nval = hweight32(prop->source_ports); | 
|  | prop->src_dpn_prop = devm_kcalloc(&slave->dev, nval, | 
|  | sizeof(*prop->src_dpn_prop), | 
|  | GFP_KERNEL); | 
|  | if (!prop->src_dpn_prop) | 
|  | return -ENOMEM; | 
|  |  | 
|  | /* Read dpn properties for source port(s) */ | 
|  | sdw_slave_read_dpn(slave, prop->src_dpn_prop, nval, | 
|  | prop->source_ports, "source"); | 
|  |  | 
|  | nval = hweight32(prop->sink_ports); | 
|  | prop->sink_dpn_prop = devm_kcalloc(&slave->dev, nval, | 
|  | sizeof(*prop->sink_dpn_prop), | 
|  | GFP_KERNEL); | 
|  | if (!prop->sink_dpn_prop) | 
|  | return -ENOMEM; | 
|  |  | 
|  | /* Read dpn properties for sink port(s) */ | 
|  | sdw_slave_read_dpn(slave, prop->sink_dpn_prop, nval, | 
|  | prop->sink_ports, "sink"); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL(sdw_slave_read_prop); |