#include <linux/pm_runtime.h>
#include <sound/soc.h>
#include <sound/pcm_params.h>
#include <uapi/sound/tlv.h>
#include "core.h"
#include "messages.h"
struct catpt_stream_template {
enum catpt_path_id path_id;
enum catpt_stream_type type;
u32 persistent_size;
u8 num_entries;
struct catpt_module_entry entries[];
};
static struct catpt_stream_template system_pb = {
.path_id = CATPT_PATH_SSP0_OUT,
.type = CATPT_STRM_TYPE_SYSTEM,
.num_entries = 1,
.entries = {{ CATPT_MODID_PCM_SYSTEM, 0 }},
};
static struct catpt_stream_template system_cp = {
.path_id = CATPT_PATH_SSP0_IN,
.type = CATPT_STRM_TYPE_CAPTURE,
.num_entries = 1,
.entries = {{ CATPT_MODID_PCM_CAPTURE, 0 }},
};
static struct catpt_stream_template offload_pb = {
.path_id = CATPT_PATH_SSP0_OUT,
.type = CATPT_STRM_TYPE_RENDER,
.num_entries = 1,
.entries = {{ CATPT_MODID_PCM, 0 }},
};
static struct catpt_stream_template loopback_cp = {
.path_id = CATPT_PATH_SSP0_OUT,
.type = CATPT_STRM_TYPE_LOOPBACK,
.num_entries = 1,
.entries = {{ CATPT_MODID_PCM_REFERENCE, 0 }},
};
static struct catpt_stream_template bluetooth_pb = {
.path_id = CATPT_PATH_SSP1_OUT,
.type = CATPT_STRM_TYPE_BLUETOOTH_RENDER,
.num_entries = 1,
.entries = {{ CATPT_MODID_BLUETOOTH_RENDER, 0 }},
};
static struct catpt_stream_template bluetooth_cp = {
.path_id = CATPT_PATH_SSP1_IN,
.type = CATPT_STRM_TYPE_BLUETOOTH_CAPTURE,
.num_entries = 1,
.entries = {{ CATPT_MODID_BLUETOOTH_CAPTURE, 0 }},
};
static struct catpt_stream_template *catpt_topology[] = {
[CATPT_STRM_TYPE_RENDER] = &offload_pb,
[CATPT_STRM_TYPE_SYSTEM] = &system_pb,
[CATPT_STRM_TYPE_CAPTURE] = &system_cp,
[CATPT_STRM_TYPE_LOOPBACK] = &loopback_cp,
[CATPT_STRM_TYPE_BLUETOOTH_RENDER] = &bluetooth_pb,
[CATPT_STRM_TYPE_BLUETOOTH_CAPTURE] = &bluetooth_cp,
};
static struct catpt_stream_template *
catpt_get_stream_template(struct snd_pcm_substream *substream)
{
struct snd_soc_pcm_runtime *rtm = snd_soc_substream_to_rtd(substream);
struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtm, 0);
enum catpt_stream_type type;
type = cpu_dai->driver->id;
switch (type) {
case CATPT_STRM_TYPE_SYSTEM:
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
type = CATPT_STRM_TYPE_CAPTURE;
break;
case CATPT_STRM_TYPE_BLUETOOTH_RENDER:
if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
type = CATPT_STRM_TYPE_BLUETOOTH_CAPTURE;
break;
default:
break;
}
return catpt_topology[type];
}
struct catpt_stream_runtime *
catpt_stream_find(struct catpt_dev *cdev, u8 stream_hw_id)
{
struct catpt_stream_runtime *pos, *result = NULL;
spin_lock(&cdev->list_lock);
list_for_each_entry(pos, &cdev->stream_list, node) {
if (pos->info.stream_hw_id == stream_hw_id) {
result = pos;
break;
}
}
spin_unlock(&cdev->list_lock);
return result;
}
static void catpt_stream_read_position(struct catpt_dev *cdev,
struct catpt_stream_runtime *stream, u32 *pos)
{
memcpy_fromio(pos, cdev->lpe_ba + stream->info.read_pos_regaddr, sizeof(*pos));
}
static u32 catpt_stream_volume(struct catpt_dev *cdev,
struct catpt_stream_runtime *stream, u32 channel)
{
u32 volume, offset;
if (channel >= CATPT_CHANNELS_MAX)
channel = 0;
offset = stream->info.volume_regaddr[channel];
memcpy_fromio(&volume, cdev->lpe_ba + offset, sizeof(volume));
return volume;
}
static u32 catpt_mixer_volume(struct catpt_dev *cdev,
struct catpt_mixer_stream_info *info, u32 channel)
{
u32 volume, offset;
if (channel >= CATPT_CHANNELS_MAX)
channel = 0;
offset = info->volume_regaddr[channel];
memcpy_fromio(&volume, cdev->lpe_ba + offset, sizeof(volume));
return volume;
}
static void catpt_arrange_page_table(struct snd_pcm_substream *substream,
struct snd_dma_buffer *pgtbl)
{
struct snd_pcm_runtime *rtm = substream->runtime;
struct snd_dma_buffer *databuf = snd_pcm_get_dma_buf(substream);
int i, pages;
pages = snd_sgbuf_aligned_pages(rtm->dma_bytes);
for (i = 0; i < pages; i++) {
u32 pfn, offset;
u32 *page_table;
pfn = PFN_DOWN(snd_sgbuf_get_addr(databuf, i * PAGE_SIZE));
offset = ((i << 2) + i) >> 1;
page_table = (u32 *)(pgtbl->area + offset);
if (i & 1)
*page_table |= (pfn << 4);
else
*page_table |= pfn;
}
}
static u32 catpt_get_channel_map(enum catpt_channel_config config)
{
switch (config) {
case CATPT_CHANNEL_CONFIG_MONO:
return GENMASK(31, 4) | CATPT_CHANNEL_CENTER;
case CATPT_CHANNEL_CONFIG_STEREO:
return GENMASK(31, 8) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_RIGHT << 4);
case CATPT_CHANNEL_CONFIG_2_POINT_1:
return GENMASK(31, 12) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_RIGHT << 4)
| (CATPT_CHANNEL_LFE << 8);
case CATPT_CHANNEL_CONFIG_3_POINT_0:
return GENMASK(31, 12) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_CENTER << 4)
| (CATPT_CHANNEL_RIGHT << 8);
case CATPT_CHANNEL_CONFIG_3_POINT_1:
return GENMASK(31, 16) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_CENTER << 4)
| (CATPT_CHANNEL_RIGHT << 8)
| (CATPT_CHANNEL_LFE << 12);
case CATPT_CHANNEL_CONFIG_QUATRO:
return GENMASK(31, 16) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_RIGHT << 4)
| (CATPT_CHANNEL_LEFT_SURROUND << 8)
| (CATPT_CHANNEL_RIGHT_SURROUND << 12);
case CATPT_CHANNEL_CONFIG_4_POINT_0:
return GENMASK(31, 16) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_CENTER << 4)
| (CATPT_CHANNEL_RIGHT << 8)
| (CATPT_CHANNEL_CENTER_SURROUND << 12);
case CATPT_CHANNEL_CONFIG_5_POINT_0:
return GENMASK(31, 20) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_CENTER << 4)
| (CATPT_CHANNEL_RIGHT << 8)
| (CATPT_CHANNEL_LEFT_SURROUND << 12)
| (CATPT_CHANNEL_RIGHT_SURROUND << 16);
case CATPT_CHANNEL_CONFIG_5_POINT_1:
return GENMASK(31, 24) | CATPT_CHANNEL_CENTER
| (CATPT_CHANNEL_LEFT << 4)
| (CATPT_CHANNEL_RIGHT << 8)
| (CATPT_CHANNEL_LEFT_SURROUND << 12)
| (CATPT_CHANNEL_RIGHT_SURROUND << 16)
| (CATPT_CHANNEL_LFE << 20);
case CATPT_CHANNEL_CONFIG_DUAL_MONO:
return GENMASK(31, 8) | CATPT_CHANNEL_LEFT
| (CATPT_CHANNEL_LEFT << 4);
default:
return U32_MAX;
}
}
static enum catpt_channel_config catpt_get_channel_config(u32 num_channels)
{
switch (num_channels) {
case 6:
return CATPT_CHANNEL_CONFIG_5_POINT_1;
case 5:
return CATPT_CHANNEL_CONFIG_5_POINT_0;
case 4:
return CATPT_CHANNEL_CONFIG_QUATRO;
case 3:
return CATPT_CHANNEL_CONFIG_2_POINT_1;
case 1:
return CATPT_CHANNEL_CONFIG_MONO;
case 2:
default:
return CATPT_CHANNEL_CONFIG_STEREO;
}
}
static int catpt_dai_startup(struct snd_pcm_substream *substream,
struct snd_soc_dai *dai)
{
struct catpt_stream_template *template;
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
struct resource *res;
int ret;
template = catpt_get_stream_template(substream);
stream = kzalloc_obj(*stream);
if (!stream)
return -ENOMEM;
ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, cdev->dev, PAGE_SIZE,
&stream->pgtbl);
if (ret)
goto err_pgtbl;
res = catpt_request_region(&cdev->dram, template->persistent_size);
if (!res) {
ret = -EBUSY;
goto err_request;
}
catpt_dsp_update_srampge(cdev, &cdev->dram, cdev->spec->dram_mask);
stream->template = template;
stream->persistent = res;
stream->substream = substream;
INIT_LIST_HEAD(&stream->node);
snd_soc_dai_set_dma_data(dai, substream, stream);
spin_lock(&cdev->list_lock);
list_add_tail(&stream->node, &cdev->stream_list);
spin_unlock(&cdev->list_lock);
return 0;
err_request:
snd_dma_free_pages(&stream->pgtbl);
err_pgtbl:
kfree(stream);
return ret;
}
static void catpt_dai_shutdown(struct snd_pcm_substream *substream,
struct snd_soc_dai *dai)
{
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
stream = snd_soc_dai_get_dma_data(dai, substream);
spin_lock(&cdev->list_lock);
list_del(&stream->node);
spin_unlock(&cdev->list_lock);
release_resource(stream->persistent);
kfree(stream->persistent);
catpt_dsp_update_srampge(cdev, &cdev->dram, cdev->spec->dram_mask);
snd_dma_free_pages(&stream->pgtbl);
kfree(stream);
snd_soc_dai_set_dma_data(dai, substream, NULL);
}
static int catpt_set_dspvol(struct catpt_dev *cdev, u8 stream_id, long *ctlvol);
static int catpt_dai_apply_usettings(struct snd_soc_dai *dai,
struct catpt_stream_runtime *stream)
{
struct snd_soc_component *component = dai->component;
struct snd_kcontrol *pos;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
const char *name;
int ret;
u32 id = stream->info.stream_hw_id;
switch (id) {
case CATPT_PIN_ID_OFFLOAD1:
name = "Media0 Playback Volume";
break;
case CATPT_PIN_ID_OFFLOAD2:
name = "Media1 Playback Volume";
break;
case CATPT_PIN_ID_CAPTURE1:
name = "Mic Capture Volume";
break;
case CATPT_PIN_ID_REFERENCE:
name = "Loopback Mute";
break;
default:
return 0;
}
list_for_each_entry(pos, &component->card->snd_card->controls, list) {
if (pos->private_data == component &&
!strncmp(name, pos->id.name, sizeof(pos->id.name)))
break;
}
if (list_entry_is_head(pos, &component->card->snd_card->controls, list))
return -ENOENT;
if (stream->template->type != CATPT_STRM_TYPE_LOOPBACK)
return catpt_set_dspvol(cdev, id, (long *)pos->private_value);
ret = catpt_ipc_mute_loopback(cdev, id, *(bool *)pos->private_value);
return CATPT_IPC_RET(ret);
}
static int catpt_dai_hw_params(struct snd_pcm_substream *substream,
struct snd_pcm_hw_params *params,
struct snd_soc_dai *dai)
{
struct snd_pcm_runtime *rtm = substream->runtime;
struct snd_dma_buffer *dmab;
struct catpt_stream_runtime *stream;
struct catpt_audio_format afmt;
struct catpt_ring_info rinfo;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
int ret;
stream = snd_soc_dai_get_dma_data(dai, substream);
if (stream->allocated)
return 0;
memset(&afmt, 0, sizeof(afmt));
afmt.sample_rate = params_rate(params);
afmt.bit_depth = params_physical_width(params);
afmt.valid_bit_depth = params_width(params);
afmt.num_channels = params_channels(params);
afmt.channel_config = catpt_get_channel_config(afmt.num_channels);
afmt.channel_map = catpt_get_channel_map(afmt.channel_config);
afmt.interleaving = CATPT_INTERLEAVING_PER_CHANNEL;
dmab = snd_pcm_get_dma_buf(substream);
catpt_arrange_page_table(substream, &stream->pgtbl);
memset(&rinfo, 0, sizeof(rinfo));
rinfo.page_table_addr = stream->pgtbl.addr;
rinfo.num_pages = DIV_ROUND_UP(rtm->dma_bytes, PAGE_SIZE);
rinfo.size = rtm->dma_bytes;
rinfo.offset = 0;
rinfo.ring_first_page_pfn = PFN_DOWN(snd_sgbuf_get_addr(dmab, 0));
ret = catpt_ipc_alloc_stream(cdev, stream->template->path_id,
stream->template->type,
&afmt, &rinfo,
stream->template->num_entries,
stream->template->entries,
stream->persistent,
cdev->scratch,
&stream->info);
if (ret)
return CATPT_IPC_RET(ret);
ret = catpt_dai_apply_usettings(dai, stream);
if (ret) {
catpt_ipc_free_stream(cdev, stream->info.stream_hw_id);
return ret;
}
stream->allocated = true;
return 0;
}
static int catpt_dai_hw_free(struct snd_pcm_substream *substream,
struct snd_soc_dai *dai)
{
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
stream = snd_soc_dai_get_dma_data(dai, substream);
if (!stream->allocated)
return 0;
catpt_ipc_reset_stream(cdev, stream->info.stream_hw_id);
catpt_ipc_free_stream(cdev, stream->info.stream_hw_id);
stream->allocated = false;
return 0;
}
static int catpt_dai_prepare(struct snd_pcm_substream *substream,
struct snd_soc_dai *dai)
{
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
int ret;
stream = snd_soc_dai_get_dma_data(dai, substream);
if (stream->prepared)
return 0;
ret = catpt_ipc_reset_stream(cdev, stream->info.stream_hw_id);
if (ret)
return CATPT_IPC_RET(ret);
ret = catpt_ipc_pause_stream(cdev, stream->info.stream_hw_id);
if (ret)
return CATPT_IPC_RET(ret);
stream->prepared = true;
return 0;
}
static int catpt_dai_trigger(struct snd_pcm_substream *substream, int cmd,
struct snd_soc_dai *dai)
{
struct snd_pcm_runtime *runtime = substream->runtime;
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
snd_pcm_uframes_t pos;
int ret;
stream = snd_soc_dai_get_dma_data(dai, substream);
switch (cmd) {
case SNDRV_PCM_TRIGGER_START:
if (stream->template->type != CATPT_STRM_TYPE_RENDER)
goto resume_stream;
pos = frames_to_bytes(runtime, runtime->start_threshold);
ret = catpt_ipc_set_write_pos(cdev, stream->info.stream_hw_id,
pos, false, false);
if (ret)
return CATPT_IPC_RET(ret);
fallthrough;
case SNDRV_PCM_TRIGGER_RESUME:
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
resume_stream:
catpt_dsp_update_lpclock(cdev);
ret = catpt_ipc_resume_stream(cdev, stream->info.stream_hw_id);
if (ret)
return CATPT_IPC_RET(ret);
break;
case SNDRV_PCM_TRIGGER_STOP:
stream->prepared = false;
fallthrough;
case SNDRV_PCM_TRIGGER_SUSPEND:
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
ret = catpt_ipc_pause_stream(cdev, stream->info.stream_hw_id);
catpt_dsp_update_lpclock(cdev);
if (ret)
return CATPT_IPC_RET(ret);
break;
default:
break;
}
return 0;
}
void catpt_stream_update_position(struct catpt_dev *cdev,
struct catpt_stream_runtime *stream,
struct catpt_notify_position *pos)
{
struct snd_pcm_substream *substream = stream->substream;
struct snd_pcm_runtime *r = substream->runtime;
snd_pcm_uframes_t dsppos, newpos;
int ret;
dsppos = bytes_to_frames(r, pos->stream_position);
if (!stream->prepared)
goto exit;
if (stream->template->type != CATPT_STRM_TYPE_RENDER)
goto exit;
if (dsppos >= r->buffer_size / 2)
newpos = r->buffer_size / 2;
else
newpos = 0;
ret = catpt_ipc_set_write_pos(cdev, stream->info.stream_hw_id,
frames_to_bytes(r, newpos),
false, false);
if (ret) {
dev_err(cdev->dev, "update position for stream %d failed: %d\n",
stream->info.stream_hw_id, ret);
return;
}
exit:
snd_pcm_period_elapsed(substream);
}
#define CATPT_BUFFER_MAX_SIZE 76800
#define CATPT_PCM_PERIODS_MAX 4
#define CATPT_PCM_PERIODS_MIN 2
static const struct snd_pcm_hardware catpt_pcm_hardware = {
.info = SNDRV_PCM_INFO_MMAP |
SNDRV_PCM_INFO_MMAP_VALID |
SNDRV_PCM_INFO_INTERLEAVED |
SNDRV_PCM_INFO_PAUSE |
SNDRV_PCM_INFO_RESUME |
SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,
.formats = SNDRV_PCM_FMTBIT_S16_LE |
SNDRV_PCM_FMTBIT_S32_LE,
.subformats = SNDRV_PCM_SUBFMTBIT_MSBITS_24 |
SNDRV_PCM_SUBFMTBIT_MSBITS_MAX,
.period_bytes_min = PAGE_SIZE,
.period_bytes_max = CATPT_BUFFER_MAX_SIZE / CATPT_PCM_PERIODS_MIN,
.periods_min = CATPT_PCM_PERIODS_MIN,
.periods_max = CATPT_PCM_PERIODS_MAX,
.buffer_bytes_max = CATPT_BUFFER_MAX_SIZE,
};
static int catpt_component_pcm_construct(struct snd_soc_component *component,
struct snd_soc_pcm_runtime *rtm)
{
struct catpt_dev *cdev = dev_get_drvdata(component->dev);
snd_pcm_set_managed_buffer_all(rtm->pcm, SNDRV_DMA_TYPE_DEV_SG,
cdev->dev,
catpt_pcm_hardware.buffer_bytes_max,
catpt_pcm_hardware.buffer_bytes_max);
return 0;
}
static int catpt_component_open(struct snd_soc_component *component,
struct snd_pcm_substream *substream)
{
struct snd_soc_pcm_runtime *rtm = snd_soc_substream_to_rtd(substream);
if (!rtm->dai_link->no_pcm)
snd_soc_set_runtime_hwparams(substream, &catpt_pcm_hardware);
return 0;
}
static snd_pcm_uframes_t
catpt_component_pointer(struct snd_soc_component *component,
struct snd_pcm_substream *substream)
{
struct snd_soc_pcm_runtime *rtm = snd_soc_substream_to_rtd(substream);
struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtm, 0);
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(component->dev);
u32 pos;
if (rtm->dai_link->no_pcm)
return 0;
stream = snd_soc_dai_get_dma_data(cpu_dai, substream);
catpt_stream_read_position(cdev, stream, &pos);
return bytes_to_frames(substream->runtime, pos);
}
static const struct snd_soc_dai_ops catpt_fe_dai_ops = {
.startup = catpt_dai_startup,
.shutdown = catpt_dai_shutdown,
.hw_params = catpt_dai_hw_params,
.hw_free = catpt_dai_hw_free,
.prepare = catpt_dai_prepare,
.trigger = catpt_dai_trigger,
};
static int catpt_dai_pcm_new(struct snd_soc_pcm_runtime *rtm,
struct snd_soc_dai *dai)
{
struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtm, 0);
struct catpt_ssp_device_format devfmt;
struct catpt_dev *cdev = dev_get_drvdata(dai->dev);
int ret;
devfmt.iface = dai->driver->id;
devfmt.channels = codec_dai->driver->capture.channels_max;
switch (devfmt.iface) {
case CATPT_SSP_IFACE_0:
devfmt.mclk = CATPT_MCLK_FREQ_24_MHZ;
switch (devfmt.channels) {
case 4:
devfmt.mode = CATPT_SSP_MODE_TDM_PROVIDER;
devfmt.clock_divider = 4;
break;
case 2:
default:
devfmt.mode = CATPT_SSP_MODE_I2S_PROVIDER;
devfmt.clock_divider = 9;
break;
}
break;
case CATPT_SSP_IFACE_1:
devfmt.mclk = CATPT_MCLK_OFF;
devfmt.mode = CATPT_SSP_MODE_I2S_CONSUMER;
devfmt.clock_divider = 0;
break;
}
if (!memcmp(&cdev->devfmt[devfmt.iface], &devfmt, sizeof(devfmt)))
return 0;
ret = pm_runtime_resume_and_get(cdev->dev);
if (ret)
return ret;
ret = catpt_ipc_set_device_format(cdev, &devfmt);
pm_runtime_put_autosuspend(cdev->dev);
if (ret)
return CATPT_IPC_RET(ret);
memcpy(&cdev->devfmt[devfmt.iface], &devfmt, sizeof(devfmt));
return 0;
}
static const struct snd_soc_dai_ops catpt_dai_ops = {
.pcm_new = catpt_dai_pcm_new,
};
static struct snd_soc_dai_driver dai_drivers[] = {
{
.name = "System Pin",
.id = CATPT_STRM_TYPE_SYSTEM,
.ops = &catpt_fe_dai_ops,
.playback = {
.stream_name = "System Playback",
.channels_min = 2,
.channels_max = 2,
.rates = SNDRV_PCM_RATE_48000,
.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE,
.subformats = SNDRV_PCM_SUBFMTBIT_MSBITS_24 |
SNDRV_PCM_SUBFMTBIT_MSBITS_MAX,
},
.capture = {
.stream_name = "Analog Capture",
.channels_min = 2,
.channels_max = 4,
.rates = SNDRV_PCM_RATE_48000,
.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE,
.subformats = SNDRV_PCM_SUBFMTBIT_MSBITS_24 |
SNDRV_PCM_SUBFMTBIT_MSBITS_MAX,
},
},
{
.name = "Offload0 Pin",
.id = CATPT_STRM_TYPE_RENDER,
.ops = &catpt_fe_dai_ops,
.playback = {
.stream_name = "Offload0 Playback",
.channels_min = 2,
.channels_max = 2,
.rates = SNDRV_PCM_RATE_8000_192000,
.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE,
.subformats = SNDRV_PCM_SUBFMTBIT_MSBITS_24 |
SNDRV_PCM_SUBFMTBIT_MSBITS_MAX,
},
},
{
.name = "Offload1 Pin",
.id = CATPT_STRM_TYPE_RENDER,
.ops = &catpt_fe_dai_ops,
.playback = {
.stream_name = "Offload1 Playback",
.channels_min = 2,
.channels_max = 2,
.rates = SNDRV_PCM_RATE_8000_192000,
.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE,
.subformats = SNDRV_PCM_SUBFMTBIT_MSBITS_24 |
SNDRV_PCM_SUBFMTBIT_MSBITS_MAX,
},
},
{
.name = "Loopback Pin",
.id = CATPT_STRM_TYPE_LOOPBACK,
.ops = &catpt_fe_dai_ops,
.capture = {
.stream_name = "Loopback Capture",
.channels_min = 2,
.channels_max = 2,
.rates = SNDRV_PCM_RATE_48000,
.formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE,
.subformats = SNDRV_PCM_SUBFMTBIT_MSBITS_24 |
SNDRV_PCM_SUBFMTBIT_MSBITS_MAX,
},
},
{
.name = "Bluetooth Pin",
.id = CATPT_STRM_TYPE_BLUETOOTH_RENDER,
.ops = &catpt_fe_dai_ops,
.playback = {
.stream_name = "Bluetooth Playback",
.channels_min = 1,
.channels_max = 1,
.rates = SNDRV_PCM_RATE_8000,
.formats = SNDRV_PCM_FMTBIT_S16_LE,
},
.capture = {
.stream_name = "Bluetooth Capture",
.channels_min = 1,
.channels_max = 1,
.rates = SNDRV_PCM_RATE_8000,
.formats = SNDRV_PCM_FMTBIT_S16_LE,
},
},
{
.name = "ssp0-port",
.id = CATPT_SSP_IFACE_0,
.playback = {
.channels_min = 1,
.channels_max = 8,
},
.capture = {
.channels_min = 1,
.channels_max = 8,
},
.ops = &catpt_dai_ops,
},
{
.name = "ssp1-port",
.id = CATPT_SSP_IFACE_1,
.playback = {
.channels_min = 1,
.channels_max = 8,
},
.capture = {
.channels_min = 1,
.channels_max = 8,
},
.ops = &catpt_dai_ops,
},
};
#define DSP_VOLUME_MAX S32_MAX
#define DSP_VOLUME_STEP_MAX 30
static u32 ctlvol_to_dspvol(u32 value)
{
if (value > DSP_VOLUME_STEP_MAX)
value = 0;
return DSP_VOLUME_MAX >> (DSP_VOLUME_STEP_MAX - value);
}
static u32 dspvol_to_ctlvol(u32 volume)
{
if (volume > DSP_VOLUME_MAX)
return DSP_VOLUME_STEP_MAX;
return volume ? __fls(volume) : 0;
}
static int catpt_set_dspvol(struct catpt_dev *cdev, u8 stream_id, long *ctlvol)
{
u32 dspvol;
int ret, i;
for (i = 1; i < CATPT_CHANNELS_MAX; i++)
if (ctlvol[i] != ctlvol[0])
break;
if (i == CATPT_CHANNELS_MAX) {
dspvol = ctlvol_to_dspvol(ctlvol[0]);
ret = catpt_ipc_set_volume(cdev, stream_id,
CATPT_ALL_CHANNELS_MASK, dspvol,
0, CATPT_AUDIO_CURVE_NONE);
} else {
for (i = 0; i < CATPT_CHANNELS_MAX; i++) {
dspvol = ctlvol_to_dspvol(ctlvol[i]);
ret = catpt_ipc_set_volume(cdev, stream_id,
i, dspvol,
0, CATPT_AUDIO_CURVE_NONE);
if (ret)
break;
}
}
return CATPT_IPC_RET(ret);
}
static int catpt_volume_info(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_info *uinfo)
{
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
uinfo->count = CATPT_CHANNELS_MAX;
uinfo->value.integer.min = 0;
uinfo->value.integer.max = DSP_VOLUME_STEP_MAX;
return 0;
}
static int catpt_mixer_volume_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
struct catpt_dev *cdev = dev_get_drvdata(component->dev);
u32 dspvol;
int ret;
int i;
ret = pm_runtime_resume_and_get(cdev->dev);
if (ret)
return ret;
for (i = 0; i < CATPT_CHANNELS_MAX; i++) {
dspvol = catpt_mixer_volume(cdev, &cdev->mixer, i);
ucontrol->value.integer.value[i] = dspvol_to_ctlvol(dspvol);
}
pm_runtime_put_autosuspend(cdev->dev);
return 0;
}
static int catpt_mixer_volume_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
struct catpt_dev *cdev = dev_get_drvdata(component->dev);
int ret;
ret = pm_runtime_resume_and_get(cdev->dev);
if (ret)
return ret;
ret = catpt_set_dspvol(cdev, cdev->mixer.mixer_hw_id,
ucontrol->value.integer.value);
pm_runtime_put_autosuspend(cdev->dev);
return ret;
}
static int catpt_stream_volume_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol,
enum catpt_pin_id pin_id)
{
struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(component->dev);
long *ctlvol = (long *)kcontrol->private_value;
u32 dspvol;
int ret;
int i;
stream = catpt_stream_find(cdev, pin_id);
if (!stream) {
for (i = 0; i < CATPT_CHANNELS_MAX; i++)
ucontrol->value.integer.value[i] = ctlvol[i];
return 0;
}
ret = pm_runtime_resume_and_get(cdev->dev);
if (ret)
return ret;
for (i = 0; i < CATPT_CHANNELS_MAX; i++) {
dspvol = catpt_stream_volume(cdev, stream, i);
ucontrol->value.integer.value[i] = dspvol_to_ctlvol(dspvol);
}
pm_runtime_put_autosuspend(cdev->dev);
return 0;
}
static int catpt_stream_volume_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol,
enum catpt_pin_id pin_id)
{
struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(component->dev);
long *ctlvol = (long *)kcontrol->private_value;
int ret, i;
stream = catpt_stream_find(cdev, pin_id);
if (!stream) {
for (i = 0; i < CATPT_CHANNELS_MAX; i++)
ctlvol[i] = ucontrol->value.integer.value[i];
return 0;
}
ret = pm_runtime_resume_and_get(cdev->dev);
if (ret)
return ret;
ret = catpt_set_dspvol(cdev, stream->info.stream_hw_id,
ucontrol->value.integer.value);
pm_runtime_put_autosuspend(cdev->dev);
if (ret)
return ret;
for (i = 0; i < CATPT_CHANNELS_MAX; i++)
ctlvol[i] = ucontrol->value.integer.value[i];
return 0;
}
static int catpt_offload1_volume_get(struct snd_kcontrol *kctl,
struct snd_ctl_elem_value *uctl)
{
return catpt_stream_volume_get(kctl, uctl, CATPT_PIN_ID_OFFLOAD1);
}
static int catpt_offload1_volume_put(struct snd_kcontrol *kctl,
struct snd_ctl_elem_value *uctl)
{
return catpt_stream_volume_put(kctl, uctl, CATPT_PIN_ID_OFFLOAD1);
}
static int catpt_offload2_volume_get(struct snd_kcontrol *kctl,
struct snd_ctl_elem_value *uctl)
{
return catpt_stream_volume_get(kctl, uctl, CATPT_PIN_ID_OFFLOAD2);
}
static int catpt_offload2_volume_put(struct snd_kcontrol *kctl,
struct snd_ctl_elem_value *uctl)
{
return catpt_stream_volume_put(kctl, uctl, CATPT_PIN_ID_OFFLOAD2);
}
static int catpt_capture_volume_get(struct snd_kcontrol *kctl,
struct snd_ctl_elem_value *uctl)
{
return catpt_stream_volume_get(kctl, uctl, CATPT_PIN_ID_CAPTURE1);
}
static int catpt_capture_volume_put(struct snd_kcontrol *kctl,
struct snd_ctl_elem_value *uctl)
{
return catpt_stream_volume_put(kctl, uctl, CATPT_PIN_ID_CAPTURE1);
}
static int catpt_loopback_switch_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
ucontrol->value.integer.value[0] = *(bool *)kcontrol->private_value;
return 0;
}
static int catpt_loopback_switch_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
struct catpt_stream_runtime *stream;
struct catpt_dev *cdev = dev_get_drvdata(component->dev);
bool mute;
int ret;
mute = (bool)ucontrol->value.integer.value[0];
stream = catpt_stream_find(cdev, CATPT_PIN_ID_REFERENCE);
if (!stream) {
*(bool *)kcontrol->private_value = mute;
return 0;
}
ret = pm_runtime_resume_and_get(cdev->dev);
if (ret)
return ret;
ret = catpt_ipc_mute_loopback(cdev, stream->info.stream_hw_id, mute);
pm_runtime_put_autosuspend(cdev->dev);
if (ret)
return CATPT_IPC_RET(ret);
*(bool *)kcontrol->private_value = mute;
return 0;
}
static int catpt_waves_switch_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static int catpt_waves_switch_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static int catpt_waves_param_get(struct snd_kcontrol *kcontrol,
unsigned int __user *bytes,
unsigned int size)
{
return 0;
}
static int catpt_waves_param_put(struct snd_kcontrol *kcontrol,
const unsigned int __user *bytes,
unsigned int size)
{
return 0;
}
static const SNDRV_CTL_TLVD_DECLARE_DB_SCALE(catpt_volume_tlv, -9000, 300, 1);
#define CATPT_VOLUME_CTL(kname, sname) \
{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \
.name = (kname), \
.access = SNDRV_CTL_ELEM_ACCESS_TLV_READ | \
SNDRV_CTL_ELEM_ACCESS_READWRITE, \
.info = catpt_volume_info, \
.get = catpt_##sname##_volume_get, \
.put = catpt_##sname##_volume_put, \
.tlv.p = catpt_volume_tlv, \
.private_value = (unsigned long) \
&(long[CATPT_CHANNELS_MAX]) {0} }
static const struct snd_kcontrol_new component_kcontrols[] = {
CATPT_VOLUME_CTL("Master Playback Volume", mixer),
CATPT_VOLUME_CTL("Media0 Playback Volume", offload1),
CATPT_VOLUME_CTL("Media1 Playback Volume", offload2),
CATPT_VOLUME_CTL("Mic Capture Volume", capture),
SOC_SINGLE_BOOL_EXT("Loopback Mute", (unsigned long)&(bool[1]) {0},
catpt_loopback_switch_get, catpt_loopback_switch_put),
SOC_SINGLE_BOOL_EXT("Waves Switch", 0,
catpt_waves_switch_get, catpt_waves_switch_put),
SND_SOC_BYTES_TLV("Waves Set Param", 128,
catpt_waves_param_get, catpt_waves_param_put),
};
static const struct snd_soc_dapm_widget component_widgets[] = {
SND_SOC_DAPM_AIF_IN("SSP0 CODEC IN", NULL, 0, SND_SOC_NOPM, 0, 0),
SND_SOC_DAPM_AIF_OUT("SSP0 CODEC OUT", NULL, 0, SND_SOC_NOPM, 0, 0),
SND_SOC_DAPM_AIF_IN("SSP1 BT IN", NULL, 0, SND_SOC_NOPM, 0, 0),
SND_SOC_DAPM_AIF_OUT("SSP1 BT OUT", NULL, 0, SND_SOC_NOPM, 0, 0),
SND_SOC_DAPM_MIXER("Playback VMixer", SND_SOC_NOPM, 0, 0, NULL, 0),
};
static const struct snd_soc_dapm_route component_routes[] = {
{"Playback VMixer", NULL, "System Playback"},
{"Playback VMixer", NULL, "Offload0 Playback"},
{"Playback VMixer", NULL, "Offload1 Playback"},
{"SSP0 CODEC OUT", NULL, "Playback VMixer"},
{"Analog Capture", NULL, "SSP0 CODEC IN"},
{"Loopback Capture", NULL, "SSP0 CODEC IN"},
{"SSP1 BT OUT", NULL, "Bluetooth Playback"},
{"Bluetooth Capture", NULL, "SSP1 BT IN"},
};
static const struct snd_soc_component_driver catpt_comp_driver = {
.name = "catpt-platform",
.pcm_construct = catpt_component_pcm_construct,
.open = catpt_component_open,
.pointer = catpt_component_pointer,
.controls = component_kcontrols,
.num_controls = ARRAY_SIZE(component_kcontrols),
.dapm_widgets = component_widgets,
.num_dapm_widgets = ARRAY_SIZE(component_widgets),
.dapm_routes = component_routes,
.num_dapm_routes = ARRAY_SIZE(component_routes),
};
int catpt_arm_stream_templates(struct catpt_dev *cdev)
{
struct resource *res;
u32 scratch_size = 0;
int i, j;
for (i = 0; i < ARRAY_SIZE(catpt_topology); i++) {
struct catpt_stream_template *template;
struct catpt_module_entry *entry;
struct catpt_module_type *type;
template = catpt_topology[i];
template->persistent_size = 0;
for (j = 0; j < template->num_entries; j++) {
entry = &template->entries[j];
type = &cdev->modules[entry->module_id];
if (!type->loaded)
return -ENOENT;
entry->entry_point = type->entry_point;
template->persistent_size += type->persistent_size;
if (type->scratch_size > scratch_size)
scratch_size = type->scratch_size;
}
}
if (scratch_size) {
res = catpt_request_region(&cdev->dram, scratch_size);
if (!res)
return -EBUSY;
cdev->scratch = res;
}
return 0;
}
int catpt_register_plat_component(struct catpt_dev *cdev)
{
struct snd_soc_component *component;
int ret;
component = devm_kzalloc(cdev->dev, sizeof(*component), GFP_KERNEL);
if (!component)
return -ENOMEM;
ret = snd_soc_component_initialize(component, &catpt_comp_driver,
cdev->dev);
if (ret)
return ret;
component->name = catpt_comp_driver.name;
return snd_soc_add_component(component, dai_drivers,
ARRAY_SIZE(dai_drivers));
}
