ASoc: tas2783A: Use acpi init data if present

 The ACPI table has initialization data for each device
which needs to be updated to device to configure the device
correctly. This commit adds the change to read the entry
"mipi-sdca-function-initialization-table" and update the device
with the data.

Signed-off-by: Niranjan H Y <niranjan.hy@ti.com>
---
v2:
- update commit message description

Author: niranjanhyti

sound/soc/codecs/Kconfig

@@ -2103,6 +2103,7 @@ config SND_SOC_TAS2783_SDW
 	tristate "Texas Instruments TAS2783 speaker amplifier (sdw)"
 	depends on SOUNDWIRE
 	depends on EFI
+	depends on SND_SOC_SDCA
 	select REGMAP_SOUNDWIRE
 	select REGMAP_SOUNDWIRE_MBQ
 	select CRC32

sound/soc/codecs/tas2783-sdw.c

@@ -27,6 +27,7 @@
 #include <linux/soundwire/sdw.h>
 #include <linux/soundwire/sdw_registers.h>
 #include <linux/soundwire/sdw_type.h>
+#include <sound/sdca_function.h>
 #include <sound/sdw.h>
 #include <sound/soc.h>
 #include <sound/tlv.h>
@@ -40,6 +41,7 @@
 #define TAS2783_PROBE_TIMEOUT 5000
 #define TAS2783_CALI_GUID EFI_GUID(0x1f52d2a1, 0xbb3a, 0x457d, 0xbc, \
 				   0x09, 0x43, 0xa3, 0xf4, 0x31, 0x0a, 0x92)
+#define MIPI_INIT_TABLE "mipi-sdca-function-initialization-table"
 
 static const u32 tas2783_cali_reg[] = {
 	TAS2783_CAL_R0,
@@ -56,6 +58,11 @@ struct bin_header_t {
 	u32 length;
 };
 
+struct raw_init_data {
+	__le32 addr;
+	u8 val;
+} __packed;
+
 struct calibration_data {
 	u32 is_valid;
 	unsigned long read_sz;
@@ -83,6 +90,8 @@ struct tas2783_prv {
 	wait_queue_head_t fw_wait;
 	bool fw_dl_task_done;
 	bool fw_dl_success;
+	struct reg_sequence *init_data;
+	int num_init_data;
 };
 
 static const struct reg_default tas2783_reg_default[] = {
@@ -1214,9 +1223,19 @@ static s32 tas_io_init(struct device *dev, struct sdw_slave *slave)
 		dev_err(tas_dev->dev, "fw request, wait_event timeout\n");
 		ret = -EAGAIN;
 	} else {
-		ret = regmap_multi_reg_write(tas_dev->regmap, tas2783_init_seq,
-					     ARRAY_SIZE(tas2783_init_seq));
-		tas_dev->hw_init = true;
+		if (tas_dev->num_init_data > 0)
+			ret = regmap_multi_reg_write(tas_dev->regmap,
+						     tas_dev->init_data,
+						     tas_dev->num_init_data);
+		else
+			ret = regmap_multi_reg_write(tas_dev->regmap, tas2783_init_seq,
+						     ARRAY_SIZE(tas2783_init_seq));
+
+		if (ret)
+			dev_err(tas_dev->dev,
+				"init writes failed, err=%d", ret);
+		else
+			tas_dev->hw_init = true;
 	}
 
 	return ret;
@@ -1260,6 +1279,73 @@ static void tas_remove(struct tas2783_prv *tas_dev)
 	snd_soc_unregister_component(tas_dev->dev);
 }
 
+static s32 tas_get_smartamp_init_data(struct sdw_slave *peripheral,
+				      struct tas2783_prv *tas_dev)
+{
+	int num_init_data, i;
+	struct device *dev;
+	struct reg_sequence *init_data;
+	struct sdca_device_data *sdca_data;
+	struct sdca_function_desc *function;
+	struct raw_init_data *raw __free(kfree) = NULL;
+
+	dev = &peripheral->dev;
+	sdca_data = &peripheral->sdca_data;
+
+	dev_dbg(dev, "number of functions found %d",
+		sdca_data->num_functions);
+
+	if (sdca_data->num_functions <= 0)
+		return -EINVAL;
+
+	/* look for smartamp function */
+	for (i = 0; i < sdca_data->num_functions; i++) {
+		if (sdca_data->function[i].type ==
+			SDCA_FUNCTION_TYPE_SMART_AMP)
+			break;
+	}
+	if (i == sdca_data->num_functions)
+		return -EINVAL;
+
+	function = &sdca_data->function[i];
+	num_init_data = fwnode_property_count_u8(function->node,
+						 MIPI_INIT_TABLE);
+	if (num_init_data <= 0) {
+		dev_dbg(dev, "error reading init table for tas2783 err=%d",
+			num_init_data);
+		return num_init_data;
+	}
+
+	if (num_init_data % sizeof(*raw) != 0) {
+		dev_dbg(dev, "%s should be integer multiple of %lu",
+			MIPI_INIT_TABLE, sizeof(*raw));
+		return -EINVAL;
+	}
+
+	raw = kzalloc(num_init_data, GFP_KERNEL);
+	if (!raw)
+		return -ENOMEM;
+
+	fwnode_property_read_u8_array(function->node, MIPI_INIT_TABLE,
+				      (u8 *)raw, num_init_data);
+
+	num_init_data /= sizeof(*raw);
+	init_data = devm_kcalloc(dev, num_init_data, sizeof(*init_data),
+				 GFP_KERNEL);
+	if (!init_data)
+		return -ENOMEM;
+
+	for (i = 0; i < num_init_data; i++) {
+		init_data[i].reg = le32_to_cpu(raw[i].addr);
+		init_data[i].def = raw[i].val;
+	}
+
+	tas_dev->num_init_data = num_init_data;
+	tas_dev->init_data = init_data;
+
+	return 0;
+}
+
 static s32 tas_sdw_probe(struct sdw_slave *peripheral,
 			 const struct sdw_device_id *id)
 {
@@ -1272,6 +1358,8 @@ static s32 tas_sdw_probe(struct sdw_slave *peripheral,
 		return dev_err_probe(dev, -ENOMEM,
 				     "Failed devm_kzalloc");
 
+	tas_get_smartamp_init_data(peripheral, tas_dev);
+
 	tas_dev->dev = dev;
 	tas_dev->sdw_peripheral = peripheral;
 	tas_dev->hw_init = false;
@@ -1325,6 +1413,7 @@ static struct sdw_driver tas_sdw_driver = {
 };
 module_sdw_driver(tas_sdw_driver);
 
+MODULE_IMPORT_NS("SND_SOC_SDCA");
 MODULE_AUTHOR("Texas Instruments Inc.");
 MODULE_DESCRIPTION("ASoC TAS2783 SoundWire Driver");
 MODULE_LICENSE("GPL");