mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
1182 lines
31 KiB
1182 lines
31 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
// |
|
// Copyright(c) 2020 Intel Corporation. All rights reserved. |
|
// |
|
// Author: Cezary Rojewski <[email protected]> |
|
// |
|
|
|
#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 = substream->private_data; |
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtm, 0); |
|
enum catpt_stream_type type; |
|
|
|
type = cpu_dai->driver->id; |
|
|
|
/* account for capture in bidirectional dais */ |
|
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 u32 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)); |
|
return 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)); |
|
/* incrementing by 2 on even and 3 on odd */ |
|
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_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct catpt_stream_template *template; |
|
struct catpt_stream_runtime *stream; |
|
struct resource *res; |
|
int ret; |
|
|
|
template = catpt_get_stream_template(substream); |
|
|
|
stream = kzalloc(sizeof(*stream), GFP_KERNEL); |
|
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_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct catpt_stream_runtime *stream; |
|
|
|
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 catpt_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct snd_soc_component *component = dai->component; |
|
struct snd_kcontrol *pos; |
|
const char *name; |
|
int ret; |
|
u32 id = stream->info.stream_hw_id; |
|
|
|
/* only selected streams have individual controls */ |
|
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); |
|
if (ret) |
|
return CATPT_IPC_ERROR(ret); |
|
return 0; |
|
} |
|
|
|
static int catpt_dai_hw_params(struct snd_pcm_substream *substream, |
|
struct snd_pcm_hw_params *params, |
|
struct snd_soc_dai *dai) |
|
{ |
|
struct catpt_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct catpt_stream_runtime *stream; |
|
struct catpt_audio_format afmt; |
|
struct catpt_ring_info rinfo; |
|
struct snd_pcm_runtime *rtm = substream->runtime; |
|
struct snd_dma_buffer *dmab; |
|
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_ERROR(ret); |
|
|
|
ret = catpt_dai_apply_usettings(dai, stream); |
|
if (ret) |
|
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_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct catpt_stream_runtime *stream; |
|
|
|
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_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct catpt_stream_runtime *stream; |
|
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_ERROR(ret); |
|
|
|
ret = catpt_ipc_pause_stream(cdev, stream->info.stream_hw_id); |
|
if (ret) |
|
return CATPT_IPC_ERROR(ret); |
|
|
|
stream->prepared = true; |
|
return 0; |
|
} |
|
|
|
static int catpt_dai_trigger(struct snd_pcm_substream *substream, int cmd, |
|
struct snd_soc_dai *dai) |
|
{ |
|
struct catpt_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct catpt_stream_runtime *stream; |
|
struct snd_pcm_runtime *runtime = substream->runtime; |
|
snd_pcm_uframes_t pos; |
|
int ret; |
|
|
|
stream = snd_soc_dai_get_dma_data(dai, substream); |
|
|
|
switch (cmd) { |
|
case SNDRV_PCM_TRIGGER_START: |
|
/* only offload is set_write_pos driven */ |
|
if (stream->template->type != CATPT_STRM_TYPE_RENDER) |
|
goto resume_stream; |
|
|
|
pos = frames_to_bytes(runtime, runtime->start_threshold); |
|
/* |
|
* Dsp operates on buffer halves, thus max 2x set_write_pos |
|
* (entire buffer filled) prior to stream start. |
|
*/ |
|
ret = catpt_ipc_set_write_pos(cdev, stream->info.stream_hw_id, |
|
pos, false, false); |
|
if (ret) |
|
return CATPT_IPC_ERROR(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_ERROR(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_ERROR(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; |
|
/* only offload is set_write_pos driven */ |
|
if (stream->template->type != CATPT_STRM_TYPE_RENDER) |
|
goto exit; |
|
|
|
if (dsppos >= r->buffer_size / 2) |
|
newpos = r->buffer_size / 2; |
|
else |
|
newpos = 0; |
|
/* |
|
* Dsp operates on buffer halves, thus on every notify position |
|
* (buffer half consumed) update wp to allow stream progression. |
|
*/ |
|
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); |
|
} |
|
|
|
/* 200 ms for 2 32-bit channels at 48kHz (native format) */ |
|
#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_S24_LE | |
|
SNDRV_PCM_FMTBIT_S32_LE, |
|
.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 = substream->private_data; |
|
|
|
if (rtm->dai_link->no_pcm) |
|
return 0; |
|
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 catpt_dev *cdev = dev_get_drvdata(component->dev); |
|
struct catpt_stream_runtime *stream; |
|
struct snd_soc_pcm_runtime *rtm = substream->private_data; |
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtm, 0); |
|
u32 pos; |
|
|
|
if (rtm->dai_link->no_pcm) |
|
return 0; |
|
|
|
stream = snd_soc_dai_get_dma_data(cpu_dai, substream); |
|
pos = catpt_stream_read_position(cdev, stream); |
|
|
|
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 = asoc_rtd_to_codec(rtm, 0); |
|
struct catpt_dev *cdev = dev_get_drvdata(dai->dev); |
|
struct catpt_ssp_device_format devfmt; |
|
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; |
|
} |
|
|
|
/* see if this is a new configuration */ |
|
if (!memcmp(&cdev->devfmt[devfmt.iface], &devfmt, sizeof(devfmt))) |
|
return 0; |
|
|
|
pm_runtime_get_sync(cdev->dev); |
|
|
|
ret = catpt_ipc_set_device_format(cdev, &devfmt); |
|
|
|
pm_runtime_mark_last_busy(cdev->dev); |
|
pm_runtime_put_autosuspend(cdev->dev); |
|
|
|
if (ret) |
|
return CATPT_IPC_ERROR(ret); |
|
|
|
/* store device format set for given SSP */ |
|
memcpy(&cdev->devfmt[devfmt.iface], &devfmt, sizeof(devfmt)); |
|
return 0; |
|
} |
|
|
|
static struct snd_soc_dai_driver dai_drivers[] = { |
|
/* FE DAIs */ |
|
{ |
|
.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_S24_LE, |
|
}, |
|
.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_S24_LE, |
|
}, |
|
}, |
|
{ |
|
.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_S24_LE, |
|
}, |
|
}, |
|
{ |
|
.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_S24_LE, |
|
}, |
|
}, |
|
{ |
|
.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_S24_LE, |
|
}, |
|
}, |
|
{ |
|
.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, |
|
}, |
|
}, |
|
/* BE DAIs */ |
|
{ |
|
.name = "ssp0-port", |
|
.id = CATPT_SSP_IFACE_0, |
|
.pcm_new = catpt_dai_pcm_new, |
|
.playback = { |
|
.channels_min = 1, |
|
.channels_max = 8, |
|
}, |
|
.capture = { |
|
.channels_min = 1, |
|
.channels_max = 8, |
|
}, |
|
}, |
|
{ |
|
.name = "ssp1-port", |
|
.id = CATPT_SSP_IFACE_1, |
|
.pcm_new = catpt_dai_pcm_new, |
|
.playback = { |
|
.channels_min = 1, |
|
.channels_max = 8, |
|
}, |
|
.capture = { |
|
.channels_min = 1, |
|
.channels_max = 8, |
|
}, |
|
}, |
|
}; |
|
|
|
#define DSP_VOLUME_MAX S32_MAX /* 0db */ |
|
#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; |
|
} |
|
} |
|
|
|
if (ret) |
|
return CATPT_IPC_ERROR(ret); |
|
return 0; |
|
} |
|
|
|
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_soc_kcontrol_component(kcontrol); |
|
struct catpt_dev *cdev = dev_get_drvdata(component->dev); |
|
u32 dspvol; |
|
int i; |
|
|
|
pm_runtime_get_sync(cdev->dev); |
|
|
|
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_mark_last_busy(cdev->dev); |
|
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_soc_kcontrol_component(kcontrol); |
|
struct catpt_dev *cdev = dev_get_drvdata(component->dev); |
|
int ret; |
|
|
|
pm_runtime_get_sync(cdev->dev); |
|
|
|
ret = catpt_set_dspvol(cdev, cdev->mixer.mixer_hw_id, |
|
ucontrol->value.integer.value); |
|
|
|
pm_runtime_mark_last_busy(cdev->dev); |
|
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_soc_kcontrol_component(kcontrol); |
|
struct catpt_dev *cdev = dev_get_drvdata(component->dev); |
|
struct catpt_stream_runtime *stream; |
|
long *ctlvol = (long *)kcontrol->private_value; |
|
u32 dspvol; |
|
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; |
|
} |
|
|
|
pm_runtime_get_sync(cdev->dev); |
|
|
|
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_mark_last_busy(cdev->dev); |
|
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_soc_kcontrol_component(kcontrol); |
|
struct catpt_dev *cdev = dev_get_drvdata(component->dev); |
|
struct catpt_stream_runtime *stream; |
|
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; |
|
} |
|
|
|
pm_runtime_get_sync(cdev->dev); |
|
|
|
ret = catpt_set_dspvol(cdev, stream->info.stream_hw_id, |
|
ucontrol->value.integer.value); |
|
|
|
pm_runtime_mark_last_busy(cdev->dev); |
|
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_soc_kcontrol_component(kcontrol); |
|
struct catpt_dev *cdev = dev_get_drvdata(component->dev); |
|
struct catpt_stream_runtime *stream; |
|
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; |
|
} |
|
|
|
pm_runtime_get_sync(cdev->dev); |
|
|
|
ret = catpt_ipc_mute_loopback(cdev, stream->info.stream_hw_id, mute); |
|
|
|
pm_runtime_mark_last_busy(cdev->dev); |
|
pm_runtime_put_autosuspend(cdev->dev); |
|
|
|
if (ret) |
|
return CATPT_IPC_ERROR(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[] = { |
|
/* Master volume (mixer stream) */ |
|
CATPT_VOLUME_CTL("Master Playback Volume", mixer), |
|
/* Individual volume controls for offload and capture */ |
|
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), |
|
/* Enable or disable WAVES module */ |
|
SOC_SINGLE_BOOL_EXT("Waves Switch", 0, |
|
catpt_waves_switch_get, catpt_waves_switch_put), |
|
/* WAVES module parameter control */ |
|
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) { |
|
/* allocate single scratch area for all modules */ |
|
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)); |
|
}
|
|
|