ASoC: rt5677: Add the GPIO function
The patch adds the GPIO function. Signed-off-by: Oder Chiou <oder_chiou@realtek.com> Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
Oder Chiou
Mark Brown
Родитель
e5b2791d2a
Коммит
44caf76480
|
|
@ -19,6 +19,7 @@
|
|||
#include <linux/i2c.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/spi/spi.h>
|
||||
#include <linux/gpio.h>
|
||||
#include <sound/core.h>
|
||||
#include <sound/pcm.h>
|
||||
#include <sound/pcm_params.h>
|
||||
|
|
@ -3160,6 +3161,135 @@ static int rt5677_set_bias_level(struct snd_soc_codec *codec,
|
|||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_GPIOLIB
|
||||
static inline struct rt5677_priv *gpio_to_rt5677(struct gpio_chip *chip)
|
||||
{
|
||||
return container_of(chip, struct rt5677_priv, gpio_chip);
|
||||
}
|
||||
|
||||
static void rt5677_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
|
||||
{
|
||||
struct rt5677_priv *rt5677 = gpio_to_rt5677(chip);
|
||||
|
||||
switch (offset) {
|
||||
case RT5677_GPIO1 ... RT5677_GPIO5:
|
||||
regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL2,
|
||||
0x1 << (offset * 3 + 1), !!value << (offset * 3 + 1));
|
||||
break;
|
||||
|
||||
case RT5677_GPIO6:
|
||||
regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL3,
|
||||
RT5677_GPIO6_OUT_MASK, !!value << RT5677_GPIO6_OUT_SFT);
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static int rt5677_gpio_direction_out(struct gpio_chip *chip,
|
||||
unsigned offset, int value)
|
||||
{
|
||||
struct rt5677_priv *rt5677 = gpio_to_rt5677(chip);
|
||||
|
||||
switch (offset) {
|
||||
case RT5677_GPIO1 ... RT5677_GPIO5:
|
||||
regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL2,
|
||||
0x3 << (offset * 3 + 1),
|
||||
(0x2 | !!value) << (offset * 3 + 1));
|
||||
break;
|
||||
|
||||
case RT5677_GPIO6:
|
||||
regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL3,
|
||||
RT5677_GPIO6_DIR_MASK | RT5677_GPIO6_OUT_MASK,
|
||||
RT5677_GPIO6_DIR_OUT | !!value << RT5677_GPIO6_OUT_SFT);
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int rt5677_gpio_get(struct gpio_chip *chip, unsigned offset)
|
||||
{
|
||||
struct rt5677_priv *rt5677 = gpio_to_rt5677(chip);
|
||||
int value, ret;
|
||||
|
||||
ret = regmap_read(rt5677->regmap, RT5677_GPIO_ST, &value);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return (value & (0x1 << offset)) >> offset;
|
||||
}
|
||||
|
||||
static int rt5677_gpio_direction_in(struct gpio_chip *chip, unsigned offset)
|
||||
{
|
||||
struct rt5677_priv *rt5677 = gpio_to_rt5677(chip);
|
||||
|
||||
switch (offset) {
|
||||
case RT5677_GPIO1 ... RT5677_GPIO5:
|
||||
regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL2,
|
||||
0x1 << (offset * 3 + 2), 0x0);
|
||||
break;
|
||||
|
||||
case RT5677_GPIO6:
|
||||
regmap_update_bits(rt5677->regmap, RT5677_GPIO_CTRL3,
|
||||
RT5677_GPIO6_DIR_MASK, RT5677_GPIO6_DIR_IN);
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct gpio_chip rt5677_template_chip = {
|
||||
.label = "rt5677",
|
||||
.owner = THIS_MODULE,
|
||||
.direction_output = rt5677_gpio_direction_out,
|
||||
.set = rt5677_gpio_set,
|
||||
.direction_input = rt5677_gpio_direction_in,
|
||||
.get = rt5677_gpio_get,
|
||||
.can_sleep = 1,
|
||||
};
|
||||
|
||||
static void rt5677_init_gpio(struct i2c_client *i2c)
|
||||
{
|
||||
struct rt5677_priv *rt5677 = i2c_get_clientdata(i2c);
|
||||
int ret;
|
||||
|
||||
rt5677->gpio_chip = rt5677_template_chip;
|
||||
rt5677->gpio_chip.ngpio = RT5677_GPIO_NUM;
|
||||
rt5677->gpio_chip.dev = &i2c->dev;
|
||||
rt5677->gpio_chip.base = -1;
|
||||
|
||||
ret = gpiochip_add(&rt5677->gpio_chip);
|
||||
if (ret != 0)
|
||||
dev_err(&i2c->dev, "Failed to add GPIOs: %d\n", ret);
|
||||
}
|
||||
|
||||
static void rt5677_free_gpio(struct i2c_client *i2c)
|
||||
{
|
||||
struct rt5677_priv *rt5677 = i2c_get_clientdata(i2c);
|
||||
int ret;
|
||||
|
||||
ret = gpiochip_remove(&rt5677->gpio_chip);
|
||||
if (ret != 0)
|
||||
dev_err(&i2c->dev, "Failed to remove GPIOs: %d\n", ret);
|
||||
}
|
||||
#else
|
||||
static void rt5677_init_gpio(struct i2c_client *i2c)
|
||||
{
|
||||
}
|
||||
|
||||
static void rt5677_free_gpio(struct i2c_client *i2c)
|
||||
{
|
||||
}
|
||||
#endif
|
||||
|
||||
static int rt5677_probe(struct snd_soc_codec *codec)
|
||||
{
|
||||
struct rt5677_priv *rt5677 = snd_soc_codec_get_drvdata(codec);
|
||||
|
|
@ -3422,6 +3552,8 @@ static int rt5677_i2c_probe(struct i2c_client *i2c,
|
|||
RT5677_GPIO5_DIR_OUT);
|
||||
}
|
||||
|
||||
rt5677_init_gpio(i2c);
|
||||
|
||||
return snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5677,
|
||||
rt5677_dai, ARRAY_SIZE(rt5677_dai));
|
||||
}
|
||||
|
|
@ -3429,6 +3561,7 @@ static int rt5677_i2c_probe(struct i2c_client *i2c,
|
|||
static int rt5677_i2c_remove(struct i2c_client *i2c)
|
||||
{
|
||||
snd_soc_unregister_codec(&i2c->dev);
|
||||
rt5677_free_gpio(i2c);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
|
|||
|
|
@ -1363,10 +1363,109 @@
|
|||
#define RT5677_SEL_SRC_IB01 (0x1 << 0)
|
||||
#define RT5677_SEL_SRC_IB01_SFT 0
|
||||
|
||||
/* GPIO status (0xbf) */
|
||||
#define RT5677_GPIO6_STATUS_MASK (0x1 << 5)
|
||||
#define RT5677_GPIO6_STATUS_SFT 5
|
||||
#define RT5677_GPIO5_STATUS_MASK (0x1 << 4)
|
||||
#define RT5677_GPIO5_STATUS_SFT 4
|
||||
#define RT5677_GPIO4_STATUS_MASK (0x1 << 3)
|
||||
#define RT5677_GPIO4_STATUS_SFT 3
|
||||
#define RT5677_GPIO3_STATUS_MASK (0x1 << 2)
|
||||
#define RT5677_GPIO3_STATUS_SFT 2
|
||||
#define RT5677_GPIO2_STATUS_MASK (0x1 << 1)
|
||||
#define RT5677_GPIO2_STATUS_SFT 1
|
||||
#define RT5677_GPIO1_STATUS_MASK (0x1 << 0)
|
||||
#define RT5677_GPIO1_STATUS_SFT 0
|
||||
|
||||
/* GPIO Control 1 (0xc0) */
|
||||
#define RT5677_GPIO1_PIN_MASK (0x1 << 15)
|
||||
#define RT5677_GPIO1_PIN_SFT 15
|
||||
#define RT5677_GPIO1_PIN_GPIO1 (0x0 << 15)
|
||||
#define RT5677_GPIO1_PIN_IRQ (0x1 << 15)
|
||||
#define RT5677_IPTV_MODE_MASK (0x1 << 14)
|
||||
#define RT5677_IPTV_MODE_SFT 14
|
||||
#define RT5677_IPTV_MODE_GPIO (0x0 << 14)
|
||||
#define RT5677_IPTV_MODE_IPTV (0x1 << 14)
|
||||
#define RT5677_FUNC_MODE_MASK (0x1 << 13)
|
||||
#define RT5677_FUNC_MODE_SFT 13
|
||||
#define RT5677_FUNC_MODE_DMIC_GPIO (0x0 << 13)
|
||||
#define RT5677_FUNC_MODE_JTAG (0x1 << 13)
|
||||
|
||||
/* GPIO Control 2 (0xc1) */
|
||||
#define RT5677_GPIO5_DIR_MASK (0x1 << 14)
|
||||
#define RT5677_GPIO5_DIR_SFT 14
|
||||
#define RT5677_GPIO5_DIR_IN (0x0 << 14)
|
||||
#define RT5677_GPIO5_DIR_OUT (0x1 << 14)
|
||||
#define RT5677_GPIO5_OUT_MASK (0x1 << 13)
|
||||
#define RT5677_GPIO5_OUT_SFT 13
|
||||
#define RT5677_GPIO5_OUT_LO (0x0 << 13)
|
||||
#define RT5677_GPIO5_OUT_HI (0x1 << 13)
|
||||
#define RT5677_GPIO5_P_MASK (0x1 << 12)
|
||||
#define RT5677_GPIO5_P_SFT 12
|
||||
#define RT5677_GPIO5_P_NOR (0x0 << 12)
|
||||
#define RT5677_GPIO5_P_INV (0x1 << 12)
|
||||
#define RT5677_GPIO4_DIR_MASK (0x1 << 11)
|
||||
#define RT5677_GPIO4_DIR_SFT 11
|
||||
#define RT5677_GPIO4_DIR_IN (0x0 << 11)
|
||||
#define RT5677_GPIO4_DIR_OUT (0x1 << 11)
|
||||
#define RT5677_GPIO4_OUT_MASK (0x1 << 10)
|
||||
#define RT5677_GPIO4_OUT_SFT 10
|
||||
#define RT5677_GPIO4_OUT_LO (0x0 << 10)
|
||||
#define RT5677_GPIO4_OUT_HI (0x1 << 10)
|
||||
#define RT5677_GPIO4_P_MASK (0x1 << 9)
|
||||
#define RT5677_GPIO4_P_SFT 9
|
||||
#define RT5677_GPIO4_P_NOR (0x0 << 9)
|
||||
#define RT5677_GPIO4_P_INV (0x1 << 9)
|
||||
#define RT5677_GPIO3_DIR_MASK (0x1 << 8)
|
||||
#define RT5677_GPIO3_DIR_SFT 8
|
||||
#define RT5677_GPIO3_DIR_IN (0x0 << 8)
|
||||
#define RT5677_GPIO3_DIR_OUT (0x1 << 8)
|
||||
#define RT5677_GPIO3_OUT_MASK (0x1 << 7)
|
||||
#define RT5677_GPIO3_OUT_SFT 7
|
||||
#define RT5677_GPIO3_OUT_LO (0x0 << 7)
|
||||
#define RT5677_GPIO3_OUT_HI (0x1 << 7)
|
||||
#define RT5677_GPIO3_P_MASK (0x1 << 6)
|
||||
#define RT5677_GPIO3_P_SFT 6
|
||||
#define RT5677_GPIO3_P_NOR (0x0 << 6)
|
||||
#define RT5677_GPIO3_P_INV (0x1 << 6)
|
||||
#define RT5677_GPIO2_DIR_MASK (0x1 << 5)
|
||||
#define RT5677_GPIO2_DIR_SFT 5
|
||||
#define RT5677_GPIO2_DIR_IN (0x0 << 5)
|
||||
#define RT5677_GPIO2_DIR_OUT (0x1 << 5)
|
||||
#define RT5677_GPIO2_OUT_MASK (0x1 << 4)
|
||||
#define RT5677_GPIO2_OUT_SFT 4
|
||||
#define RT5677_GPIO2_OUT_LO (0x0 << 4)
|
||||
#define RT5677_GPIO2_OUT_HI (0x1 << 4)
|
||||
#define RT5677_GPIO2_P_MASK (0x1 << 3)
|
||||
#define RT5677_GPIO2_P_SFT 3
|
||||
#define RT5677_GPIO2_P_NOR (0x0 << 3)
|
||||
#define RT5677_GPIO2_P_INV (0x1 << 3)
|
||||
#define RT5677_GPIO1_DIR_MASK (0x1 << 2)
|
||||
#define RT5677_GPIO1_DIR_SFT 2
|
||||
#define RT5677_GPIO1_DIR_IN (0x0 << 2)
|
||||
#define RT5677_GPIO1_DIR_OUT (0x1 << 2)
|
||||
#define RT5677_GPIO1_OUT_MASK (0x1 << 1)
|
||||
#define RT5677_GPIO1_OUT_SFT 1
|
||||
#define RT5677_GPIO1_OUT_LO (0x0 << 1)
|
||||
#define RT5677_GPIO1_OUT_HI (0x1 << 1)
|
||||
#define RT5677_GPIO1_P_MASK (0x1 << 0)
|
||||
#define RT5677_GPIO1_P_SFT 0
|
||||
#define RT5677_GPIO1_P_NOR (0x0 << 0)
|
||||
#define RT5677_GPIO1_P_INV (0x1 << 0)
|
||||
|
||||
/* GPIO Control 3 (0xc2) */
|
||||
#define RT5677_GPIO6_DIR_MASK (0x1 << 2)
|
||||
#define RT5677_GPIO6_DIR_SFT 2
|
||||
#define RT5677_GPIO6_DIR_IN (0x0 << 2)
|
||||
#define RT5677_GPIO6_DIR_OUT (0x1 << 2)
|
||||
#define RT5677_GPIO6_OUT_MASK (0x1 << 1)
|
||||
#define RT5677_GPIO6_OUT_SFT 1
|
||||
#define RT5677_GPIO6_OUT_LO (0x0 << 1)
|
||||
#define RT5677_GPIO6_OUT_HI (0x1 << 1)
|
||||
#define RT5677_GPIO6_P_MASK (0x1 << 0)
|
||||
#define RT5677_GPIO6_P_SFT 0
|
||||
#define RT5677_GPIO6_P_NOR (0x0 << 0)
|
||||
#define RT5677_GPIO6_P_INV (0x1 << 0)
|
||||
|
||||
/* Virtual DSP Mixer Control (0xf7 0xf8 0xf9) */
|
||||
#define RT5677_DSP_IB_01_H (0x1 << 15)
|
||||
|
|
@ -1428,6 +1527,16 @@ enum {
|
|||
RT5677_AIFS,
|
||||
};
|
||||
|
||||
enum {
|
||||
RT5677_GPIO1,
|
||||
RT5677_GPIO2,
|
||||
RT5677_GPIO3,
|
||||
RT5677_GPIO4,
|
||||
RT5677_GPIO5,
|
||||
RT5677_GPIO6,
|
||||
RT5677_GPIO_NUM,
|
||||
};
|
||||
|
||||
struct rt5677_priv {
|
||||
struct snd_soc_codec *codec;
|
||||
struct rt5677_platform_data pdata;
|
||||
|
|
@ -1441,6 +1550,9 @@ struct rt5677_priv {
|
|||
int pll_src;
|
||||
int pll_in;
|
||||
int pll_out;
|
||||
#ifdef CONFIG_GPIOLIB
|
||||
struct gpio_chip gpio_chip;
|
||||
#endif
|
||||
};
|
||||
|
||||
#endif /* __RT5677_H__ */
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче