Skip to content

Commit

Permalink
ASoC: rt711: add rt711 support
Browse files Browse the repository at this point in the history 
Signed-off-by: Bard Liao <[email protected]>
  • Loading branch information
@bardliao
bardliao committed Aug 15, 2019
1 parent 421ce5e commit 52a0274
Show file tree
Hide file tree
Showing 7 changed files with 1,970 additions and 1 deletion.
9 changes: 9 additions & 0 deletions sound/soc/codecs/Kconfig
View file
Original file line number Diff line number Diff line change
Expand Up @@ -1038,6 +1038,15 @@ config SND_SOC_RT1308_SDW
select SND_SOC_RT1308
select REGMAP_SOUNDWIRE

config SND_SOC_RT711
tristate

config SND_SOC_RT711_SDW
tristate "Realtek RT711 Codec - SDW"
depends on SOUNDWIRE
select SND_SOC_RT711
select REGMAP_SOUNDWIRE

#Freescale sgtl5000 codec
config SND_SOC_SGTL5000
tristate "Freescale SGTL5000 CODEC"
Expand Down
2 changes: 2 additions & 0 deletions sound/soc/codecs/Makefile
View file
Original file line number Diff line number Diff line change
Expand Up @@ -278,6 +278,7 @@ snd-soc-wm-hubs-objs := wm_hubs.o
snd-soc-zx-aud96p22-objs := zx_aud96p22.o
snd-soc-rt700-objs := rt700.o rt700-sdw.o
snd-soc-rt1308-sdw-objs := rt1308-sdw.o
snd-soc-rt711-objs := rt711.o rt711-sdw.o

# Amp
snd-soc-max9877-objs := max9877.o
Expand Down Expand Up @@ -564,6 +565,7 @@ obj-$(CONFIG_SND_SOC_WM_HUBS) += snd-soc-wm-hubs.o
obj-$(CONFIG_SND_SOC_ZX_AUD96P22) += snd-soc-zx-aud96p22.o
obj-$(CONFIG_SND_SOC_RT700) += snd-soc-rt700.o
obj-$(CONFIG_SND_SOC_RT1308_SDW) += snd-soc-rt1308-sdw.o
obj-$(CONFIG_SND_SOC_RT711) += snd-soc-rt711.o

# Amp
obj-$(CONFIG_SND_SOC_MAX9877) += snd-soc-max9877.o
Expand Down
334 changes: 334 additions & 0 deletions sound/soc/codecs/rt711-sdw.c
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,334 @@
// SPDX-License-Identifier: GPL-2.0
//
// rt711-sdw.c -- rt711 ALSA SoC audio driver
//
// Copyright(c) 2019 Realtek Semiconductor Corp.
//
//

#include <linux/delay.h>
#include <linux/device.h>
#include <linux/mod_devicetable.h>
#include <linux/soundwire/sdw.h>
#include <linux/soundwire/sdw_type.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/regmap.h>
#include <sound/soc.h>
#include "rt711.h"
#include "rt711-sdw.h"

static bool rt711_readable_register(struct device *dev, unsigned int reg)
{
switch (reg) {
case 0x0020:
case 0x0030:
case 0x0060:
case 0x0070:
case 0x0080:
case 0x0088:
case 0x0000 ... 0x0005:
case 0x0022 ... 0x0026:
case 0x0032 ... 0x0036:
case 0x0040 ... 0x0046:
case 0x0050 ... 0x0055:
case 0x00e0 ... 0x00e5:
case 0x00ee ... 0x00f5:
case 0x00fe ... 0x0105:
case 0x0200 ... 0x0205:
case 0x0220:
case 0x0222 ... 0x0227:
case 0x0230:
case 0x0232 ... 0x0237:
case 0x0300 ... 0x0305:
case 0x0320:
case 0x0322 ... 0x0327:
case 0x0330:
case 0x0332 ... 0x0337:
case 0x0400 ... 0x0405:
case 0x0420:
case 0x0422 ... 0x0427:
case 0x0430:
case 0x0432 ... 0x0437:
case 0x0f00 ... 0x0f27:
case 0x0f30:
case 0x0f32 ... 0x0f37:
case 0x2000 ... 0x200e:
case 0x2012 ... 0x2016:
case 0x201a ... 0x2027:
case 0x2029 ... 0x202a:
case 0x202d ... 0x2034:
case 0x2201 ... 0x2204:
case 0x2206 ... 0x2212:
case 0x2220 ... 0x2223:
case 0x2230 ... 0x2239:
case 0x2f01 ... 0x2f0f:
case 0x3000 ... 0xffff:
return true;
default:
return false;
}
}

