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

Commit e562a364 authored by Laxminath Kasam's avatar Laxminath Kasam
Browse files

asoc: bolero: Add support for bolero codec 



Add bolero driver to provide interface to all
macros and represent as a single codec to ASoC
framework.

Change-Id: Ie4cd3b9422ff9691dd37b40fc243573d7536860c
Signed-off-by: default avatarLaxminath Kasam <lkasam@codeaurora.org>
parent 743a507e

asoc/codecs/bolero/bolero_cdc.c

0 → 100644
+445 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2018, The Linux Foundation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 and

 * only version 2 as published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 */



#include <linux/of_platform.h>

#include <linux/module.h>

#include <linux/io.h>

#include <linux/init.h>

#include <linux/platform_device.h>

#include <linux/printk.h>

#include <linux/delay.h>

#include <linux/kernel.h>



#include "bolero_cdc.h"

#include "internal.h"



static struct snd_soc_codec_driver bolero;



static void bolero_ahb_write_device(char __iomem *io_base,

				    u16 reg, u8 value)

{

	u32 temp = (u32)(value) & 0x000000FF;



	iowrite32(temp, io_base + reg);

}



static void bolero_ahb_read_device(char __iomem *io_base,

				   u16 reg, u8 *value)

{

	u32 temp;



	temp = ioread32(io_base + reg);

	*value = (u8)temp;

}



static int __bolero_reg_read(struct bolero_priv *priv,

			     u16 macro_id, u16 reg, u8 *val)

{

	int ret = -EINVAL;



	if (!priv->macro_params[macro_id].mclk_fn) {

		dev_dbg_ratelimited(priv->dev,

			"%s: mclk_fn not init for macro-id-%d\n",

			__func__, macro_id);

		return ret;

	}

	ret = priv->macro_params[macro_id].mclk_fn(

			priv->macro_params[macro_id].dev, true);

	if (ret) {

		dev_dbg_ratelimited(priv->dev,

				"%s: clock enable failed\n", __func__);

		return ret;

	}

	bolero_ahb_read_device(

		priv->macro_params[macro_id].io_base, reg, val);

	priv->macro_params[macro_id].mclk_fn(

			priv->macro_params[macro_id].dev, false);

	return ret;

}



static int __bolero_reg_write(struct bolero_priv *priv,

			      u16 macro_id, u16 reg, u8 val)

{

	int ret = -EINVAL;



	if (!priv->macro_params[macro_id].mclk_fn) {

		dev_dbg_ratelimited(priv->dev,

			"%s: mclk_fn not init for macro-id-%d\n",

			__func__, macro_id);

		return ret;

	}

	ret = priv->macro_params[macro_id].mclk_fn(

			priv->macro_params[macro_id].dev, true);

	if (ret) {

		dev_dbg_ratelimited(priv->dev,

				"%s: clock enable failed\n", __func__);

		return ret;

	}

	bolero_ahb_write_device(

		priv->macro_params[macro_id].io_base, reg, val);

	priv->macro_params[macro_id].mclk_fn(

			priv->macro_params[macro_id].dev, false);

	return ret;

}



static bool bolero_is_valid_macro_dev(struct device *dev)

{

	if (of_device_is_compatible(dev->parent->of_node, "qcom,bolero-codec"))

		return true;



	return false;

}



static bool bolero_is_valid_codec_dev(struct device *dev)

{

	if (of_device_is_compatible(dev->of_node, "qcom,bolero-codec"))

		return true;



	return false;

}



/**

 * bolero_get_device_ptr - Get child or macro device ptr

 *

 * @dev: bolero device ptr.

 * @macro_id: ID of macro calling this API.

 *

 * Returns dev ptr on success or NULL on error.

 */

struct device *bolero_get_device_ptr(struct device *dev, u16 macro_id)

{

	struct bolero_priv *priv;



	if (!dev) {

		pr_err("%s: dev is null\n", __func__);

		return NULL;

	}



	if (!bolero_is_valid_codec_dev(dev)) {

		pr_err("%s: invalid codec\n", __func__);

		return NULL;

	}

