mirror of
https://github.com/alsa-project/alsa-utils
synced 2024-11-14 05:15:43 +01:00
153d185822
Signed-off-by: Jaroslav Kysela <perex@perex.cz>
648 lines
20 KiB
C
648 lines
20 KiB
C
// SPDX-License-Identifier: BSD-3-Clause
|
|
//
|
|
// Copyright(c) 2021 Intel Corporation. All rights reserved.
|
|
//
|
|
// Author: Jaska Uimonen <jaska.uimonen@linux.intel.com>
|
|
|
|
#include <stdint.h>
|
|
#include <errno.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <alsa/input.h>
|
|
#include <alsa/output.h>
|
|
#include <alsa/conf.h>
|
|
#include <alsa/error.h>
|
|
#include "intel-nhlt.h"
|
|
#include "ssp-nhlt.h"
|
|
#include "ssp/ssp-process.h"
|
|
#include "ssp/ssp-internal.h"
|
|
|
|
static int set_mn_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long m_div;
|
|
long n_div;
|
|
long ret;
|
|
|
|
struct dai_values ssp_mn_data[] = {
|
|
{"m_div", SND_CONFIG_TYPE_INTEGER, NULL, &m_div, NULL},
|
|
{"n_div", SND_CONFIG_TYPE_INTEGER, NULL, &n_div, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_mn_data[0], ARRAY_SIZE(ssp_mn_data), cfg, top,
|
|
"Class.Base.mn_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_mn_set_params(nhlt, m_div, n_div);
|
|
}
|
|
|
|
static int set_clk_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long clock_warm_up;
|
|
long mclk;
|
|
long warm_up_ovr;
|
|
long clock_stop_delay;
|
|
long keep_running;
|
|
long clock_stop_ovr;
|
|
long ret;
|
|
|
|
struct dai_values ssp_clk_data[] = {
|
|
{"clock_warm_up", SND_CONFIG_TYPE_INTEGER, NULL, &clock_warm_up, NULL},
|
|
{"mclk", SND_CONFIG_TYPE_INTEGER, NULL, &mclk, NULL},
|
|
{"warm_up_ovr", SND_CONFIG_TYPE_INTEGER, NULL, &warm_up_ovr, NULL},
|
|
{"clock_stop_delay", SND_CONFIG_TYPE_INTEGER, NULL, &clock_stop_delay, NULL},
|
|
{"keep_running", SND_CONFIG_TYPE_INTEGER, NULL, &keep_running, NULL},
|
|
{"clock_stop_ovr", SND_CONFIG_TYPE_INTEGER, NULL, &clock_stop_ovr, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_clk_data[0], ARRAY_SIZE(ssp_clk_data), cfg, top,
|
|
"Class.Base.clk_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_clk_set_params(nhlt, clock_warm_up, mclk, warm_up_ovr, clock_stop_delay,
|
|
keep_running, clock_stop_ovr);
|
|
}
|
|
|
|
static int set_tr_start_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long sampling_frequency;
|
|
long bit_depth;
|
|
long channel_map;
|
|
long channel_config;
|
|
long interleaving_style;
|
|
long number_of_channels;
|
|
long valid_bit_depth;
|
|
long sample_type;
|
|
long ret;
|
|
|
|
struct dai_values ssp_tr_data[] = {
|
|
{"sampling_frequency", SND_CONFIG_TYPE_INTEGER, NULL, &sampling_frequency, NULL},
|
|
{"bit_depth", SND_CONFIG_TYPE_INTEGER, NULL, &bit_depth, NULL},
|
|
{"channel_map", SND_CONFIG_TYPE_INTEGER, NULL, &channel_map, NULL},
|
|
{"channel_config", SND_CONFIG_TYPE_INTEGER, NULL, &channel_config, NULL},
|
|
{"interleaving_style", SND_CONFIG_TYPE_INTEGER, NULL, &interleaving_style, NULL},
|
|
{"number_of_channels", SND_CONFIG_TYPE_INTEGER, NULL, &number_of_channels, NULL},
|
|
{"valid_bit_depth", SND_CONFIG_TYPE_INTEGER, NULL, &valid_bit_depth, NULL},
|
|
{"sample_type", SND_CONFIG_TYPE_INTEGER, NULL, &sample_type, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_tr_data[0], ARRAY_SIZE(ssp_tr_data), cfg, top,
|
|
"Class.Base.tr_start_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_tr_start_set_params(nhlt, sampling_frequency, bit_depth, channel_map,
|
|
channel_config, interleaving_style, number_of_channels,
|
|
valid_bit_depth,sample_type);
|
|
}
|
|
|
|
static int set_tr_stop_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long sampling_frequency;
|
|
long bit_depth;
|
|
long channel_map;
|
|
long channel_config;
|
|
long interleaving_style;
|
|
long number_of_channels;
|
|
long valid_bit_depth;
|
|
long sample_type;
|
|
long ret;
|
|
|
|
struct dai_values ssp_tr_data[] = {
|
|
{"sampling_frequency", SND_CONFIG_TYPE_INTEGER, NULL, &sampling_frequency, NULL},
|
|
{"bit_depth", SND_CONFIG_TYPE_INTEGER, NULL, &bit_depth, NULL},
|
|
{"channel_map", SND_CONFIG_TYPE_INTEGER, NULL, &channel_map, NULL},
|
|
{"channel_config", SND_CONFIG_TYPE_INTEGER, NULL, &channel_config, NULL},
|
|
{"interleaving_style", SND_CONFIG_TYPE_INTEGER, NULL, &interleaving_style, NULL},
|
|
{"number_of_channels", SND_CONFIG_TYPE_INTEGER, NULL, &number_of_channels, NULL},
|
|
{"valid_bit_depth", SND_CONFIG_TYPE_INTEGER, NULL, &valid_bit_depth, NULL},
|
|
{"sample_type", SND_CONFIG_TYPE_INTEGER, NULL, &sample_type, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_tr_data[0], ARRAY_SIZE(ssp_tr_data), cfg, top,
|
|
"Class.Base.tr_stop_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_tr_stop_set_params(nhlt, sampling_frequency, bit_depth, channel_map,
|
|
channel_config, interleaving_style, number_of_channels,
|
|
valid_bit_depth,sample_type);
|
|
}
|
|
|
|
static int set_run_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long always_run;
|
|
long ret;
|
|
|
|
struct dai_values ssp_run_data[] = {
|
|
{"always_run", SND_CONFIG_TYPE_INTEGER, NULL, &always_run, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_run_data[0], ARRAY_SIZE(ssp_run_data), cfg, top,
|
|
"Class.Base.run_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_run_set_params(nhlt, always_run);
|
|
}
|
|
|
|
static int set_node_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long sampling_rate;
|
|
long node_id;
|
|
long ret;
|
|
|
|
struct dai_values ssp_node_data[] = {
|
|
{"node_id", SND_CONFIG_TYPE_INTEGER, NULL, &node_id, NULL},
|
|
{"sampling_rate", SND_CONFIG_TYPE_INTEGER, NULL, &sampling_rate, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_node_data[0], ARRAY_SIZE(ssp_node_data), cfg, top,
|
|
"Class.Base.node_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_node_set_params(nhlt, node_id, sampling_rate);
|
|
}
|
|
|
|
static int set_sync_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long sync_denominator;
|
|
long ret;
|
|
|
|
struct dai_values ssp_sync_data[] = {
|
|
{"sync_denominator", SND_CONFIG_TYPE_INTEGER, NULL, &sync_denominator, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_sync_data[0], ARRAY_SIZE(ssp_sync_data), cfg, top,
|
|
"Class.Base.sync_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_sync_set_params(nhlt, sync_denominator);
|
|
}
|
|
|
|
static int set_ext_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long mclk_policy_override;
|
|
long mclk_always_running;
|
|
long mclk_starts_on_gtw_init;
|
|
long mclk_starts_on_run;
|
|
long mclk_starts_on_pause;
|
|
long mclk_stops_on_pause;
|
|
long mclk_stops_on_reset;
|
|
|
|
long bclk_policy_override;
|
|
long bclk_always_running;
|
|
long bclk_starts_on_gtw_init;
|
|
long bclk_starts_on_run;
|
|
long bclk_starts_on_pause;
|
|
long bclk_stops_on_pause;
|
|
long bclk_stops_on_reset;
|
|
|
|
long sync_policy_override;
|
|
long sync_always_running;
|
|
long sync_starts_on_gtw_init;
|
|
long sync_starts_on_run;
|
|
long sync_starts_on_pause;
|
|
long sync_stops_on_pause;
|
|
long sync_stops_on_reset;
|
|
long ret;
|
|
|
|
struct dai_values ssp_ext_data[] = {
|
|
{"mclk_policy_override", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_policy_override, NULL},
|
|
{"mclk_always_running", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_always_running, NULL},
|
|
{"mclk_starts_on_gtw_init", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_starts_on_gtw_init, NULL},
|
|
{"mclk_starts_on_run", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_starts_on_run, NULL},
|
|
{"mclk_starts_on_pause", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_starts_on_pause, NULL},
|
|
{"mclk_stops_on_pause", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_stops_on_pause, NULL},
|
|
{"mclk_stops_on_reset", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_stops_on_reset, NULL},
|
|
{"bclk_policy_override", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_policy_override, NULL},
|
|
{"bclk_always_running", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_always_running, NULL},
|
|
{"bclk_starts_on_gtw_init", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_starts_on_gtw_init, NULL},
|
|
{"bclk_starts_on_run", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_starts_on_run, NULL},
|
|
{"bclk_starts_on_pause", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_starts_on_pause, NULL},
|
|
{"bclk_stops_on_pause", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_stops_on_pause, NULL},
|
|
{"bclk_stops_on_reset", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_stops_on_reset, NULL},
|
|
{"sync_policy_override", SND_CONFIG_TYPE_INTEGER, NULL, &sync_policy_override, NULL},
|
|
{"sync_always_running", SND_CONFIG_TYPE_INTEGER, NULL, &sync_always_running, NULL},
|
|
{"sync_starts_on_gtw_init", SND_CONFIG_TYPE_INTEGER, NULL, &sync_starts_on_gtw_init, NULL},
|
|
{"sync_starts_on_run", SND_CONFIG_TYPE_INTEGER, NULL, &sync_starts_on_run, NULL},
|
|
{"sync_starts_on_pause", SND_CONFIG_TYPE_INTEGER, NULL, &sync_starts_on_pause, NULL},
|
|
{"sync_stops_on_pause", SND_CONFIG_TYPE_INTEGER, NULL, &sync_stops_on_pause, NULL},
|
|
{"sync_stops_on_reset", SND_CONFIG_TYPE_INTEGER, NULL, &sync_stops_on_reset, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_ext_data[0], ARRAY_SIZE(ssp_ext_data), cfg, top,
|
|
"Class.Base.ext_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_ext_set_params(nhlt, mclk_policy_override, mclk_always_running,
|
|
mclk_starts_on_gtw_init, mclk_starts_on_run, mclk_starts_on_pause,
|
|
mclk_stops_on_pause, mclk_stops_on_reset,
|
|
bclk_policy_override, bclk_always_running,
|
|
bclk_starts_on_gtw_init, bclk_starts_on_run, bclk_starts_on_pause,
|
|
bclk_stops_on_pause, bclk_stops_on_reset,
|
|
sync_policy_override, sync_always_running,
|
|
sync_starts_on_gtw_init, sync_starts_on_run, sync_starts_on_pause,
|
|
sync_stops_on_pause, sync_stops_on_reset);
|
|
}
|
|
|
|
static int set_link_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
long clock_source;
|
|
long ret;
|
|
|
|
struct dai_values ssp_link_data[] = {
|
|
{"clock_source", SND_CONFIG_TYPE_INTEGER, NULL, &clock_source, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_link_data[0], ARRAY_SIZE(ssp_link_data), cfg, top,
|
|
"Class.Base.link_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_link_set_params(nhlt, clock_source);
|
|
}
|
|
|
|
static int set_aux_params(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
struct aux_map {
|
|
const char *name;
|
|
int id;
|
|
};
|
|
|
|
struct aux_map aux_maps[] = {
|
|
{ "Object.Base.mn_config", SSP_MN_DIVIDER_CONTROLS },
|
|
{"Object.Base.clk_config", SSP_DMA_CLK_CONTROLS },
|
|
{"Object.Base.tr_start_config", SSP_DMA_TRANSMISSION_START },
|
|
{"Object.Base.tr_stop_config", SSP_DMA_TRANSMISSION_STOP },
|
|
{"Object.Base.run_config", SSP_DMA_ALWAYS_RUNNING_MODE} ,
|
|
{"Object.Base.sync_config", SSP_DMA_SYNC_DATA },
|
|
{"Object.Base.ext_config", SSP_DMA_CLK_CONTROLS_EXT },
|
|
{"Object.Base.link_config", SSP_LINK_CLK_SOURCE },
|
|
{"Object.Base.node_config", SSP_DMA_SYNC_NODE },
|
|
};
|
|
|
|
snd_config_iterator_t iter, next;
|
|
snd_config_t *items, *n;
|
|
const char *id;
|
|
unsigned int i;
|
|
int ret = 0;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(aux_maps); i++) {
|
|
if (snd_config_search(cfg, aux_maps[i].name, &items) < 0)
|
|
continue;
|
|
|
|
snd_config_for_each(iter, next, items) {
|
|
n = snd_config_iterator_entry(iter);
|
|
|
|
if (snd_config_get_id(n, &id) < 0)
|
|
continue;
|
|
|
|
switch(aux_maps[i].id) {
|
|
case SSP_MN_DIVIDER_CONTROLS:
|
|
ret = set_mn_config(nhlt, n, top);
|
|
break;
|
|
case SSP_DMA_CLK_CONTROLS:
|
|
ret = set_clk_config(nhlt, n, top);
|
|
break;
|
|
case SSP_DMA_TRANSMISSION_START:
|
|
ret = set_tr_start_config(nhlt, n, top);
|
|
break;
|
|
case SSP_DMA_TRANSMISSION_STOP:
|
|
ret = set_tr_stop_config(nhlt, n, top);
|
|
break;
|
|
case SSP_DMA_ALWAYS_RUNNING_MODE:
|
|
ret = set_run_config(nhlt, n, top);
|
|
break;
|
|
case SSP_DMA_SYNC_DATA:
|
|
ret = set_sync_config(nhlt, n, top);
|
|
break;
|
|
case SSP_DMA_CLK_CONTROLS_EXT:
|
|
ret = set_ext_config(nhlt, n, top);
|
|
break;
|
|
case SSP_LINK_CLK_SOURCE:
|
|
ret = set_link_config(nhlt, n, top);
|
|
break;
|
|
case SSP_DMA_SYNC_NODE:
|
|
ret = set_node_config(nhlt, n, top);
|
|
break;
|
|
default:
|
|
ret = -EINVAL;
|
|
}
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int set_hw_config(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
const char *format = NULL;
|
|
const char *mclk = NULL;
|
|
const char *bclk = NULL;
|
|
const char *bclk_invert = NULL;
|
|
const char *fsync = NULL;
|
|
const char *fsync_invert = NULL;
|
|
long mclk_freq = 0;
|
|
long bclk_freq = 0;
|
|
long fsync_freq = 0;
|
|
long tdm_slots = 0;
|
|
long tdm_slot_width = 0;
|
|
long tx_slots = 0;
|
|
long rx_slots = 0;
|
|
long ret;
|
|
|
|
struct dai_values ssp_hw_data[] = {
|
|
{"format", SND_CONFIG_TYPE_STRING, NULL, NULL, &format},
|
|
{"mclk", SND_CONFIG_TYPE_STRING, NULL, NULL, &mclk},
|
|
{"bclk", SND_CONFIG_TYPE_STRING, NULL, NULL, &bclk},
|
|
{"fsync", SND_CONFIG_TYPE_STRING, NULL, NULL, &fsync},
|
|
{"bclk_invert", SND_CONFIG_TYPE_STRING, NULL, NULL, &bclk_invert},
|
|
{"fsync_invert", SND_CONFIG_TYPE_STRING, NULL, NULL, &fsync_invert},
|
|
{"fsync_freq", SND_CONFIG_TYPE_INTEGER, NULL, &fsync_freq, NULL},
|
|
{"bclk_freq", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_freq, NULL},
|
|
{"mclk_freq", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_freq, NULL},
|
|
{"tdm_slots", SND_CONFIG_TYPE_INTEGER, NULL, &tdm_slots, NULL},
|
|
{"tdm_slot_width", SND_CONFIG_TYPE_INTEGER, NULL, &tdm_slot_width, NULL},
|
|
{"tx_slots", SND_CONFIG_TYPE_INTEGER, NULL, &tx_slots, NULL},
|
|
{"rx_slots", SND_CONFIG_TYPE_INTEGER, NULL, &rx_slots, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_hw_data[0], ARRAY_SIZE(ssp_hw_data), cfg, top,
|
|
"Class.Base.hw_config");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = set_aux_params(nhlt, cfg, top);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_hw_set_params(nhlt, format, mclk, bclk, bclk_invert, fsync, fsync_invert,
|
|
mclk_freq, bclk_freq, fsync_freq, tdm_slots, tdm_slot_width,
|
|
tx_slots, rx_slots);
|
|
}
|
|
|
|
static int set_ssp_data(struct intel_nhlt_params *nhlt, snd_config_t *dai_cfg, snd_config_t *top)
|
|
{
|
|
const char *tdm_padding_per_slot = NULL;
|
|
const char *direction = NULL;
|
|
const char *quirks = NULL;
|
|
long frame_pulse_width = 0;
|
|
long clks_control = 0;
|
|
long sample_bits = 0;
|
|
long bclk_delay = 0;
|
|
long version = 0;
|
|
long dai_index = 0;
|
|
long mclk_id = 0;
|
|
long io_clk = 0;
|
|
int ret;
|
|
|
|
struct dai_values ssp_data[] = {
|
|
{ "io_clk", SND_CONFIG_TYPE_INTEGER, NULL, &io_clk, NULL},
|
|
{ "direction", SND_CONFIG_TYPE_STRING, NULL, NULL, &direction},
|
|
{ "quirks", SND_CONFIG_TYPE_STRING, NULL, NULL, &quirks},
|
|
{ "dai_index", SND_CONFIG_TYPE_INTEGER, NULL, &dai_index, NULL},
|
|
{ "sample_bits", SND_CONFIG_TYPE_INTEGER, NULL, &sample_bits, NULL},
|
|
{ "bclk_delay", SND_CONFIG_TYPE_INTEGER, NULL, &bclk_delay, NULL},
|
|
{ "mclk_id", SND_CONFIG_TYPE_INTEGER, NULL, &mclk_id, NULL},
|
|
{ "clks_control", SND_CONFIG_TYPE_INTEGER, NULL, &clks_control, NULL},
|
|
{ "frame_pulse_width", SND_CONFIG_TYPE_INTEGER, NULL, &frame_pulse_width, NULL},
|
|
{ "tdm_padding_per_slot", SND_CONFIG_TYPE_STRING, NULL, NULL,
|
|
&tdm_padding_per_slot},
|
|
{ "version", SND_CONFIG_TYPE_INTEGER, NULL, &version, NULL},
|
|
};
|
|
|
|
ret = find_set_values(&ssp_data[0], ARRAY_SIZE(ssp_data), dai_cfg, top, "Class.Dai.SSP");
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ssp_set_params(nhlt, direction, dai_index, io_clk, bclk_delay, sample_bits, mclk_id,
|
|
clks_control, frame_pulse_width, tdm_padding_per_slot, quirks,
|
|
version);
|
|
}
|
|
|
|
/* init ssp parameters, should be called before parsing dais */
|
|
int nhlt_ssp_init_params(struct intel_nhlt_params *nhlt)
|
|
{
|
|
return ssp_init_params(nhlt);
|
|
}
|
|
|
|
int nhlt_ssp_get_ep_count(struct intel_nhlt_params *nhlt)
|
|
{
|
|
return ssp_get_vendor_blob_count(nhlt);
|
|
}
|
|
|
|
int nhlt_ssp_get_dir(struct intel_nhlt_params *nhlt, int dai_index, uint8_t *dir)
|
|
{
|
|
return ssp_get_dir(nhlt, dai_index, dir);
|
|
}
|
|
|
|
int nhlt_ssp_get_ep(struct intel_nhlt_params *nhlt, struct endpoint_descriptor **eps,
|
|
int dai_index, uint8_t dir)
|
|
{
|
|
struct endpoint_descriptor ep;
|
|
struct ssp_device_specific_config ssp_conf;
|
|
struct formats_config f_conf;
|
|
struct format_config f_conf1[8];
|
|
uint32_t sample_rate;
|
|
uint16_t channel_count;
|
|
uint32_t bits_per_sample;
|
|
uint32_t virtualbus_id;
|
|
uint32_t formats_count;
|
|
uint32_t device_type;
|
|
uint32_t direction = dir;
|
|
uint8_t *ep_target;
|
|
size_t blob_size;
|
|
int ret;
|
|
int i;
|
|
|
|
/*
|
|
* nhlt ssp structure:
|
|
*
|
|
* endpoint_descriptor, sizeof(struct endpoint_descriptor)
|
|
* device_specific_config (headset), sizeof(struct ssp_device_specific_config)
|
|
* formats_config (formats_count), sizeof(struct formats_config)
|
|
* format_config (waveex), sizeof(struct format_config)
|
|
* vendor_blob sizeof(vendor_blob)
|
|
*/
|
|
|
|
ret = ssp_get_params(nhlt, dai_index, &virtualbus_id, &formats_count,
|
|
&device_type, &direction);
|
|
if (ret < 0) {
|
|
fprintf(stderr, "nhlt_ssp_get_ep: ssp_get_params failed\n");
|
|
return ret;
|
|
}
|
|
|
|
ep.link_type = NHLT_LINK_TYPE_SSP;
|
|
ep.instance_id = 0;
|
|
ep.vendor_id = NHLT_VENDOR_ID_INTEL;
|
|
ep.device_id = NHLT_DEVICE_ID_INTEL_I2S_TDM;
|
|
ep.revision_id = 0;
|
|
ep.subsystem_id = 0;
|
|
ep.device_type = device_type;
|
|
|
|
ep.direction = direction;
|
|
/* ssp device index */
|
|
ep.virtualbus_id = virtualbus_id;
|
|
/* ssp config */
|
|
ssp_conf.config.capabilities_size = 2;
|
|
ssp_conf.device_config.virtual_slot = 0;
|
|
ssp_conf.device_config.config_type = 0;
|
|
|
|
/* formats_config */
|
|
f_conf.formats_count = formats_count;
|
|
|
|
for (i = 0; i < f_conf.formats_count; i++) {
|
|
/* fill in wave format extensible types */
|
|
f_conf1[i].format.wFormatTag = 0xFFFE;
|
|
|
|
ret = ssp_get_hw_params(nhlt, dai_index, i, &sample_rate, &channel_count,
|
|
&bits_per_sample);
|
|
|
|
if (ret < 0) {
|
|
fprintf(stderr, "nhlt_ssp_get_ep: ssp_get_hw_params failed\n");
|
|
return ret;
|
|
}
|
|
|
|
f_conf1[i].format.nChannels = channel_count;
|
|
f_conf1[i].format.nSamplesPerSec = sample_rate;
|
|
f_conf1[i].format.wBitsPerSample = bits_per_sample;
|
|
f_conf1[i].format.nBlockAlign = channel_count * bits_per_sample / 8;
|
|
f_conf1[i].format.nAvgBytesPerSec = sample_rate * f_conf1[i].format.nBlockAlign;
|
|
|
|
/* bytes after this value in this struct */
|
|
f_conf1[i].format.cbSize = 22;
|
|
/* actual bits in container */
|
|
f_conf1[i].format.wValidBitsPerSample = bits_per_sample;
|
|
/* channel map not used at this time */
|
|
f_conf1[i].format.dwChannelMask = 0;
|
|
/* WAVE_FORMAT_PCM guid (0x0001) ? */
|
|
f_conf1[i].format.SubFormat[0] = 0;
|
|
f_conf1[i].format.SubFormat[1] = 0;
|
|
f_conf1[i].format.SubFormat[2] = 0;
|
|
f_conf1[i].format.SubFormat[3] = 0;
|
|
|
|
ret = ssp_get_vendor_blob_size(nhlt, dai_index, i, &blob_size);
|
|
if (ret < 0) {
|
|
fprintf(stderr, "nhlt_ssp_get_ep: dmic_get_vendor_blob_size failed\n");
|
|
return ret;
|
|
}
|
|
f_conf1[i].vendor_blob.capabilities_size = blob_size;
|
|
}
|
|
|
|
ep.length = sizeof(struct endpoint_descriptor) +
|
|
sizeof(struct ssp_device_specific_config) +
|
|
sizeof(struct formats_config) +
|
|
sizeof(struct format_config) * f_conf.formats_count +
|
|
blob_size * f_conf.formats_count;
|
|
|
|
/* allocate the final variable length ep struct */
|
|
ep_target = calloc(ep.length, sizeof(uint8_t));
|
|
if (!ep_target)
|
|
return -ENOMEM;
|
|
|
|
*eps = (struct endpoint_descriptor *)ep_target;
|
|
|
|
/* copy all parsed sub arrays into the top level array */
|
|
memcpy(ep_target, &ep, sizeof(struct endpoint_descriptor));
|
|
|
|
ep_target += sizeof(struct endpoint_descriptor);
|
|
|
|
memcpy(ep_target, &ssp_conf, sizeof(struct ssp_device_specific_config));
|
|
ep_target += sizeof(struct ssp_device_specific_config);
|
|
|
|
memcpy(ep_target, &f_conf, sizeof(struct formats_config));
|
|
ep_target += sizeof(struct formats_config);
|
|
|
|
/* copy all hw configs */
|
|
for (i = 0; i < f_conf.formats_count; i++) {
|
|
memcpy(ep_target, &f_conf1[i], sizeof(struct format_config));
|
|
ep_target += sizeof(struct format_config);
|
|
ret = ssp_get_vendor_blob(nhlt, ep_target, dai_index, i);
|
|
if (ret < 0) {
|
|
fprintf(stderr, "nhlt_sso_get_ep: ssp_get_vendor_blob failed\n");
|
|
return ret;
|
|
}
|
|
ep_target += blob_size;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Set ssp parameters from topology for ssp coefficient calculation.
|
|
*
|
|
* You can see an example of topology v2 config of ssp below. In this example the default
|
|
* object parameters are spelled out for clarity. General parameters like sample_bits are parsed
|
|
* with set_ssp_data and hw_config object data with set_hw_data. Ssp can have multiple hw_configs.
|
|
* Values are saved into intermediate structs and the vendor specific blob is calculated at the end
|
|
* of parsing with ssp_calculate.
|
|
*
|
|
* SSP."0" {
|
|
* id 0
|
|
* direction "duplex"
|
|
* name NoCodec-0
|
|
* io_clk 38400000
|
|
* default_hw_conf_id 0
|
|
* sample_bits 16
|
|
* quirks "lbm_mode"
|
|
* bclk_delay 0
|
|
* mclk_id 0
|
|
* clks_control 0
|
|
* frame_pulse_width 0
|
|
* tdm_padding_per_slot false
|
|
*
|
|
* Object.Base.hw_config."SSP0" {
|
|
* id 0
|
|
* mclk_freq 24576000
|
|
* bclk_freq 3072000
|
|
* tdm_slot_width 32
|
|
* format "I2S"
|
|
* mclk "codec_mclk_in"
|
|
* bclk "codec_consumer"
|
|
* fsync "codec_consumer"
|
|
* fsync_freq 48000
|
|
* tdm_slots 2
|
|
* tx_slots 3
|
|
* rx_slots 3
|
|
* }
|
|
* }
|
|
*/
|
|
int nhlt_ssp_set_params(struct intel_nhlt_params *nhlt, snd_config_t *cfg, snd_config_t *top)
|
|
{
|
|
snd_config_iterator_t i, next;
|
|
snd_config_t *items;
|
|
snd_config_t *n;
|
|
const char *id;
|
|
int ret;
|
|
|
|
ret = set_ssp_data(nhlt, cfg, top);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = snd_config_search(cfg, "Object.Base.hw_config", &items);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
snd_config_for_each(i, next, items) {
|
|
n = snd_config_iterator_entry(i);
|
|
|
|
if (snd_config_get_id(n, &id) < 0)
|
|
continue;
|
|
|
|
ret = set_hw_config(nhlt, n, top);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
ret = ssp_calculate(nhlt);
|
|
|
|
return ret;
|
|
}
|