Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit b396ebca authored by Richard Fitzgerald's avatar Richard Fitzgerald Committed by Mark Brown
Browse files

ASoC: wm_adsp: factor out getting base register for a control



The lookup of the base register corresponding to a control is
duplicated in read and write so factor it out into a separate
function.

Signed-off-by: default avatarRichard Fitzgerald <rf@opensource.wolfsonmicro.com>
Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent a23ebba8
Loading
Loading
Loading
Loading
+24 −22
Original line number Original line Diff line number Diff line
@@ -756,6 +756,24 @@ static inline struct wm_coeff_ctl *bytes_ext_to_ctl(struct soc_bytes_ext *ext)
	return container_of(ext, struct wm_coeff_ctl, bytes_ext);
	return container_of(ext, struct wm_coeff_ctl, bytes_ext);
}
}


static int wm_coeff_base_reg(struct wm_coeff_ctl *ctl, unsigned int *reg)
{
	const struct wm_adsp_alg_region *alg_region = &ctl->alg_region;
	struct wm_adsp *dsp = ctl->dsp;
	const struct wm_adsp_region *mem;

	mem = wm_adsp_find_region(dsp, alg_region->type);
	if (!mem) {
		adsp_err(dsp, "No base for region %x\n",
			 alg_region->type);
		return -EINVAL;
	}

	*reg = wm_adsp_region_to_reg(mem, ctl->alg_region.base + ctl->offset);

	return 0;
}

static int wm_coeff_info(struct snd_kcontrol *kctl,
static int wm_coeff_info(struct snd_kcontrol *kctl,
			 struct snd_ctl_elem_info *uinfo)
			 struct snd_ctl_elem_info *uinfo)
{
{
@@ -843,22 +861,14 @@ static int wm_coeff_write_acked_control(struct wm_coeff_ctl *ctl,
static int wm_coeff_write_control(struct wm_coeff_ctl *ctl,
static int wm_coeff_write_control(struct wm_coeff_ctl *ctl,
				  const void *buf, size_t len)
				  const void *buf, size_t len)
{
{
	struct wm_adsp_alg_region *alg_region = &ctl->alg_region;
	const struct wm_adsp_region *mem;
	struct wm_adsp *dsp = ctl->dsp;
	struct wm_adsp *dsp = ctl->dsp;
	void *scratch;
	void *scratch;
	int ret;
	int ret;
	unsigned int reg;
	unsigned int reg;


	mem = wm_adsp_find_region(dsp, alg_region->type);
	ret = wm_coeff_base_reg(ctl, &reg);
	if (!mem) {
	if (ret)
		adsp_err(dsp, "No base for region %x\n",
		return ret;
			 alg_region->type);
		return -EINVAL;
	}

	reg = ctl->alg_region.base + ctl->offset;
	reg = wm_adsp_region_to_reg(mem, reg);


	scratch = kmemdup(buf, len, GFP_KERNEL | GFP_DMA);
	scratch = kmemdup(buf, len, GFP_KERNEL | GFP_DMA);
	if (!scratch)
	if (!scratch)
@@ -951,22 +961,14 @@ static int wm_coeff_put_acked(struct snd_kcontrol *kctl,
static int wm_coeff_read_control(struct wm_coeff_ctl *ctl,
static int wm_coeff_read_control(struct wm_coeff_ctl *ctl,
				 void *buf, size_t len)
				 void *buf, size_t len)
{
{
	struct wm_adsp_alg_region *alg_region = &ctl->alg_region;
	const struct wm_adsp_region *mem;
	struct wm_adsp *dsp = ctl->dsp;
	struct wm_adsp *dsp = ctl->dsp;
	void *scratch;
	void *scratch;
	int ret;
	int ret;
	unsigned int reg;
	unsigned int reg;


	mem = wm_adsp_find_region(dsp, alg_region->type);
	ret = wm_coeff_base_reg(ctl, &reg);
	if (!mem) {
	if (ret)
		adsp_err(dsp, "No base for region %x\n",
		return ret;
			 alg_region->type);
		return -EINVAL;
	}

	reg = ctl->alg_region.base + ctl->offset;
	reg = wm_adsp_region_to_reg(mem, reg);


	scratch = kmalloc(len, GFP_KERNEL | GFP_DMA);
	scratch = kmalloc(len, GFP_KERNEL | GFP_DMA);
	if (!scratch)
	if (!scratch)