static bool rt711_volatile_register(struct device *dev, unsigned int reg)
{
switch (reg) {
case 0x0000:
case 0x0001:
case 0x0004:
case 0x0005:
case 0x0040:
case 0x0042:
case 0x0043:
case 0x0044:
case 0x0045:
case 0x0104:
case 0x0204:
case 0x0304:
case 0x0404:
case 0x0504:
case 0x0604:
case 0x0704:
case 0x0804:
case 0x0105:
case 0x0205:
case 0x0305:
case 0x0405:
case 0x0505:
case 0x0605:
case 0x0705:
case 0x0805:
case 0x0f00:
case 0x0f04:
case 0x0f05:
case 0x2009:
case 0x2016:
case 0x201b:
case 0x201c:
case 0x201d:
case 0x201f:
case 0x2021:
case 0x2023:
case 0x2230:
case 0x0050 ... 0x0055: /* device id */
case 0x200b ... 0x200e: /* i2c read */
case 0x2012 ... 0x2015: /* HD-A read */
case 0x202d ... 0x202f: /* BRA */
case 0x2201 ... 0x2212: /* i2c debug */
case 0x2220 ... 0x2223: /* decoded HD-A */
case 0x3000 ... 0xffff: /* HD-A command */
return true;
default:
return false;
}
}

const struct regmap_config rt711_sdw_regmap = {
.reg_bits = 32, /* Total register space for SDW */
.val_bits = 8, /* Total number of bits in register */
.readable_reg = rt711_readable_register, /* Readable registers */
.volatile_reg = rt711_volatile_register, /* volatile register */
.max_register = 0xffff, /* Maximum number of register */
.reg_defaults = rt711_reg_defaults, /* Defaults */
.num_reg_defaults = ARRAY_SIZE(rt711_reg_defaults),
.cache_type = REGCACHE_RBTREE,
.use_single_read = true,
.use_single_write = true,
};

static int rt711_update_status(struct sdw_slave *slave,
enum sdw_slave_status status)
{
struct rt711_priv *rt711 = dev_get_drvdata(&slave->dev);

/* Update the status */
rt711->status = status;

/*
* Perform initialization only if slave status is present and
* hw_init flag is false
*/
if (rt711->hw_init || rt711->status != SDW_SLAVE_ATTACHED)
return 0;

/* perform I/O transfers required for Slave initialization */
return rt711_io_init(&slave->dev, slave);
}

static int rt711_read_prop(struct sdw_slave *slave)
{
struct sdw_slave_prop *prop = &slave->prop;
int nval, i, num_of_ports = 1;
u32 bit;
unsigned long addr;
struct sdw_dpn_prop *dpn;

sdw_slave_read_prop(slave);

prop->paging_support = false;

/* first we need to allocate memory for set bits in port lists */
prop->source_ports = 0x14; /* BITMAP: 00010100 */
prop->sink_ports = 0x8; /* BITMAP: 00001000 */

nval = hweight32(prop->source_ports);
num_of_ports += nval;
prop->src_dpn_prop = devm_kcalloc(&slave->dev, nval,
sizeof(*prop->src_dpn_prop),
GFP_KERNEL);
if (!prop->src_dpn_prop)
return -ENOMEM;

/* call helper to read */
sdw_slave_read_dpn(slave, prop->src_dpn_prop, nval,
prop->source_ports, "source");
dpn = prop->src_dpn_prop;
i = 0;
addr = prop->source_ports;
for_each_set_bit(bit, &addr, 32) {
dpn[i].num = bit;
dpn[i].simple_ch_prep_sm = true;
dpn[i].ch_prep_timeout = 10;
i++;
}

/* do this again for sink now */
nval = hweight32(prop->sink_ports);
num_of_ports += nval;
prop->sink_dpn_prop = devm_kcalloc(&slave->dev, nval,
sizeof(*prop->sink_dpn_prop),
GFP_KERNEL);
if (!prop->sink_dpn_prop)
return -ENOMEM;

/* call helper to read */
sdw_slave_read_dpn(slave, prop->sink_dpn_prop, nval,
prop->sink_ports, "sink");

dpn = prop->sink_dpn_prop;
i = 0;
addr = prop->sink_ports;
for_each_set_bit(bit, &addr, 32) {
dpn[i].num = bit;
dpn[i].simple_ch_prep_sm = true;
dpn[i].ch_prep_timeout = 10;
i++;
}

/* Allocate port_ready based on num_of_ports */
slave->port_ready = devm_kcalloc(&slave->dev, num_of_ports,
sizeof(*slave->port_ready),
GFP_KERNEL);
if (!slave->port_ready)
return -ENOMEM;

/* Initialize completion */
for (i = 0; i < num_of_ports; i++)
init_completion(&slave->port_ready[i]);

/* set the timeout values */
prop->clk_stop_timeout = 20;

return 0;
}