	priv = dev_get_drvdata(dev);

	if (!priv || (macro_id >= MAX_MACRO)) {

		dev_err(dev, "%s: priv is null or invalid macro\n", __func__);

		return NULL;

	}



	return priv->macro_params[macro_id].dev;

}

EXPORT_SYMBOL(bolero_get_device_ptr);



static int bolero_copy_dais_from_macro(struct bolero_priv *priv)

{

	struct snd_soc_dai_driver *dai_ptr;

	u16 macro_idx;



	/* memcpy into bolero_dais all macro dais */

	if (!priv->bolero_dais)

		priv->bolero_dais = devm_kzalloc(priv->dev,

						priv->num_dais *

						sizeof(

						struct snd_soc_dai_driver),

						GFP_KERNEL);

	if (!priv->bolero_dais)

		return -ENOMEM;



	dai_ptr = priv->bolero_dais;



	for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {

		if (priv->macro_params[macro_idx].dai_ptr) {

			memcpy(dai_ptr,

			       priv->macro_params[macro_idx].dai_ptr,

			       priv->macro_params[macro_idx].num_dais *

			       sizeof(struct snd_soc_dai_driver));

			dai_ptr += priv->macro_params[macro_idx].num_dais;

		}

	}

	return 0;

}



/**

 * bolero_register_macro - Registers macro to bolero

 *

 * @dev: macro device ptr.

 * @macro_id: ID of macro calling this API.

 * @ops: macro params to register.

 *

 * Returns 0 on success or -EINVAL on error.

 */

int bolero_register_macro(struct device *dev, u16 macro_id,

			  struct macro_ops *ops)

{

	struct bolero_priv *priv;

	int ret = -EINVAL;



	if (!dev || !ops) {

		pr_err("%s: dev or ops is null\n", __func__);

		return -EINVAL;

	}

	if (!bolero_is_valid_macro_dev(dev)) {

		dev_err(dev, "%s: child device for macro:%d not added yet\n",

			__func__, macro_id);

		return -EINVAL;

	}

	priv = dev_get_drvdata(dev->parent);

	if (!priv || (macro_id >= MAX_MACRO)) {

		dev_err(dev, "%s: priv is null or invalid macro\n", __func__);

		return -EINVAL;

	}



	priv->macro_params[macro_id].init = ops->init;

	priv->macro_params[macro_id].exit = ops->exit;

	priv->macro_params[macro_id].io_base = ops->io_base;

	priv->macro_params[macro_id].num_dais = ops->num_dais;

	priv->macro_params[macro_id].dai_ptr = ops->dai_ptr;

	priv->macro_params[macro_id].mclk_fn = ops->mclk_fn;

	priv->macro_params[macro_id].dev = dev;

	priv->num_dais += ops->num_dais;

	priv->num_macros_registered++;

	priv->macros_supported[macro_id] = true;



	if (priv->num_macros_registered == priv->child_num) {

		ret = bolero_copy_dais_from_macro(priv);

		if (ret < 0) {

			dev_err(dev, "%s: copy_dais failed\n", __func__);

			return ret;

		}

		ret = snd_soc_register_codec(dev->parent, &bolero,

				priv->bolero_dais, priv->num_dais);

		if (ret < 0) {

			dev_err(dev, "%s: register codec failed\n", __func__);

			return ret;

		}

	}

	return 0;

}

EXPORT_SYMBOL(bolero_register_macro);



/**

 * bolero_unregister_macro - De-Register macro from bolero

 *

 * @dev: macro device ptr.

 * @macro_id: ID of macro calling this API.

 *

 */

void bolero_unregister_macro(struct device *dev, u16 macro_id)

