Commit 222cbe17 authored by Charles Keepax's avatar Charles Keepax Committed by Mark Brown
Browse files

ASoC: SDCA: Factor out helper to process Control defaults



The indentation of the loop processing writing out SDCA Control default
values is getting a bit large. Reduce indentation and make adding more
functionality easier by factoring out the Control handling into a helper
function.

Tested-by: default avatarBard Liao <yung-chuan.liao@linux.intel.com>
Reviewed-by: default avatarMaciej Strozek <mstrozek@opensource.cirrus.com>
Reviewed-by: default avatarPeter Ujfalusi <peter.ujfalusi@linux.intel.com>
Tested-by: default avatarRichard Fitzgerald <rf@opensource.cirrus.com>
Signed-off-by: default avatarCharles Keepax <ckeepax@opensource.cirrus.com>
Link: https://patch.msgid.link/20251120153023.2105663-9-ckeepax@opensource.cirrus.com


Reviewed-by: default avatarVinod Koul <vkoul@kernel.org>
Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent fb62da31
Loading
Loading
Loading
Loading
+39 −22
Original line number Diff line number Diff line
@@ -275,6 +275,40 @@ int sdca_regmap_populate_constants(struct device *dev,
}
EXPORT_SYMBOL_NS(sdca_regmap_populate_constants, "SND_SOC_SDCA");

static int populate_control_defaults(struct device *dev, struct regmap *regmap,
				     struct sdca_function_data *function,
				     struct sdca_entity *entity,
				     struct sdca_control *control)
{
	int i, ret;
	int cn;

	if (control->mode == SDCA_ACCESS_MODE_DC)
		return 0;

	if (!control->has_default && !control->has_fixed)
		return 0;

	i = 0;
	for_each_set_bit(cn, (unsigned long *)&control->cn_list,
			 BITS_PER_TYPE(control->cn_list)) {
		unsigned int reg;

		reg = SDW_SDCA_CTL(function->desc->adr, entity->id, control->sel, cn);

		ret = regmap_write(regmap, reg, control->values[i]);
		if (ret) {
			dev_err(dev, "Failed to write default %#x: %d\n",
				reg, ret);
			return ret;
		}

		i++;
	}

	return 0;
}

/**
 * sdca_regmap_write_defaults - write out DisCo defaults to device
 * @dev: Pointer to the device.
@@ -290,7 +324,7 @@ EXPORT_SYMBOL_NS(sdca_regmap_populate_constants, "SND_SOC_SDCA");
int sdca_regmap_write_defaults(struct device *dev, struct regmap *regmap,
			       struct sdca_function_data *function)
{
	int i, j, k;
	int i, j;
	int ret;

	for (i = 0; i < function->num_entities; i++) {
@@ -298,28 +332,11 @@ int sdca_regmap_write_defaults(struct device *dev, struct regmap *regmap,

		for (j = 0; j < entity->num_controls; j++) {
			struct sdca_control *control = &entity->controls[j];
			int cn;

			if (control->mode == SDCA_ACCESS_MODE_DC)
				continue;

			if (!control->has_default && !control->has_fixed)
				continue;

			k = 0;
			for_each_set_bit(cn, (unsigned long *)&control->cn_list,
					 BITS_PER_TYPE(control->cn_list)) {
				unsigned int reg;

				reg = SDW_SDCA_CTL(function->desc->adr, entity->id,
						   control->sel, cn);

				ret = regmap_write(regmap, reg, control->values[k]);
			ret = populate_control_defaults(dev, regmap, function,
							entity, control);
			if (ret)
				return ret;

				k++;
			}
		}
	}