kernel-brax3-ubuntu-touch/sound/soc/mediatek/mt6835/mt6835-afe-gpio.c

// SPDX-License-Identifier: GPL-2.0
/*
 *  mt6835-afe-gpio.c  --  Mediatek 6835 afe gpio ctrl
 *
 *  Copyright (c) 2021 MediaTek Inc.
 *  Author: Shu-wei Hsu <shu-wei.Hsu@mediatek.com>
 */

#include <linux/gpio.h>
#include <linux/pinctrl/consumer.h>

#include "mt6835-afe-common.h"
#include "mt6835-afe-gpio.h"

struct pinctrl *aud_pinctrl;
struct audio_gpio_attr {
	const char *name;
	bool gpio_prepare;
	struct pinctrl_state *gpioctrl;
};

static struct audio_gpio_attr aud_gpios[MT6835_AFE_GPIO_GPIO_NUM] = {
	[MT6835_AFE_GPIO_DAT_MISO0_OFF] = {"aud_dat_miso0_off", false, NULL},
	[MT6835_AFE_GPIO_DAT_MISO0_ON] = {"aud_dat_miso0_on", false, NULL},
	[MT6835_AFE_GPIO_DAT_MISO1_OFF] = {"aud_dat_miso1_off", false, NULL},
	[MT6835_AFE_GPIO_DAT_MISO1_ON] = {"aud_dat_miso1_on", false, NULL},
	[MT6835_AFE_GPIO_DAT_MOSI_OFF] = {"aud_dat_mosi_off", false, NULL},
	[MT6835_AFE_GPIO_DAT_MOSI_ON] = {"aud_dat_mosi_on", false, NULL},
	[MT6835_AFE_GPIO_I2S0_OFF] = {"aud_gpio_i2s0_off", false, NULL},
	[MT6835_AFE_GPIO_I2S0_ON] = {"aud_gpio_i2s0_on", false, NULL},
	[MT6835_AFE_GPIO_I2S3_OFF] = {"aud_gpio_i2s3_off", false, NULL},
	[MT6835_AFE_GPIO_I2S3_ON] = {"aud_gpio_i2s3_on", false, NULL},
	[MT6835_AFE_GPIO_VOW_DAT_OFF] = {"vow_dat_miso_off", false, NULL},
	[MT6835_AFE_GPIO_VOW_DAT_ON] = {"vow_dat_miso_on", false, NULL},
	[MT6835_AFE_GPIO_VOW_CLK_OFF] = {"vow_clk_miso_off", false, NULL},
	[MT6835_AFE_GPIO_VOW_CLK_ON] = {"vow_clk_miso_on", false, NULL},
};

static DEFINE_MUTEX(gpio_request_mutex);

int mt6835_afe_gpio_init(struct mtk_base_afe *afe)
{
	int ret;
	int i = 0;

	aud_pinctrl = devm_pinctrl_get(afe->dev);
	if (IS_ERR(aud_pinctrl)) {
		ret = PTR_ERR(aud_pinctrl);
		dev_err(afe->dev, "%s(), ret %d, cannot get aud_pinctrl!\n",
			__func__, ret);
		return -ENODEV;
	}

	for (i = 0; i < ARRAY_SIZE(aud_gpios); i++) {
		dev_dbg(afe->dev, "%s(), aud_gpios[%d]: %s\n", __func__, i, aud_gpios[i].name);
		if (aud_gpios[i].name == NULL) {
			dev_dbg(afe->dev, "%s(), aud_gpios[%d]: %s NULL, bypass\n",
				 __func__, i, aud_gpios[i].name);
			continue;
		}
		aud_gpios[i].gpioctrl = pinctrl_lookup_state(aud_pinctrl,
					aud_gpios[i].name);
		if (IS_ERR(aud_gpios[i].gpioctrl)) {
			ret = PTR_ERR(aud_gpios[i].gpioctrl);
			dev_err(afe->dev, "%s(), pinctrl_lookup_state %s fail, ret %d\n",
				__func__, aud_gpios[i].name, ret);
		} else
			aud_gpios[i].gpio_prepare = true;
	}

	/* gpio status init */
	mt6835_afe_gpio_request(afe, false, MT6835_DAI_ADDA, 0);
	mt6835_afe_gpio_request(afe, false, MT6835_DAI_ADDA, 1);

	return 0;
}