static int rt711_bus_config(struct sdw_slave *slave,
struct sdw_bus_params *params)
{
struct rt711_priv *rt711 = dev_get_drvdata(&slave->dev);
int ret;

memcpy(&rt711->params, params, sizeof(*params));

ret = rt711_clock_config(&slave->dev);
if (ret < 0)
dev_err(&slave->dev, "Invalid clk config");

return 0;
}

static int rt711_interrupt_callback(struct sdw_slave *slave,
struct sdw_slave_intr_status *status)
{

struct rt711_priv *rt711 = dev_get_drvdata(&slave->dev);
bool hp, mic;

pr_debug("%s control_port_stat=%x", __func__, status->control_port);

if (status->control_port & 0x4) {
rt711_jack_detect(rt711, &hp, &mic);
pr_info("%s hp=%d mic=%d\n", __func__, hp, mic);
}

return 0;
}

static struct sdw_slave_ops rt711_slave_ops = {
.read_prop = rt711_read_prop,
.interrupt_callback = rt711_interrupt_callback,
.update_status = rt711_update_status,
.bus_config = rt711_bus_config,
};

static int rt711_sdw_probe(struct sdw_slave *slave,
const struct sdw_device_id *id)
{
struct regmap *regmap;
int ret = 0;

pr_err("bard: %s\n", __func__);
/* Assign ops */
/*
* FIXME: by Shuming
* rt711_slave_ops set in sdw_driver structure already.
* Why to set again here?
*/
slave->ops = &rt711_slave_ops;

/* Regmap Initialization */
regmap = devm_regmap_init_sdw(slave, &rt711_sdw_regmap);
if (!regmap)
return -EINVAL;

rt711_init(&slave->dev, regmap, slave);

/* Perform IO operations only if slave is in ATTACHED state */
if (slave->status == SDW_SLAVE_ATTACHED)
rt711_io_init(&slave->dev, slave);

return ret;
}

static const struct sdw_device_id rt711_id[] = {
SDW_SLAVE_ENTRY(0x025d, 0x711, 0),
{},
};
MODULE_DEVICE_TABLE(sdw, rt711_id);

static struct sdw_driver rt711_sdw_driver = {
.driver = {
.name = "rt711",
.owner = THIS_MODULE,
},
.probe = rt711_sdw_probe,
.ops = &rt711_slave_ops,
.id_table = rt711_id,
};

static int __init sdw_slave_init(void)
{
return sdw_register_driver(&rt711_sdw_driver);
}

static void __exit sdw_slave_exit(void)
{
sdw_unregister_driver(&rt711_sdw_driver);
}

module_init(sdw_slave_init);
module_exit(sdw_slave_exit);

MODULE_DESCRIPTION("ASoC RT711 SDW driver");
MODULE_AUTHOR("Shuming Fan <[email protected]>");
MODULE_LICENSE("GPL");
Loading

0 comments on commit 52a0274

Please sign in to comment.