// SPDX-License-Identifier: GPL-2.0-only // // Copyright(c) 2020 Intel Corporation // // Author: Cezary Rojewski // #include #include #include #include #include #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; /* 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]; } /* Caller responsible for holding ->stream_mutex. */ struct catpt_stream_runtime *catpt_stream_find(struct catpt_dev *cdev, u8 stream_hw_id) { struct catpt_stream_runtime *stream; list_for_each_entry(stream, &cdev->stream_list, node) if (stream->info.stream_hw_id == stream_hw_id) return stream; return NULL; } /* Caller responsible for holding ->stream_mutex. */ static u8 catpt_stream_hw_id(struct catpt_dev *cdev, enum catpt_pin_id pin_id) { struct catpt_stream_runtime *stream; switch (pin_id) { default: stream = catpt_stream_find(cdev, pin_id); if (stream) return stream->info.stream_hw_id; break; case CATPT_PIN_ID_MIXER: if (!list_empty(&cdev->stream_list)) return cdev->mixer.mixer_hw_id; break; } return CATPT_PIN_ID_INVALID; } /* Caller responsible for holding ->stream_mutex. */ static u32 *catpt_stream_volume_regs(struct catpt_dev *cdev, enum catpt_pin_id pin_id) { struct catpt_stream_runtime *stream; switch (pin_id) { case CATPT_PIN_ID_MIXER: if (!list_empty(&cdev->stream_list)) return &cdev->mixer.volume_regaddr[0]; break; default: stream = catpt_stream_find(cdev, pin_id); if (stream) return &stream->info.volume_regaddr[0]; break; } return NULL; } 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 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_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); 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); 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); struct catpt_control_data { enum catpt_pin_id pin_id; long volumes[CATPT_CHANNELS_MAX]; }; static int catpt_apply_volume(struct catpt_dev *cdev, struct snd_soc_card *card, const char *name) { struct snd_kcontrol *kctl = snd_ctl_find_id_mixer(card->snd_card, name); struct catpt_control_data *data; if (!kctl) return -ENOENT; data = (struct catpt_control_data *)kctl->private_value; return catpt_set_dspvol(cdev, data->pin_id, data->volumes); } static int catpt_apply_mute(struct catpt_dev *cdev, struct snd_soc_card *card) { struct snd_kcontrol *kctl = snd_ctl_find_id_mixer(card->snd_card, "Loopback Mute"); bool mute; int ret; if (!kctl) return -ENOENT; mute = *(bool *)kctl->private_value; ret = catpt_ipc_mute_loopback(cdev, CATPT_PIN_ID_REFERENCE, mute); return CATPT_IPC_RET(ret); } static int catpt_apply_controls(struct catpt_dev *cdev, struct snd_soc_card *card, struct catpt_stream_runtime *stream) { int ret; /* Update the master volume when the first stream is opened. */ if (list_empty(&cdev->stream_list)) { ret = catpt_apply_volume(cdev, card, "Master Playback Volume"); if (ret) return ret; } /* Only selected streams have individual controls. */ switch (stream->info.stream_hw_id) { case CATPT_PIN_ID_OFFLOAD1: return catpt_apply_volume(cdev, card, "Media0 Playback Volume"); case CATPT_PIN_ID_OFFLOAD2: return catpt_apply_volume(cdev, card, "Media1 Playback Volume"); case CATPT_PIN_ID_CAPTURE1: return catpt_apply_volume(cdev, card, "Mic Capture Volume"); case CATPT_PIN_ID_REFERENCE: return catpt_apply_mute(cdev, card); default: 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 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); guard(mutex)(&cdev->stream_mutex); ret = catpt_apply_controls(cdev, dai->component->card, stream); if (ret) { catpt_ipc_free_stream(cdev, stream->info.stream_hw_id); return ret; } list_add_tail(&stream->node, &cdev->stream_list); 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; mutex_lock(&cdev->stream_mutex); list_del(&stream->node); mutex_unlock(&cdev->stream_mutex); 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: /* 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_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; /* 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_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_new(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; } /* see if this is a new configuration */ 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); /* store device format set for given SSP */ 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[] = { /* 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_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, }, }, /* BE DAIs */ { .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 /* 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; } } 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_volume_get(struct snd_kcontrol *kctl, struct snd_ctl_elem_value *uctl) { struct snd_soc_component *component = snd_kcontrol_chip(kctl); struct catpt_dev *cdev = dev_get_drvdata(component->dev); struct catpt_control_data *data; u32 dspvol, *regs; long *uvolumes; int i; data = (struct catpt_control_data *)kctl->private_value; uvolumes = &uctl->value.integer.value[0]; guard(mutex)(&cdev->stream_mutex); regs = catpt_stream_volume_regs(cdev, data->pin_id); if (regs) { for (i = 0; i < CATPT_CHANNELS_MAX; i++) { dspvol = readl(cdev->lpe_ba + regs[i]); data->volumes[i] = dspvol_to_ctlvol(dspvol); } } memcpy(uvolumes, data->volumes, sizeof(data->volumes)); return 0; } static int catpt_volume_put(struct snd_kcontrol *kctl, struct snd_ctl_elem_value *uctl) { struct snd_soc_component *component = snd_kcontrol_chip(kctl); struct catpt_dev *cdev = dev_get_drvdata(component->dev); struct catpt_control_data *data; u8 stream_hw_id; long *uvolumes; int ret; data = (struct catpt_control_data *)kctl->private_value; uvolumes = &uctl->value.integer.value[0]; if (!memcmp(data->volumes, uvolumes, sizeof(data->volumes))) return 0; guard(mutex)(&cdev->stream_mutex); stream_hw_id = catpt_stream_hw_id(cdev, data->pin_id); if (stream_hw_id != CATPT_PIN_ID_INVALID) { ret = catpt_set_dspvol(cdev, stream_hw_id, uvolumes); if (ret) return ret; } memcpy(data->volumes, uvolumes, sizeof(data->volumes)); return 1; } static int catpt_loopback_mute_get(struct snd_kcontrol *kctl, struct snd_ctl_elem_value *uctl) { uctl->value.integer.value[0] = *(bool *)kctl->private_value; return 0; } static int catpt_loopback_mute_put(struct snd_kcontrol *kctl, struct snd_ctl_elem_value *uctl) { struct snd_soc_component *component = snd_kcontrol_chip(kctl); struct catpt_dev *cdev = dev_get_drvdata(component->dev); bool *kmute, cmute; u8 stream_hw_id; int ret; kmute = (bool *)kctl->private_value; cmute = (bool)uctl->value.integer.value[0]; if (*kmute == cmute) return 0; guard(mutex)(&cdev->stream_mutex); stream_hw_id = catpt_stream_hw_id(cdev, CATPT_PIN_ID_REFERENCE); if (stream_hw_id != CATPT_PIN_ID_INVALID) { ret = catpt_ipc_mute_loopback(cdev, stream_hw_id, cmute); if (ret) return CATPT_IPC_RET(ret); } *kmute = cmute; return 1; } static bool catpt_loopback_mute; static const SNDRV_CTL_TLVD_DECLARE_DB_SCALE(catpt_volume_tlv, -9000, 300, 1); #define CATPT_VOLUME_CTL(kname, pname) { \ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \ .name = kname, \ .access = SNDRV_CTL_ELEM_ACCESS_READWRITE | \ SNDRV_CTL_ELEM_ACCESS_TLV_READ, \ .info = catpt_volume_info, \ .get = catpt_volume_get, \ .put = catpt_volume_put, \ .tlv.p = catpt_volume_tlv, \ .private_value = (unsigned long) \ &(struct catpt_control_data) { CATPT_PIN_ID_##pname } \ } 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", CAPTURE1), SOC_SINGLE_BOOL_EXT("Loopback Mute", (unsigned long)&catpt_loopback_mute, catpt_loopback_mute_get, catpt_loopback_mute_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_new = catpt_component_pcm_new, .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)); }