xref: /OK3568_Linux_fs/kernel/sound/soc/sof/intel/hda-compress.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
2*4882a593Smuzhiyun //
3*4882a593Smuzhiyun // This file is provided under a dual BSD/GPLv2 license.  When using or
4*4882a593Smuzhiyun // redistributing this file, you may do so under either license.
5*4882a593Smuzhiyun //
6*4882a593Smuzhiyun // Copyright(c) 2019-2020 Intel Corporation. All rights reserved.
7*4882a593Smuzhiyun //
8*4882a593Smuzhiyun // Author: Cezary Rojewski <cezary.rojewski@intel.com>
9*4882a593Smuzhiyun //
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun #include <sound/hdaudio_ext.h>
12*4882a593Smuzhiyun #include <sound/soc.h>
13*4882a593Smuzhiyun #include "../sof-priv.h"
14*4882a593Smuzhiyun #include "hda.h"
15*4882a593Smuzhiyun 
16*4882a593Smuzhiyun static inline struct hdac_ext_stream *
hda_compr_get_stream(struct snd_compr_stream * cstream)17*4882a593Smuzhiyun hda_compr_get_stream(struct snd_compr_stream *cstream)
18*4882a593Smuzhiyun {
19*4882a593Smuzhiyun 	return cstream->runtime->private_data;
20*4882a593Smuzhiyun }
21*4882a593Smuzhiyun 
hda_probe_compr_assign(struct snd_sof_dev * sdev,struct snd_compr_stream * cstream,struct snd_soc_dai * dai)22*4882a593Smuzhiyun int hda_probe_compr_assign(struct snd_sof_dev *sdev,
23*4882a593Smuzhiyun 			   struct snd_compr_stream *cstream,
24*4882a593Smuzhiyun 			   struct snd_soc_dai *dai)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun 	struct hdac_ext_stream *stream;
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun 	stream = hda_dsp_stream_get(sdev, cstream->direction);
29*4882a593Smuzhiyun 	if (!stream)
30*4882a593Smuzhiyun 		return -EBUSY;
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun 	hdac_stream(stream)->curr_pos = 0;
33*4882a593Smuzhiyun 	hdac_stream(stream)->cstream = cstream;
34*4882a593Smuzhiyun 	cstream->runtime->private_data = stream;
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun 	return hdac_stream(stream)->stream_tag;
37*4882a593Smuzhiyun }
38*4882a593Smuzhiyun 
hda_probe_compr_free(struct snd_sof_dev * sdev,struct snd_compr_stream * cstream,struct snd_soc_dai * dai)39*4882a593Smuzhiyun int hda_probe_compr_free(struct snd_sof_dev *sdev,
40*4882a593Smuzhiyun 			 struct snd_compr_stream *cstream,
41*4882a593Smuzhiyun 			 struct snd_soc_dai *dai)
42*4882a593Smuzhiyun {
43*4882a593Smuzhiyun 	struct hdac_ext_stream *stream = hda_compr_get_stream(cstream);
44*4882a593Smuzhiyun 	int ret;
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun 	ret = hda_dsp_stream_put(sdev, cstream->direction,
47*4882a593Smuzhiyun 				 hdac_stream(stream)->stream_tag);
48*4882a593Smuzhiyun 	if (ret < 0) {
49*4882a593Smuzhiyun 		dev_dbg(sdev->dev, "stream put failed: %d\n", ret);
50*4882a593Smuzhiyun 		return ret;
51*4882a593Smuzhiyun 	}
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun 	hdac_stream(stream)->cstream = NULL;
54*4882a593Smuzhiyun 	cstream->runtime->private_data = NULL;
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun 	return 0;
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun 
hda_probe_compr_set_params(struct snd_sof_dev * sdev,struct snd_compr_stream * cstream,struct snd_compr_params * params,struct snd_soc_dai * dai)59*4882a593Smuzhiyun int hda_probe_compr_set_params(struct snd_sof_dev *sdev,
60*4882a593Smuzhiyun 			       struct snd_compr_stream *cstream,
61*4882a593Smuzhiyun 			       struct snd_compr_params *params,
62*4882a593Smuzhiyun 			       struct snd_soc_dai *dai)
63*4882a593Smuzhiyun {
64*4882a593Smuzhiyun 	struct hdac_ext_stream *stream = hda_compr_get_stream(cstream);
65*4882a593Smuzhiyun 	struct hdac_stream *hstream = hdac_stream(stream);
66*4882a593Smuzhiyun 	struct snd_dma_buffer *dmab;
67*4882a593Smuzhiyun 	u32 bits, rate;
68*4882a593Smuzhiyun 	int bps, ret;
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	dmab = cstream->runtime->dma_buffer_p;
71*4882a593Smuzhiyun 	/* compr params do not store bit depth, default to S32_LE */
72*4882a593Smuzhiyun 	bps = snd_pcm_format_physical_width(SNDRV_PCM_FORMAT_S32_LE);
73*4882a593Smuzhiyun 	if (bps < 0)
74*4882a593Smuzhiyun 		return bps;
75*4882a593Smuzhiyun 	bits = hda_dsp_get_bits(sdev, bps);
76*4882a593Smuzhiyun 	rate = hda_dsp_get_mult_div(sdev, params->codec.sample_rate);
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	hstream->format_val = rate | bits | (params->codec.ch_out - 1);
79*4882a593Smuzhiyun 	hstream->bufsize = cstream->runtime->buffer_size;
80*4882a593Smuzhiyun 	hstream->period_bytes = cstream->runtime->fragment_size;
81*4882a593Smuzhiyun 	hstream->no_period_wakeup = 0;
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun 	ret = hda_dsp_stream_hw_params(sdev, stream, dmab, NULL);
84*4882a593Smuzhiyun 	if (ret < 0) {
85*4882a593Smuzhiyun 		dev_err(sdev->dev, "error: hdac prepare failed: %x\n", ret);
86*4882a593Smuzhiyun 		return ret;
87*4882a593Smuzhiyun 	}
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun 	return 0;
90*4882a593Smuzhiyun }
91*4882a593Smuzhiyun 
hda_probe_compr_trigger(struct snd_sof_dev * sdev,struct snd_compr_stream * cstream,int cmd,struct snd_soc_dai * dai)92*4882a593Smuzhiyun int hda_probe_compr_trigger(struct snd_sof_dev *sdev,
93*4882a593Smuzhiyun 			    struct snd_compr_stream *cstream, int cmd,
94*4882a593Smuzhiyun 			    struct snd_soc_dai *dai)
95*4882a593Smuzhiyun {
96*4882a593Smuzhiyun 	struct hdac_ext_stream *stream = hda_compr_get_stream(cstream);
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun 	return hda_dsp_stream_trigger(sdev, stream, cmd);
99*4882a593Smuzhiyun }
100*4882a593Smuzhiyun 
hda_probe_compr_pointer(struct snd_sof_dev * sdev,struct snd_compr_stream * cstream,struct snd_compr_tstamp * tstamp,struct snd_soc_dai * dai)101*4882a593Smuzhiyun int hda_probe_compr_pointer(struct snd_sof_dev *sdev,
102*4882a593Smuzhiyun 			    struct snd_compr_stream *cstream,
103*4882a593Smuzhiyun 			    struct snd_compr_tstamp *tstamp,
104*4882a593Smuzhiyun 			    struct snd_soc_dai *dai)
105*4882a593Smuzhiyun {
106*4882a593Smuzhiyun 	struct hdac_ext_stream *stream = hda_compr_get_stream(cstream);
107*4882a593Smuzhiyun 	struct snd_soc_pcm_stream *pstream;
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 	pstream = &dai->driver->capture;
110*4882a593Smuzhiyun 	tstamp->copied_total = hdac_stream(stream)->curr_pos;
111*4882a593Smuzhiyun 	tstamp->sampling_rate = snd_pcm_rate_bit_to_rate(pstream->rates);
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun 	return 0;
114*4882a593Smuzhiyun }
115