// 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
  ", 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)

  			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)
  			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);

  
  	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
  ", 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)
  				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)

  				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)
  				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 */
  
  		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!!
  ");
  	} else {

  		prop->dp0_prop = devm_kzalloc(&slave->dev,

  					      sizeof(*prop->dp0_prop),
  					      GFP_KERNEL);

  		if (!prop->dp0_prop)
  			return -ENOMEM;
  
  		sdw_slave_read_dp0(slave, port, prop->dp0_prop);

  	}
  
  	/*
  	 * 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);