Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

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