{

	struct bolero_priv *priv;



	if (!dev) {

		pr_err("%s: dev is null\n", __func__);

		return;

	}

	if (!bolero_is_valid_macro_dev(dev)) {

		dev_err(dev, "%s: macro:%d not in valid registered macro-list\n",

			__func__, macro_id);

		return;

	}

	priv = dev_get_drvdata(dev->parent);

	if (!priv || (macro_id >= MAX_MACRO)) {

		dev_err(dev, "%s: priv is null or invalid macro\n", __func__);

		return;

	}



	priv->macro_params[macro_id].init = NULL;

	priv->macro_params[macro_id].num_dais = 0;

	priv->macro_params[macro_id].dai_ptr = NULL;

	priv->macro_params[macro_id].mclk_fn = NULL;

	priv->macro_params[macro_id].dev = NULL;

	priv->num_dais -= priv->macro_params[macro_id].num_dais;

	priv->num_macros_registered--;



	/* UNREGISTER CODEC HERE */

	if (priv->child_num - 1 == priv->num_macros_registered)

		snd_soc_unregister_codec(dev->parent);

}

EXPORT_SYMBOL(bolero_unregister_macro);



static int bolero_soc_codec_probe(struct snd_soc_codec *codec)

{

	struct bolero_priv *priv = dev_get_drvdata(codec->dev);

	int macro_idx, ret = 0;



	/* call init for supported macros */

	for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {

		if (priv->macro_params[macro_idx].init) {

			ret = priv->macro_params[macro_idx].init(codec);

			if (ret < 0) {

				dev_err(codec->dev,

					"%s: init for macro %d failed\n",

					__func__, macro_idx);

				goto err;

			}

		}

	}

	priv->codec = codec;

	dev_dbg(codec->dev, "%s: bolero soc codec probe success\n", __func__);

err:

	return ret;

}



static int bolero_soc_codec_remove(struct snd_soc_codec *codec)

{

	struct bolero_priv *priv = dev_get_drvdata(codec->dev);

	int macro_idx;



	/* call exit for supported macros */

	for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++)

		if (priv->macro_params[macro_idx].exit)

			priv->macro_params[macro_idx].exit(codec);



	return 0;

}



static struct regmap *bolero_get_regmap(struct device *dev)

{

	struct bolero_priv *priv = dev_get_drvdata(dev);



	return priv->regmap;

}



static struct snd_soc_codec_driver bolero = {

	.probe = bolero_soc_codec_probe,

	.remove = bolero_soc_codec_remove,

	.get_regmap = bolero_get_regmap,

};



static void bolero_add_child_devices(struct work_struct *work)

{

	struct bolero_priv *priv;

	struct platform_device *pdev;

	struct device_node *node;

	int ret, i, cnt = 0;



	priv = container_of(work, struct bolero_priv,

			    bolero_add_child_devices_work);

	if (!priv) {

		pr_err("%s: Memory for bolero priv does not exist\n",

			__func__);

		return;

	}

	if (!priv->dev->of_node) {

		dev_err(priv->dev, "%s: DT node for bolero does not exist\n",

			__func__);

		return;

	}



	for_each_child_of_node(priv->dev->of_node, node) {

		pdev = platform_device_alloc(node->name, -1);

		if (!pdev) {

			dev_err(priv->dev, "%s: pdev memory alloc failed\n",

				__func__);

			ret = -ENOMEM;

			goto fail_pdev_add;

		}

		pdev->dev.parent = priv->dev;

		pdev->dev.of_node = node;



		ret = platform_device_add(pdev);

		if (ret) {

			dev_err(priv->dev,

				"%s: Cannot add platform device\n",

				__func__);

			goto fail_pdev_add;

		}

		priv->pdev_child_devices[cnt] = pdev;

		cnt++;

	}

	return;

fail_pdev_add:

	for (i = cnt; i > 0; i--)

		platform_device_put(priv->pdev_child_devices[i - 1]);

err:

	return;

}



static int bolero_probe(struct platform_device *pdev)