static int mt6835_afe_gpio_select(struct mtk_base_afe *afe,
				  enum mt6835_afe_gpio type)
{
	int ret = 0;

	if (type < 0 || type >= MT6835_AFE_GPIO_GPIO_NUM) {
		dev_err(afe->dev, "%s(), error, invalid gpio type %d\n",
			__func__, type);
		return -EINVAL;
	}

	if (!aud_gpios[type].gpio_prepare) {
		dev_info(afe->dev, "%s(), error, gpio type %d not prepared\n",
			 __func__, type);
		return -EIO;
	}

	ret = pinctrl_select_state(aud_pinctrl,
				   aud_gpios[type].gpioctrl);
	if (ret)
		dev_err(afe->dev, "%s(), error, can not set gpio type %d\n",
			__func__, type);

	return ret;
}

static int mt6835_afe_gpio_adda_dl(struct mtk_base_afe *afe, bool enable)
{
	if (enable)
		return mt6835_afe_gpio_select(afe,
					      MT6835_AFE_GPIO_DAT_MOSI_ON);
	else
		return mt6835_afe_gpio_select(afe,
					      MT6835_AFE_GPIO_DAT_MOSI_OFF);
}

static int mt6835_afe_gpio_adda_ul(struct mtk_base_afe *afe, bool enable)
{
	int ret = 0;

	if (mt6835_afe_gpio_is_prepared(MT6835_AFE_GPIO_DAT_MISO0_ON)) {
		ret = mt6835_afe_gpio_select(afe, enable ?
					     MT6835_AFE_GPIO_DAT_MISO0_ON :
					     MT6835_AFE_GPIO_DAT_MISO0_OFF);
		/* if error happened, skip miso1 select */
		if (ret)
			return ret;
	}

	if (mt6835_afe_gpio_is_prepared(MT6835_AFE_GPIO_DAT_MISO1_ON))
		ret = mt6835_afe_gpio_select(afe, enable ?
					     MT6835_AFE_GPIO_DAT_MISO1_ON :
					     MT6835_AFE_GPIO_DAT_MISO1_OFF);

	return ret;
}

int mt6835_afe_gpio_request(struct mtk_base_afe *afe, bool enable,
			    int dai, int uplink)
{
	mutex_lock(&gpio_request_mutex);
	switch (dai) {
	case MT6835_DAI_ADDA:
		if (uplink)
			mt6835_afe_gpio_adda_ul(afe, enable);
		else
			mt6835_afe_gpio_adda_dl(afe, enable);
		break;
	case MT6835_DAI_I2S_0:
		if (enable)
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S0_ON);
		else
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S0_OFF);
		break;
	case MT6835_DAI_I2S_1:
		if (enable)
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S1_ON);
		else
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S1_OFF);
		break;
	case MT6835_DAI_I2S_2:
		if (enable)
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S2_ON);
		else
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S2_OFF);
		break;
	case MT6835_DAI_I2S_3:
		if (enable)
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S3_ON);
		else
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S3_OFF);
		break;
	case MT6835_DAI_I2S_5:
		if (enable)
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S5_ON);
		else
			mt6835_afe_gpio_select(afe, MT6835_AFE_GPIO_I2S5_OFF);
		break;
	case MT6835_DAI_VOW:
		if (enable) {
			mt6835_afe_gpio_select(afe,
					       MT6835_AFE_GPIO_VOW_CLK_ON);
			mt6835_afe_gpio_select(afe,
					       MT6835_AFE_GPIO_VOW_DAT_ON);
		} else {
			mt6835_afe_gpio_select(afe,
					       MT6835_AFE_GPIO_VOW_CLK_OFF);
			mt6835_afe_gpio_select(afe,
					       MT6835_AFE_GPIO_VOW_DAT_OFF);
		}
		break;
	default:
		mutex_unlock(&gpio_request_mutex);
		dev_info(afe->dev, "%s(), invalid dai %d\n", __func__, dai);
		return -EINVAL;
	}
	mutex_unlock(&gpio_request_mutex);
	return 0;
}
EXPORT_SYMBOL_GPL(mt6835_afe_gpio_request);

bool mt6835_afe_gpio_is_prepared(enum mt6835_afe_gpio type)
{
	return aud_gpios[type].gpio_prepare;
}
EXPORT_SYMBOL(mt6835_afe_gpio_is_prepared);