{

	struct bolero_priv *priv;

	u32 num_macros = 0;

	int ret;



	priv = devm_kzalloc(&pdev->dev, sizeof(struct bolero_priv),

			    GFP_KERNEL);

	if (!priv)

		return -ENOMEM;

	ret = of_property_read_u32(pdev->dev.of_node, "qcom,num-macros",

				   &num_macros);

	if (ret) {

		dev_err(&pdev->dev,

			"%s:num-macros property not found\n",

			__func__);

		return ret;

	}

	priv->child_num = num_macros;

	if (priv->child_num > MAX_MACRO) {

		dev_err(&pdev->dev,

			"%s:child_num(%d) > MAX_MACRO(%d) than supported\n",

			__func__, priv->child_num, MAX_MACRO);

		return -EINVAL;

	}

	priv->va_without_decimation = of_property_read_bool(pdev->dev.of_node,

						"qcom,va-without-decimation");

	if (priv->va_without_decimation)

		bolero_reg_access[VA_MACRO] = bolero_va_top_reg_access;



	priv->dev = &pdev->dev;

	priv->regmap = bolero_regmap_init(priv->dev,

					  &bolero_regmap_config);

	if (IS_ERR_OR_NULL((void *)(priv->regmap))) {

		dev_err(&pdev->dev, "%s:regmap init failed\n", __func__);

		return -EINVAL;

	}

	priv->read_dev = __bolero_reg_read;

	priv->write_dev = __bolero_reg_write;



	dev_set_drvdata(&pdev->dev, priv);

	mutex_init(&priv->io_lock);

	INIT_WORK(&priv->bolero_add_child_devices_work,

		  bolero_add_child_devices);

	schedule_work(&priv->bolero_add_child_devices_work);



	return 0;

}



static int bolero_remove(struct platform_device *pdev)

{

	struct bolero_priv *priv = dev_get_drvdata(&pdev->dev);

	u16 i;



	for (i = priv->child_num; i > 0; i--)

		platform_device_unregister(priv->pdev_child_devices[i - 1]);

	mutex_destroy(&priv->io_lock);

	return 0;

}



static const struct of_device_id bolero_dt_match[] = {

	{.compatible = "qcom,bolero-codec"},

	{}

};

MODULE_DEVICE_TABLE(of, bolero_dt_match);



static struct platform_driver bolero_drv = {

	.driver = {

		.name = "bolero-codec",

		.owner = THIS_MODULE,

		.of_match_table = bolero_dt_match,

	},

	.probe = bolero_probe,

	.remove = bolero_remove,

};



module_platform_driver(bolero_drv);



MODULE_DESCRIPTION("Bolero driver");

MODULE_LICENSE("GPL v2");

asoc/codecs/bolero/bolero_cdc.h

0 → 100644
+61 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2018, The Linux Foundation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 and

 * only version 2 as published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 */



#ifndef BOLERO_CDC_H

#define BOLERO_CDC_H



#include <sound/soc.h>

#include <linux/regmap.h>



enum {

	START_MACRO,

	TX_MACRO = START_MACRO,

	RX_MACRO,

	WSA_MACRO,

	VA_MACRO,

	MAX_MACRO

};



struct macro_ops {

	int (*init)(struct snd_soc_codec *codec);

	int (*exit)(struct snd_soc_codec *codec);

	u16 num_dais;

	struct device *dev;

	struct snd_soc_dai_driver *dai_ptr;

	int (*mclk_fn)(struct device *dev, bool enable);

	char __iomem *io_base;

};



#if IS_ENABLED(CONFIG_SND_SOC_BOLERO)

int bolero_register_macro(struct device *dev, u16 macro_id,

			  struct macro_ops *ops);

void bolero_unregister_macro(struct device *dev, u16 macro_id);

struct device *bolero_get_device_ptr(struct device *dev, u16 macro_id);

#else

static inline int bolero_register_macro(struct device *dev,

					u16 macro_id,

					struct macro_ops *ops)

{

	return 0;

}



static inline void bolero_unregister_macro(struct device *dev, u16 macro_id)

{

}



static inline struct device *bolero_get_device_ptr(struct device *dev,

						u16 macro_id)

{

	return NULL;

}

#endif /* CONFIG_SND_SOC_BOLERO */

#endif /* BOLERO_CDC_H */