2013-07-22 12:35:52 +08:00
|
|
|
/*
|
|
|
|
* Renesas R-Car SRU/SCU/SSIU/SSI support
|
|
|
|
*
|
|
|
|
* Copyright (C) 2013 Renesas Solutions Corp.
|
|
|
|
* Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
|
|
|
|
*
|
|
|
|
* Based on fsi.c
|
|
|
|
* Kuninori Morimoto <morimoto.kuninori@renesas.com>
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Renesas R-Car sound device structure
|
|
|
|
*
|
|
|
|
* Gen1
|
|
|
|
*
|
|
|
|
* SRU : Sound Routing Unit
|
|
|
|
* - SRC : Sampling Rate Converter
|
|
|
|
* - CMD
|
|
|
|
* - CTU : Channel Count Conversion Unit
|
|
|
|
* - MIX : Mixer
|
|
|
|
* - DVC : Digital Volume and Mute Function
|
|
|
|
* - SSI : Serial Sound Interface
|
|
|
|
*
|
|
|
|
* Gen2
|
|
|
|
*
|
|
|
|
* SCU : Sampling Rate Converter Unit
|
|
|
|
* - SRC : Sampling Rate Converter
|
|
|
|
* - CMD
|
|
|
|
* - CTU : Channel Count Conversion Unit
|
|
|
|
* - MIX : Mixer
|
|
|
|
* - DVC : Digital Volume and Mute Function
|
|
|
|
* SSIU : Serial Sound Interface Unit
|
|
|
|
* - SSI : Serial Sound Interface
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* driver data Image
|
|
|
|
*
|
|
|
|
* rsnd_priv
|
|
|
|
* |
|
|
|
|
* | ** this depends on Gen1/Gen2
|
|
|
|
* |
|
|
|
|
* +- gen
|
|
|
|
* |
|
|
|
|
* | ** these depend on data path
|
|
|
|
* | ** gen and platform data control it
|
|
|
|
* |
|
|
|
|
* +- rdai[0]
|
|
|
|
* | | sru ssiu ssi
|
|
|
|
* | +- playback -> [mod] -> [mod] -> [mod] -> ...
|
|
|
|
* | |
|
|
|
|
* | | sru ssiu ssi
|
|
|
|
* | +- capture -> [mod] -> [mod] -> [mod] -> ...
|
|
|
|
* |
|
|
|
|
* +- rdai[1]
|
|
|
|
* | | sru ssiu ssi
|
|
|
|
* | +- playback -> [mod] -> [mod] -> [mod] -> ...
|
|
|
|
* | |
|
|
|
|
* | | sru ssiu ssi
|
|
|
|
* | +- capture -> [mod] -> [mod] -> [mod] -> ...
|
|
|
|
* ...
|
|
|
|
* |
|
|
|
|
* | ** these control ssi
|
|
|
|
* |
|
|
|
|
* +- ssi
|
|
|
|
* | |
|
|
|
|
* | +- ssi[0]
|
|
|
|
* | +- ssi[1]
|
|
|
|
* | +- ssi[2]
|
|
|
|
* | ...
|
|
|
|
* |
|
2014-03-04 12:51:21 +08:00
|
|
|
* | ** these control src
|
2013-07-22 12:35:52 +08:00
|
|
|
* |
|
2014-03-04 12:51:21 +08:00
|
|
|
* +- src
|
2013-07-22 12:35:52 +08:00
|
|
|
* |
|
2014-03-04 12:51:21 +08:00
|
|
|
* +- src[0]
|
|
|
|
* +- src[1]
|
|
|
|
* +- src[2]
|
2013-07-22 12:35:52 +08:00
|
|
|
* ...
|
|
|
|
*
|
|
|
|
*
|
|
|
|
* for_each_rsnd_dai(xx, priv, xx)
|
|
|
|
* rdai[0] => rdai[1] => rdai[2] => ...
|
|
|
|
*
|
|
|
|
* for_each_rsnd_mod(xx, rdai, xx)
|
|
|
|
* [mod] => [mod] => [mod] => ...
|
|
|
|
*
|
|
|
|
* rsnd_dai_call(xxx, fn )
|
|
|
|
* [mod]->fn() -> [mod]->fn() -> [mod]->fn()...
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
#include <linux/pm_runtime.h>
|
|
|
|
#include "rsnd.h"
|
|
|
|
|
2017-03-22 13:43:35 +08:00
|
|
|
#define RSND_RATES SNDRV_PCM_RATE_8000_192000
|
2013-07-22 12:35:52 +08:00
|
|
|
#define RSND_FMTS (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE)
|
|
|
|
|
2015-03-19 00:49:02 +08:00
|
|
|
static const struct of_device_id rsnd_of_match[] = {
|
2015-11-10 13:13:33 +08:00
|
|
|
{ .compatible = "renesas,rcar_sound-gen1", .data = (void *)RSND_GEN1 },
|
|
|
|
{ .compatible = "renesas,rcar_sound-gen2", .data = (void *)RSND_GEN2 },
|
|
|
|
{ .compatible = "renesas,rcar_sound-gen3", .data = (void *)RSND_GEN2 }, /* gen2 compatible */
|
2014-03-18 10:29:55 +08:00
|
|
|
{},
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(of, rsnd_of_match);
|
|
|
|
|
2015-11-05 16:50:10 +08:00
|
|
|
/*
|
|
|
|
* rsnd_mod functions
|
|
|
|
*/
|
2015-09-10 15:03:08 +08:00
|
|
|
void rsnd_mod_make_sure(struct rsnd_mod *mod, enum rsnd_mod_type type)
|
|
|
|
{
|
|
|
|
if (mod->type != type) {
|
|
|
|
struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
|
|
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
|
|
|
|
|
|
|
dev_warn(dev, "%s[%d] is not your expected module\n",
|
|
|
|
rsnd_mod_name(mod), rsnd_mod_id(mod));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2015-06-15 14:26:25 +08:00
|
|
|
struct dma_chan *rsnd_mod_dma_req(struct rsnd_dai_stream *io,
|
|
|
|
struct rsnd_mod *mod)
|
2014-06-23 08:56:23 +08:00
|
|
|
{
|
ASoC: rsnd: 1st DMAC dma-names cares subnode
Renesas R-Car sound (= rsnd) needs 2 DMAC which are called as
Audio DMAC (= 1st DMAC) and Audio DMAC peri peri (2nd DMAC).
And rsnd had assumed that 1st / 2nd DMACs are implemented as DMAEngine.
But, in result of DMA ML discussion, 2nd DMAC was concluded that it is
not a general purpose DMAC (2nd DMAC is for Device to Device inside
sound system). Additionally, current DMAEngine can't support Device to
Device, and we don't have correct DT bindings for it at this point.
So the easiest solution for it is that move it from DMAEngine to rsnd
driver.
dma-names on DT was implemented as no difference between 1st / 2nd
DMAC's, since rsnd had assumed that both DMACs are implemented as
DMAEngine. That style was "src_dst". But now, 2nd DMAC was implemented
as non DMAEngine, and it doesn't need dma-names anymore. So, this
dma-names rule is no longer needed.
And additionally, dma-names was assumed that it has all
(= SSI/SSIU/SRC/DVC) nodes under sound node.
In upstream code, no SoC/platform is supporting DMA for rsnd driver yet.
This means there is no compatible issue if this patch changes
dma-names's rule of DT.
This patch assumes dma-names for 1st DMAC are tx/rx base, and listed
in each SSI/SRC/DVC subnode
ex)
rcar_sound,dvc {
dvc0: dvc@0 {
dmas = <&audma0 0xbc>;
dma-names = "tx";
};
...
rcar_sound,src {
src0: src@0 {
...
dmas = <&audma0 0x85>, <&audma1 0x9a>;
dma-names = "rx", "tx";
};
...
rcar_sound,ssi {
ssi0: ssi@0 {
...
dmas = <&audma0 0x01>, <&audma1 0x02>, <&audma0 0x15>, <&audma1 0x16>;
dma-names = "rx", "tx", "rxu", "txu";
};
...
Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
Signed-off-by: Mark Brown <broonie@kernel.org>
2015-02-20 18:31:23 +08:00
|
|
|
if (!mod || !mod->ops || !mod->ops->dma_req)
|
|
|
|
return NULL;
|
2014-06-23 08:56:23 +08:00
|
|
|
|
2015-06-15 14:26:25 +08:00
|
|
|
return mod->ops->dma_req(io, mod);
|
2014-06-23 08:56:23 +08:00
|
|
|
}
|
|
|
|
|
2016-01-21 09:58:07 +08:00
|
|
|
u32 *rsnd_mod_get_status(struct rsnd_dai_stream *io,
|
|
|
|
struct rsnd_mod *mod,
|
|
|
|
enum rsnd_mod_type type)
|
|
|
|
{
|
|
|
|
return &mod->status;
|
|
|
|
}
|
|
|
|
|
2015-06-15 14:24:54 +08:00
|
|
|
int rsnd_mod_init(struct rsnd_priv *priv,
|
|
|
|
struct rsnd_mod *mod,
|
2016-01-21 09:58:07 +08:00
|
|
|
struct rsnd_mod_ops *ops,
|
|
|
|
struct clk *clk,
|
|
|
|
u32* (*get_status)(struct rsnd_dai_stream *io,
|
|
|
|
struct rsnd_mod *mod,
|
|
|
|
enum rsnd_mod_type type),
|
|
|
|
enum rsnd_mod_type type,
|
|
|
|
int id)
|
2013-07-22 12:36:03 +08:00
|
|
|
{
|
2015-03-26 12:02:09 +08:00
|
|
|
int ret = clk_prepare(clk);
|
|
|
|
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
2013-07-22 12:36:03 +08:00
|
|
|
mod->id = id;
|
|
|
|
mod->ops = ops;
|
2014-03-03 15:42:55 +08:00
|
|
|
mod->type = type;
|
2015-01-15 16:03:22 +08:00
|
|
|
mod->clk = clk;
|
2015-06-15 14:24:54 +08:00
|
|
|
mod->priv = priv;
|
2016-01-21 09:58:07 +08:00
|
|
|
mod->get_status = get_status;
|
2015-03-26 12:02:09 +08:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
void rsnd_mod_quit(struct rsnd_mod *mod)
|
|
|
|
{
|
2017-10-31 08:39:17 +08:00
|
|
|
clk_unprepare(mod->clk);
|
2016-01-21 09:56:59 +08:00
|
|
|
mod->clk = NULL;
|
2013-07-22 12:36:03 +08:00
|
|
|
}
|
|
|
|
|
2015-06-15 14:25:48 +08:00
|
|
|
void rsnd_mod_interrupt(struct rsnd_mod *mod,
|
|
|
|
void (*callback)(struct rsnd_mod *mod,
|
|
|
|
struct rsnd_dai_stream *io))
|
|
|
|
{
|
|
|
|
struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
|
|
|
|
struct rsnd_dai_stream *io;
|
|
|
|
struct rsnd_dai *rdai;
|
2015-10-26 16:41:53 +08:00
|
|
|
int i;
|
2015-06-15 14:25:48 +08:00
|
|
|
|
2015-10-26 16:41:53 +08:00
|
|
|
for_each_rsnd_dai(rdai, priv, i) {
|
|
|
|
io = &rdai->playback;
|
|
|
|
if (mod == io->mod[mod->type])
|
|
|
|
callback(mod, io);
|
2015-06-15 14:25:48 +08:00
|
|
|
|
2015-10-26 16:41:53 +08:00
|
|
|
io = &rdai->capture;
|
|
|
|
if (mod == io->mod[mod->type])
|
|
|
|
callback(mod, io);
|
2015-06-15 14:25:48 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2015-06-15 14:27:47 +08:00
|
|
|
int rsnd_io_is_working(struct rsnd_dai_stream *io)
|
2015-05-21 11:50:23 +08:00
|
|
|
{
|
|
|
|
/* see rsnd_dai_stream_init/quit() */
|
2017-10-31 08:39:45 +08:00
|
|
|
if (io->substream)
|
|
|
|
return snd_pcm_running(io->substream);
|
|
|
|
|
|
|
|
return 0;
|
2015-05-21 11:50:23 +08:00
|
|
|
}
|
|
|
|
|
2016-02-25 13:54:58 +08:00
|
|
|
int rsnd_runtime_channel_original(struct rsnd_dai_stream *io)
|
2015-11-30 16:53:27 +08:00
|
|
|
{
|
2015-12-17 10:57:07 +08:00
|
|
|
struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
|
2015-12-17 11:00:10 +08:00
|
|
|
|
2016-02-25 13:54:58 +08:00
|
|
|
return runtime->channels;
|
|
|
|
}
|
|
|
|
|
|
|
|
int rsnd_runtime_channel_after_ctu(struct rsnd_dai_stream *io)
|
|
|
|
{
|
|
|
|
int chan = rsnd_runtime_channel_original(io);
|
|
|
|
struct rsnd_mod *ctu_mod = rsnd_io_to_mod_ctu(io);
|
|
|
|
|
|
|
|
if (ctu_mod) {
|
|
|
|
u32 converted_chan = rsnd_ctu_converted_channel(ctu_mod);
|
|
|
|
|
|
|
|
if (converted_chan)
|
|
|
|
return converted_chan;
|
|
|
|
}
|
|
|
|
|
|
|
|
return chan;
|
|
|
|
}
|
|
|
|
|
|
|
|
int rsnd_runtime_channel_for_ssi(struct rsnd_dai_stream *io)
|
|
|
|
{
|
2017-06-15 08:49:27 +08:00
|
|
|
struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
|
2016-02-25 13:54:58 +08:00
|
|
|
int chan = rsnd_io_is_play(io) ?
|
|
|
|
rsnd_runtime_channel_after_ctu(io) :
|
|
|
|
rsnd_runtime_channel_original(io);
|
|
|
|
|
|
|
|
/* Use Multi SSI */
|
|
|
|
if (rsnd_runtime_is_ssi_multi(io))
|
2017-06-15 08:49:27 +08:00
|
|
|
chan /= rsnd_rdai_ssi_lane_get(rdai);
|
2015-11-30 16:53:27 +08:00
|
|
|
|
|
|
|
/* TDM Extend Mode needs 8ch */
|
|
|
|
if (chan == 6)
|
|
|
|
chan = 8;
|
|
|
|
|
|
|
|
return chan;
|
|
|
|
}
|
|
|
|
|
2016-02-25 13:54:58 +08:00
|
|
|
int rsnd_runtime_is_ssi_multi(struct rsnd_dai_stream *io)
|
|
|
|
{
|
2017-06-15 08:49:27 +08:00
|
|
|
struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
|
|
|
|
int lane = rsnd_rdai_ssi_lane_get(rdai);
|
2016-02-25 13:54:58 +08:00
|
|
|
int chan = rsnd_io_is_play(io) ?
|
|
|
|
rsnd_runtime_channel_after_ctu(io) :
|
|
|
|
rsnd_runtime_channel_original(io);
|
|
|
|
|
2017-06-15 08:49:27 +08:00
|
|
|
return (chan > 2) && (lane > 1);
|
2016-02-25 13:54:58 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
int rsnd_runtime_is_ssi_tdm(struct rsnd_dai_stream *io)
|
|
|
|
{
|
|
|
|
return rsnd_runtime_channel_for_ssi(io) >= 6;
|
|
|
|
}
|
|
|
|
|
2014-05-09 08:44:14 +08:00
|
|
|
/*
|
2015-07-15 15:14:05 +08:00
|
|
|
* ADINR function
|
2014-05-09 08:44:14 +08:00
|
|
|
*/
|
2015-07-15 15:14:05 +08:00
|
|
|
u32 rsnd_get_adinr_bit(struct rsnd_mod *mod, struct rsnd_dai_stream *io)
|
2014-05-09 08:44:14 +08:00
|
|
|
{
|
|
|
|
struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
|
|
|
|
struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
|
|
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
|
|
|
|
|
|
|
switch (runtime->sample_bits) {
|
|
|
|
case 16:
|
2015-12-17 10:55:51 +08:00
|
|
|
return 8 << 16;
|
2014-05-09 08:44:14 +08:00
|
|
|
case 32:
|
2015-12-17 10:55:51 +08:00
|
|
|
return 0 << 16;
|
2014-05-09 08:44:14 +08:00
|
|
|
}
|
|
|
|
|
2015-12-17 10:55:51 +08:00
|
|
|
dev_warn(dev, "not supported sample bits\n");
|
|
|
|
|
|
|
|
return 0;
|
2014-05-09 08:44:14 +08:00
|
|
|
}
|
|
|
|
|
2015-07-15 15:14:47 +08:00
|
|
|
/*
|
|
|
|
* DALIGN function
|
|
|
|
*/
|
|
|
|
u32 rsnd_get_dalign(struct rsnd_mod *mod, struct rsnd_dai_stream *io)
|
|
|
|
{
|
2016-12-02 10:44:23 +08:00
|
|
|
struct rsnd_mod *ssiu = rsnd_io_to_mod_ssiu(io);
|
2015-12-08 13:38:23 +08:00
|
|
|
struct rsnd_mod *target;
|
2015-07-15 15:14:47 +08:00
|
|
|
struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
|
|
|
|
u32 val = 0x76543210;
|
|
|
|
u32 mask = ~0;
|
|
|
|
|
2017-06-09 08:34:09 +08:00
|
|
|
/*
|
|
|
|
* *Hardware* L/R and *Software* L/R are inverted.
|
|
|
|
* We need to care about inversion timing to control
|
|
|
|
* Playback/Capture correctly.
|
|
|
|
* The point is [DVC] needs *Hardware* L/R, [MEM] needs *Software* L/R
|
|
|
|
*
|
|
|
|
* sL/R : software L/R
|
|
|
|
* hL/R : hardware L/R
|
|
|
|
* (*) : conversion timing
|
|
|
|
*
|
|
|
|
* Playback
|
|
|
|
* sL/R (*) hL/R hL/R hL/R hL/R hL/R
|
|
|
|
* [MEM] -> [SRC] -> [DVC] -> [CMD] -> [SSIU] -> [SSI] -> codec
|
|
|
|
*
|
|
|
|
* Capture
|
|
|
|
* hL/R hL/R hL/R hL/R hL/R (*) sL/R
|
|
|
|
* codec -> [SSI] -> [SSIU] -> [SRC] -> [DVC] -> [CMD] -> [MEM]
|
|
|
|
*/
|
2015-12-08 13:38:23 +08:00
|
|
|
if (rsnd_io_is_play(io)) {
|
|
|
|
struct rsnd_mod *src = rsnd_io_to_mod_src(io);
|
|
|
|
|
2016-12-02 10:44:23 +08:00
|
|
|
target = src ? src : ssiu;
|
2015-12-08 13:38:23 +08:00
|
|
|
} else {
|
|
|
|
struct rsnd_mod *cmd = rsnd_io_to_mod_cmd(io);
|
|
|
|
|
2016-12-02 10:44:23 +08:00
|
|
|
target = cmd ? cmd : ssiu;
|
2015-12-08 13:38:23 +08:00
|
|
|
}
|
|
|
|
|
2015-07-15 15:14:47 +08:00
|
|
|
mask <<= runtime->channels * 4;
|
|
|
|
val = val & mask;
|
|
|
|
|
|
|
|
switch (runtime->sample_bits) {
|
|
|
|
case 16:
|
|
|
|
val |= 0x67452301 & ~mask;
|
|
|
|
break;
|
|
|
|
case 32:
|
|
|
|
val |= 0x76543210 & ~mask;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* exchange channeles on SRC if possible,
|
|
|
|
* otherwise, R/L volume settings on DVC
|
|
|
|
* changes inverted channels
|
|
|
|
*/
|
|
|
|
if (mod == target)
|
|
|
|
return val;
|
|
|
|
else
|
|
|
|
return 0x76543210;
|
|
|
|
}
|
|
|
|
|
2017-05-16 09:51:41 +08:00
|
|
|
u32 rsnd_get_busif_shift(struct rsnd_dai_stream *io, struct rsnd_mod *mod)
|
|
|
|
{
|
|
|
|
enum rsnd_mod_type playback_mods[] = {
|
|
|
|
RSND_MOD_SRC,
|
|
|
|
RSND_MOD_CMD,
|
|
|
|
RSND_MOD_SSIU,
|
|
|
|
};
|
|
|
|
enum rsnd_mod_type capture_mods[] = {
|
|
|
|
RSND_MOD_CMD,
|
|
|
|
RSND_MOD_SRC,
|
|
|
|
RSND_MOD_SSIU,
|
|
|
|
};
|
|
|
|
struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
|
|
|
|
struct rsnd_mod *tmod = NULL;
|
|
|
|
enum rsnd_mod_type *mods =
|
|
|
|
rsnd_io_is_play(io) ?
|
|
|
|
playback_mods : capture_mods;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* This is needed for 24bit data
|
|
|
|
* We need to shift 8bit
|
|
|
|
*
|
|
|
|
* Linux 24bit data is located as 0x00******
|
|
|
|
* HW 24bit data is located as 0x******00
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
switch (runtime->sample_bits) {
|
|
|
|
case 16:
|
|
|
|
return 0;
|
|
|
|
case 32:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(playback_mods); i++) {
|
|
|
|
tmod = rsnd_io_to_mod(io, mods[i]);
|
|
|
|
if (tmod)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (tmod != mod)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (rsnd_io_is_play(io))
|
|
|
|
return (0 << 20) | /* shift to Left */
|
|
|
|
(8 << 16); /* 8bit */
|
|
|
|
else
|
|
|
|
return (1 << 20) | /* shift to Right */
|
|
|
|
(8 << 16); /* 8bit */
|
|
|
|
}
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
/*
|
|
|
|
* rsnd_dai functions
|
|
|
|
*/
|
2016-10-19 11:56:46 +08:00
|
|
|
struct rsnd_mod *rsnd_mod_next(int *iterator,
|
|
|
|
struct rsnd_dai_stream *io,
|
|
|
|
enum rsnd_mod_type *array,
|
|
|
|
int array_size)
|
|
|
|
{
|
|
|
|
struct rsnd_mod *mod;
|
|
|
|
enum rsnd_mod_type type;
|
|
|
|
int max = array ? array_size : RSND_MOD_MAX;
|
|
|
|
|
|
|
|
for (; *iterator < max; (*iterator)++) {
|
|
|
|
type = (array) ? array[*iterator] : *iterator;
|
2017-10-31 08:38:09 +08:00
|
|
|
mod = rsnd_io_to_mod(io, type);
|
2017-10-31 08:38:36 +08:00
|
|
|
if (mod)
|
|
|
|
return mod;
|
2016-10-19 11:56:46 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2016-01-21 09:59:55 +08:00
|
|
|
static enum rsnd_mod_type rsnd_mod_sequence[][RSND_MOD_MAX] = {
|
|
|
|
{
|
|
|
|
/* CAPTURE */
|
|
|
|
RSND_MOD_AUDMAPP,
|
|
|
|
RSND_MOD_AUDMA,
|
|
|
|
RSND_MOD_DVC,
|
|
|
|
RSND_MOD_MIX,
|
|
|
|
RSND_MOD_CTU,
|
|
|
|
RSND_MOD_CMD,
|
|
|
|
RSND_MOD_SRC,
|
|
|
|
RSND_MOD_SSIU,
|
|
|
|
RSND_MOD_SSIM3,
|
|
|
|
RSND_MOD_SSIM2,
|
|
|
|
RSND_MOD_SSIM1,
|
|
|
|
RSND_MOD_SSIP,
|
|
|
|
RSND_MOD_SSI,
|
|
|
|
}, {
|
|
|
|
/* PLAYBACK */
|
|
|
|
RSND_MOD_AUDMAPP,
|
|
|
|
RSND_MOD_AUDMA,
|
|
|
|
RSND_MOD_SSIM3,
|
|
|
|
RSND_MOD_SSIM2,
|
|
|
|
RSND_MOD_SSIM1,
|
|
|
|
RSND_MOD_SSIP,
|
|
|
|
RSND_MOD_SSI,
|
|
|
|
RSND_MOD_SSIU,
|
|
|
|
RSND_MOD_DVC,
|
|
|
|
RSND_MOD_MIX,
|
|
|
|
RSND_MOD_CTU,
|
|
|
|
RSND_MOD_CMD,
|
|
|
|
RSND_MOD_SRC,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
2016-10-19 11:57:08 +08:00
|
|
|
static int rsnd_status_update(u32 *status,
|
|
|
|
int shift, int add, int timing)
|
|
|
|
{
|
|
|
|
u32 mask = 0xF << shift;
|
|
|
|
u8 val = (*status >> shift) & 0xF;
|
|
|
|
u8 next_val = (val + add) & 0xF;
|
|
|
|
int func_call = (val == timing);
|
|
|
|
|
|
|
|
if (next_val == 0xF) /* underflow case */
|
|
|
|
func_call = 0;
|
|
|
|
else
|
|
|
|
*status = (*status & ~mask) + (next_val << shift);
|
|
|
|
|
|
|
|
return func_call;
|
|
|
|
}
|
|
|
|
|
|
|
|
#define rsnd_dai_call(fn, io, param...) \
|
|
|
|
({ \
|
2017-06-14 15:41:43 +08:00
|
|
|
struct device *dev = rsnd_priv_to_dev(rsnd_io_to_priv(io)); \
|
2016-10-19 11:57:08 +08:00
|
|
|
struct rsnd_mod *mod; \
|
|
|
|
int is_play = rsnd_io_is_play(io); \
|
|
|
|
int ret = 0, i; \
|
|
|
|
enum rsnd_mod_type *types = rsnd_mod_sequence[is_play]; \
|
|
|
|
for_each_rsnd_mod_arrays(i, mod, io, types, RSND_MOD_MAX) { \
|
|
|
|
int tmp = 0; \
|
|
|
|
u32 *status = mod->get_status(io, mod, types[i]); \
|
|
|
|
int func_call = rsnd_status_update(status, \
|
|
|
|
__rsnd_mod_shift_##fn, \
|
|
|
|
__rsnd_mod_add_##fn, \
|
|
|
|
__rsnd_mod_call_##fn); \
|
|
|
|
dev_dbg(dev, "%s[%d]\t0x%08x %s\n", \
|
|
|
|
rsnd_mod_name(mod), rsnd_mod_id(mod), *status, \
|
|
|
|
(func_call && (mod)->ops->fn) ? #fn : ""); \
|
|
|
|
if (func_call && (mod)->ops->fn) \
|
|
|
|
tmp = (mod)->ops->fn(mod, io, param); \
|
|
|
|
if (tmp) \
|
|
|
|
dev_err(dev, "%s[%d] : %s error %d\n", \
|
|
|
|
rsnd_mod_name(mod), rsnd_mod_id(mod), \
|
|
|
|
#fn, tmp); \
|
|
|
|
ret |= tmp; \
|
|
|
|
} \
|
|
|
|
ret; \
|
2013-07-22 12:36:03 +08:00
|
|
|
})
|
|
|
|
|
2015-10-26 16:39:41 +08:00
|
|
|
int rsnd_dai_connect(struct rsnd_mod *mod,
|
|
|
|
struct rsnd_dai_stream *io,
|
|
|
|
enum rsnd_mod_type type)
|
2013-07-22 12:36:03 +08:00
|
|
|
{
|
2015-07-21 08:03:35 +08:00
|
|
|
struct rsnd_priv *priv;
|
|
|
|
struct device *dev;
|
2015-07-15 15:15:10 +08:00
|
|
|
|
2013-11-11 09:00:42 +08:00
|
|
|
if (!mod)
|
2013-07-22 12:36:03 +08:00
|
|
|
return -EIO;
|
|
|
|
|
2016-01-21 09:56:36 +08:00
|
|
|
if (io->mod[type] == mod)
|
|
|
|
return 0;
|
|
|
|
|
2015-12-17 10:56:31 +08:00
|
|
|
if (io->mod[type])
|
|
|
|
return -EINVAL;
|
|
|
|
|
2015-07-21 08:03:35 +08:00
|
|
|
priv = rsnd_mod_to_priv(mod);
|
|
|
|
dev = rsnd_priv_to_dev(priv);
|
|
|
|
|
2015-10-26 16:39:41 +08:00
|
|
|
io->mod[type] = mod;
|
2013-07-22 12:36:03 +08:00
|
|
|
|
2015-07-15 15:15:10 +08:00
|
|
|
dev_dbg(dev, "%s[%d] is connected to io (%s)\n",
|
|
|
|
rsnd_mod_name(mod), rsnd_mod_id(mod),
|
|
|
|
rsnd_io_is_play(io) ? "Playback" : "Capture");
|
|
|
|
|
2013-07-22 12:36:03 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-11-10 12:00:58 +08:00
|
|
|
static void rsnd_dai_disconnect(struct rsnd_mod *mod,
|
2015-10-26 16:39:41 +08:00
|
|
|
struct rsnd_dai_stream *io,
|
|
|
|
enum rsnd_mod_type type)
|
2014-11-10 12:00:58 +08:00
|
|
|
{
|
2015-10-26 16:39:41 +08:00
|
|
|
io->mod[type] = NULL;
|
2014-11-10 12:00:58 +08:00
|
|
|
}
|
|
|
|
|
2017-06-15 08:49:27 +08:00
|
|
|
int rsnd_rdai_channels_ctrl(struct rsnd_dai *rdai,
|
|
|
|
int max_channels)
|
|
|
|
{
|
|
|
|
if (max_channels > 0)
|
|
|
|
rdai->max_channels = max_channels;
|
|
|
|
|
|
|
|
return rdai->max_channels;
|
|
|
|
}
|
|
|
|
|
|
|
|
int rsnd_rdai_ssi_lane_ctrl(struct rsnd_dai *rdai,
|
|
|
|
int ssi_lane)
|
|
|
|
{
|
|
|
|
if (ssi_lane > 0)
|
|
|
|
rdai->ssi_lane = ssi_lane;
|
|
|
|
|
|
|
|
return rdai->ssi_lane;
|
|
|
|
}
|
|
|
|
|
2015-01-15 16:03:38 +08:00
|
|
|
struct rsnd_dai *rsnd_rdai_get(struct rsnd_priv *priv, int id)
|
2013-07-22 12:35:52 +08:00
|
|
|
{
|
2014-02-25 14:15:18 +08:00
|
|
|
if ((id < 0) || (id >= rsnd_rdai_nr(priv)))
|
2013-10-11 15:07:48 +08:00
|
|
|
return NULL;
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
return priv->rdai + id;
|
|
|
|
}
|
|
|
|
|
2015-04-10 16:49:25 +08:00
|
|
|
#define rsnd_dai_to_priv(dai) snd_soc_dai_get_drvdata(dai)
|
2013-07-22 12:35:52 +08:00
|
|
|
static struct rsnd_dai *rsnd_dai_to_rdai(struct snd_soc_dai *dai)
|
|
|
|
{
|
2015-04-10 16:49:25 +08:00
|
|
|
struct rsnd_priv *priv = rsnd_dai_to_priv(dai);
|
2013-07-22 12:35:52 +08:00
|
|
|
|
2015-01-15 16:03:38 +08:00
|
|
|
return rsnd_rdai_get(priv, dai->id);
|
2013-07-22 12:35:52 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* rsnd_soc_dai functions
|
|
|
|
*/
|
2015-06-15 14:21:15 +08:00
|
|
|
void rsnd_dai_period_elapsed(struct rsnd_dai_stream *io)
|
|
|
|
{
|
|
|
|
struct snd_pcm_substream *substream = io->substream;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* this function should be called...
|
|
|
|
*
|
|
|
|
* - if rsnd_dai_pointer_update() returns true
|
|
|
|
* - without spin lock
|
|
|
|
*/
|
|
|
|
|
|
|
|
snd_pcm_period_elapsed(substream);
|
2013-07-22 12:35:52 +08:00
|
|
|
}
|
|
|
|
|
2015-05-21 11:49:54 +08:00
|
|
|
static void rsnd_dai_stream_init(struct rsnd_dai_stream *io,
|
2013-07-22 12:35:52 +08:00
|
|
|
struct snd_pcm_substream *substream)
|
|
|
|
{
|
|
|
|
io->substream = substream;
|
2015-05-21 11:49:54 +08:00
|
|
|
}
|
2013-07-22 12:35:52 +08:00
|
|
|
|
2015-05-21 11:49:54 +08:00
|
|
|
static void rsnd_dai_stream_quit(struct rsnd_dai_stream *io)
|
|
|
|
{
|
|
|
|
io->substream = NULL;
|
2013-07-22 12:35:52 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static
|
|
|
|
struct snd_soc_dai *rsnd_substream_to_dai(struct snd_pcm_substream *substream)
|
|
|
|
{
|
|
|
|
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
|
|
|
|
|
|
|
return rtd->cpu_dai;
|
|
|
|
}
|
|
|
|
|
|
|
|
static
|
|
|
|
struct rsnd_dai_stream *rsnd_rdai_to_io(struct rsnd_dai *rdai,
|
|
|
|
struct snd_pcm_substream *substream)
|
|
|
|
{
|
|
|
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
|
|
|
return &rdai->playback;
|
|
|
|
else
|
|
|
|
return &rdai->capture;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_soc_dai_trigger(struct snd_pcm_substream *substream, int cmd,
|
|
|
|
struct snd_soc_dai *dai)
|
|
|
|
{
|
2015-04-10 16:49:25 +08:00
|
|
|
struct rsnd_priv *priv = rsnd_dai_to_priv(dai);
|
2013-07-22 12:35:52 +08:00
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
|
|
|
struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
|
|
|
|
int ret;
|
|
|
|
unsigned long flags;
|
|
|
|
|
2015-05-21 11:50:23 +08:00
|
|
|
spin_lock_irqsave(&priv->lock, flags);
|
2013-07-22 12:35:52 +08:00
|
|
|
|
|
|
|
switch (cmd) {
|
|
|
|
case SNDRV_PCM_TRIGGER_START:
|
2016-09-29 11:09:22 +08:00
|
|
|
case SNDRV_PCM_TRIGGER_RESUME:
|
2015-05-21 11:49:54 +08:00
|
|
|
rsnd_dai_stream_init(io, substream);
|
2013-07-22 12:35:52 +08:00
|
|
|
|
2015-01-15 16:07:47 +08:00
|
|
|
ret = rsnd_dai_call(init, io, priv);
|
2013-07-22 12:36:03 +08:00
|
|
|
if (ret < 0)
|
|
|
|
goto dai_trigger_end;
|
|
|
|
|
2015-01-15 16:07:47 +08:00
|
|
|
ret = rsnd_dai_call(start, io, priv);
|
2013-07-22 12:36:03 +08:00
|
|
|
if (ret < 0)
|
|
|
|
goto dai_trigger_end;
|
2016-01-26 12:56:57 +08:00
|
|
|
|
|
|
|
ret = rsnd_dai_call(irq, io, priv, 1);
|
|
|
|
if (ret < 0)
|
|
|
|
goto dai_trigger_end;
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
break;
|
|
|
|
case SNDRV_PCM_TRIGGER_STOP:
|
2016-09-29 11:09:22 +08:00
|
|
|
case SNDRV_PCM_TRIGGER_SUSPEND:
|
2016-01-26 12:56:57 +08:00
|
|
|
ret = rsnd_dai_call(irq, io, priv, 0);
|
|
|
|
|
|
|
|
ret |= rsnd_dai_call(stop, io, priv);
|
2013-07-22 12:36:03 +08:00
|
|
|
|
2015-10-22 11:14:43 +08:00
|
|
|
ret |= rsnd_dai_call(quit, io, priv);
|
2013-07-22 12:36:03 +08:00
|
|
|
|
2015-05-21 11:49:54 +08:00
|
|
|
rsnd_dai_stream_quit(io);
|
2013-07-22 12:35:52 +08:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
ret = -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
dai_trigger_end:
|
2015-05-21 11:50:23 +08:00
|
|
|
spin_unlock_irqrestore(&priv->lock, flags);
|
2013-07-22 12:35:52 +08:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
|
|
|
|
{
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
|
|
|
|
|
|
|
/* set master/slave audio interface */
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
|
|
|
case SND_SOC_DAIFMT_CBM_CFM:
|
2014-03-14 08:56:43 +08:00
|
|
|
rdai->clk_master = 0;
|
2013-07-22 12:35:52 +08:00
|
|
|
break;
|
|
|
|
case SND_SOC_DAIFMT_CBS_CFS:
|
2014-03-14 08:56:43 +08:00
|
|
|
rdai->clk_master = 1; /* codec is slave, cpu is master */
|
2013-07-22 12:35:52 +08:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* set format */
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
|
|
|
case SND_SOC_DAIFMT_I2S:
|
|
|
|
rdai->sys_delay = 0;
|
|
|
|
rdai->data_alignment = 0;
|
2014-08-01 09:08:18 +08:00
|
|
|
rdai->frm_clk_inv = 0;
|
2013-07-22 12:35:52 +08:00
|
|
|
break;
|
|
|
|
case SND_SOC_DAIFMT_LEFT_J:
|
|
|
|
rdai->sys_delay = 1;
|
|
|
|
rdai->data_alignment = 0;
|
2014-08-01 09:08:18 +08:00
|
|
|
rdai->frm_clk_inv = 1;
|
2013-07-22 12:35:52 +08:00
|
|
|
break;
|
|
|
|
case SND_SOC_DAIFMT_RIGHT_J:
|
|
|
|
rdai->sys_delay = 1;
|
|
|
|
rdai->data_alignment = 1;
|
2014-08-01 09:08:18 +08:00
|
|
|
rdai->frm_clk_inv = 1;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* set clock inversion */
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
|
|
|
|
case SND_SOC_DAIFMT_NB_IF:
|
|
|
|
rdai->frm_clk_inv = !rdai->frm_clk_inv;
|
|
|
|
break;
|
|
|
|
case SND_SOC_DAIFMT_IB_NF:
|
|
|
|
rdai->bit_clk_inv = !rdai->bit_clk_inv;
|
|
|
|
break;
|
|
|
|
case SND_SOC_DAIFMT_IB_IF:
|
|
|
|
rdai->bit_clk_inv = !rdai->bit_clk_inv;
|
|
|
|
rdai->frm_clk_inv = !rdai->frm_clk_inv;
|
|
|
|
break;
|
|
|
|
case SND_SOC_DAIFMT_NB_NF:
|
|
|
|
default:
|
2013-07-22 12:35:52 +08:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-11-30 16:54:03 +08:00
|
|
|
static int rsnd_soc_set_dai_tdm_slot(struct snd_soc_dai *dai,
|
|
|
|
u32 tx_mask, u32 rx_mask,
|
|
|
|
int slots, int slot_width)
|
|
|
|
{
|
|
|
|
struct rsnd_priv *priv = rsnd_dai_to_priv(dai);
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
|
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
|
|
|
|
|
|
|
switch (slots) {
|
2017-06-15 08:50:19 +08:00
|
|
|
case 2:
|
2015-11-30 16:54:03 +08:00
|
|
|
case 6:
|
2017-06-15 08:50:19 +08:00
|
|
|
case 8:
|
2015-11-30 16:54:03 +08:00
|
|
|
/* TDM Extend Mode */
|
2017-06-15 08:49:27 +08:00
|
|
|
rsnd_rdai_channels_set(rdai, slots);
|
|
|
|
rsnd_rdai_ssi_lane_set(rdai, 1);
|
2015-11-30 16:54:03 +08:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
dev_err(dev, "unsupported TDM slots (%d)\n", slots);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2017-06-15 08:50:19 +08:00
|
|
|
static unsigned int rsnd_soc_hw_channels_list[] = {
|
2017-08-09 09:46:23 +08:00
|
|
|
2, 6, 8,
|
2017-06-15 08:50:19 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
static unsigned int rsnd_soc_hw_rate_list[] = {
|
|
|
|
8000,
|
|
|
|
11025,
|
|
|
|
16000,
|
|
|
|
22050,
|
|
|
|
32000,
|
|
|
|
44100,
|
|
|
|
48000,
|
|
|
|
64000,
|
|
|
|
88200,
|
|
|
|
96000,
|
|
|
|
176400,
|
|
|
|
192000,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int rsnd_soc_hw_rule(struct rsnd_priv *priv,
|
|
|
|
unsigned int *list, int list_num,
|
|
|
|
struct snd_interval *baseline, struct snd_interval *iv)
|
|
|
|
{
|
|
|
|
struct snd_interval p;
|
2017-06-16 08:02:59 +08:00
|
|
|
unsigned int rate;
|
2017-06-15 08:50:19 +08:00
|
|
|
int i;
|
|
|
|
|
|
|
|
snd_interval_any(&p);
|
|
|
|
p.min = UINT_MAX;
|
|
|
|
p.max = 0;
|
|
|
|
|
|
|
|
for (i = 0; i < list_num; i++) {
|
|
|
|
|
|
|
|
if (!snd_interval_test(iv, list[i]))
|
|
|
|
continue;
|
|
|
|
|
|
|
|
rate = rsnd_ssi_clk_query(priv,
|
|
|
|
baseline->min, list[i], NULL);
|
|
|
|
if (rate > 0) {
|
|
|
|
p.min = min(p.min, list[i]);
|
|
|
|
p.max = max(p.max, list[i]);
|
|
|
|
}
|
|
|
|
|
|
|
|
rate = rsnd_ssi_clk_query(priv,
|
|
|
|
baseline->max, list[i], NULL);
|
|
|
|
if (rate > 0) {
|
|
|
|
p.min = min(p.min, list[i]);
|
|
|
|
p.max = max(p.max, list[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return snd_interval_refine(iv, &p);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_soc_hw_rule_rate(struct snd_pcm_hw_params *params,
|
|
|
|
struct snd_pcm_hw_rule *rule)
|
|
|
|
{
|
|
|
|
struct snd_interval *ic_ = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
|
|
|
|
struct snd_interval *ir = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
|
|
|
|
struct snd_interval ic;
|
|
|
|
struct snd_soc_dai *dai = rule->private;
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
|
|
|
struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* possible sampling rate limitation is same as
|
|
|
|
* 2ch if it supports multi ssi
|
|
|
|
*/
|
|
|
|
ic = *ic_;
|
|
|
|
if (1 < rsnd_rdai_ssi_lane_get(rdai)) {
|
|
|
|
ic.min = 2;
|
|
|
|
ic.max = 2;
|
|
|
|
}
|
|
|
|
|
|
|
|
return rsnd_soc_hw_rule(priv, rsnd_soc_hw_rate_list,
|
|
|
|
ARRAY_SIZE(rsnd_soc_hw_rate_list),
|
|
|
|
&ic, ir);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int rsnd_soc_hw_rule_channels(struct snd_pcm_hw_params *params,
|
|
|
|
struct snd_pcm_hw_rule *rule)
|
|
|
|
{
|
|
|
|
struct snd_interval *ic_ = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
|
|
|
|
struct snd_interval *ir = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
|
|
|
|
struct snd_interval ic;
|
|
|
|
struct snd_soc_dai *dai = rule->private;
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
|
|
|
struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* possible sampling rate limitation is same as
|
|
|
|
* 2ch if it supports multi ssi
|
|
|
|
*/
|
|
|
|
ic = *ic_;
|
|
|
|
if (1 < rsnd_rdai_ssi_lane_get(rdai)) {
|
|
|
|
ic.min = 2;
|
|
|
|
ic.max = 2;
|
|
|
|
}
|
|
|
|
|
|
|
|
return rsnd_soc_hw_rule(priv, rsnd_soc_hw_channels_list,
|
|
|
|
ARRAY_SIZE(rsnd_soc_hw_channels_list),
|
|
|
|
ir, &ic);
|
|
|
|
}
|
|
|
|
|
2017-08-17 18:16:11 +08:00
|
|
|
static const struct snd_pcm_hardware rsnd_pcm_hardware = {
|
2017-07-27 09:32:06 +08:00
|
|
|
.info = SNDRV_PCM_INFO_INTERLEAVED |
|
|
|
|
SNDRV_PCM_INFO_MMAP |
|
|
|
|
SNDRV_PCM_INFO_MMAP_VALID,
|
|
|
|
.buffer_bytes_max = 64 * 1024,
|
|
|
|
.period_bytes_min = 32,
|
|
|
|
.period_bytes_max = 8192,
|
|
|
|
.periods_min = 1,
|
|
|
|
.periods_max = 32,
|
|
|
|
.fifo_size = 256,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int rsnd_soc_dai_startup(struct snd_pcm_substream *substream,
|
|
|
|
struct snd_soc_dai *dai)
|
2017-06-15 08:50:19 +08:00
|
|
|
{
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
2017-07-27 09:32:06 +08:00
|
|
|
struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
|
|
|
|
struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
|
2017-06-15 08:50:19 +08:00
|
|
|
struct snd_pcm_hw_constraint_list *constraint = &rdai->constraint;
|
2017-07-27 09:32:06 +08:00
|
|
|
struct snd_pcm_runtime *runtime = substream->runtime;
|
2017-06-15 08:50:19 +08:00
|
|
|
unsigned int max_channels = rsnd_rdai_channels_get(rdai);
|
2017-07-27 09:32:06 +08:00
|
|
|
int ret;
|
2017-06-15 08:50:19 +08:00
|
|
|
int i;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Channel Limitation
|
|
|
|
* It depends on Platform design
|
|
|
|
*/
|
|
|
|
constraint->list = rsnd_soc_hw_channels_list;
|
|
|
|
constraint->count = 0;
|
|
|
|
constraint->mask = 0;
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(rsnd_soc_hw_channels_list); i++) {
|
|
|
|
if (rsnd_soc_hw_channels_list[i] > max_channels)
|
|
|
|
break;
|
|
|
|
constraint->count = i + 1;
|
|
|
|
}
|
|
|
|
|
2017-07-27 09:32:06 +08:00
|
|
|
snd_soc_set_runtime_hwparams(substream, &rsnd_pcm_hardware);
|
|
|
|
|
2017-06-15 08:50:19 +08:00
|
|
|
snd_pcm_hw_constraint_list(runtime, 0,
|
|
|
|
SNDRV_PCM_HW_PARAM_CHANNELS, constraint);
|
|
|
|
|
2017-07-27 09:32:06 +08:00
|
|
|
snd_pcm_hw_constraint_integer(runtime,
|
|
|
|
SNDRV_PCM_HW_PARAM_PERIODS);
|
|
|
|
|
2017-06-15 08:50:19 +08:00
|
|
|
/*
|
|
|
|
* Sampling Rate / Channel Limitation
|
|
|
|
* It depends on Clock Master Mode
|
|
|
|
*/
|
2017-07-27 09:32:06 +08:00
|
|
|
if (rsnd_rdai_is_clk_master(rdai)) {
|
|
|
|
snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
|
|
|
|
rsnd_soc_hw_rule_rate, dai,
|
|
|
|
SNDRV_PCM_HW_PARAM_CHANNELS, -1);
|
|
|
|
snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
|
|
|
|
rsnd_soc_hw_rule_channels, dai,
|
|
|
|
SNDRV_PCM_HW_PARAM_RATE, -1);
|
|
|
|
}
|
2017-06-15 08:50:19 +08:00
|
|
|
|
2016-10-25 08:37:35 +08:00
|
|
|
/*
|
|
|
|
* call rsnd_dai_call without spinlock
|
|
|
|
*/
|
2017-05-17 15:59:20 +08:00
|
|
|
ret = rsnd_dai_call(nolock_start, io, priv);
|
|
|
|
if (ret < 0)
|
|
|
|
rsnd_dai_call(nolock_stop, io, priv);
|
|
|
|
|
|
|
|
return ret;
|
2016-10-25 08:37:35 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static void rsnd_soc_dai_shutdown(struct snd_pcm_substream *substream,
|
|
|
|
struct snd_soc_dai *dai)
|
|
|
|
{
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
2017-06-14 15:41:43 +08:00
|
|
|
struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
|
2016-10-25 08:37:35 +08:00
|
|
|
struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* call rsnd_dai_call without spinlock
|
|
|
|
*/
|
|
|
|
rsnd_dai_call(nolock_stop, io, priv);
|
|
|
|
}
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
static const struct snd_soc_dai_ops rsnd_soc_dai_ops = {
|
2016-10-25 08:37:35 +08:00
|
|
|
.startup = rsnd_soc_dai_startup,
|
|
|
|
.shutdown = rsnd_soc_dai_shutdown,
|
2013-07-22 12:35:52 +08:00
|
|
|
.trigger = rsnd_soc_dai_trigger,
|
|
|
|
.set_fmt = rsnd_soc_dai_set_fmt,
|
2015-11-30 16:54:03 +08:00
|
|
|
.set_tdm_slot = rsnd_soc_set_dai_tdm_slot,
|
2013-07-22 12:35:52 +08:00
|
|
|
};
|
|
|
|
|
2015-12-17 10:58:14 +08:00
|
|
|
void rsnd_parse_connect_common(struct rsnd_dai *rdai,
|
|
|
|
struct rsnd_mod* (*mod_get)(struct rsnd_priv *priv, int id),
|
|
|
|
struct device_node *node,
|
|
|
|
struct device_node *playback,
|
|
|
|
struct device_node *capture)
|
|
|
|
{
|
|
|
|
struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
|
|
|
|
struct device_node *np;
|
|
|
|
struct rsnd_mod *mod;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
if (!node)
|
|
|
|
return;
|
|
|
|
|
|
|
|
i = 0;
|
|
|
|
for_each_child_of_node(node, np) {
|
|
|
|
mod = mod_get(priv, i);
|
|
|
|
if (np == playback)
|
|
|
|
rsnd_dai_connect(mod, &rdai->playback, mod->type);
|
|
|
|
if (np == capture)
|
|
|
|
rsnd_dai_connect(mod, &rdai->capture, mod->type);
|
|
|
|
i++;
|
|
|
|
}
|
|
|
|
|
|
|
|
of_node_put(node);
|
|
|
|
}
|
|
|
|
|
2017-05-18 09:27:48 +08:00
|
|
|
static struct device_node *rsnd_dai_of_node(struct rsnd_priv *priv,
|
|
|
|
int *is_graph)
|
|
|
|
{
|
|
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
|
|
|
struct device_node *np = dev->of_node;
|
|
|
|
struct device_node *dai_node;
|
|
|
|
struct device_node *ret;
|
|
|
|
|
|
|
|
*is_graph = 0;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* parse both previous dai (= rcar_sound,dai), and
|
|
|
|
* graph dai (= ports/port)
|
|
|
|
*/
|
|
|
|
dai_node = of_get_child_by_name(np, RSND_NODE_DAI);
|
|
|
|
if (dai_node) {
|
|
|
|
ret = dai_node;
|
|
|
|
goto of_node_compatible;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = np;
|
|
|
|
|
|
|
|
dai_node = of_graph_get_next_endpoint(np, NULL);
|
|
|
|
if (dai_node)
|
|
|
|
goto of_node_graph;
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
of_node_graph:
|
|
|
|
*is_graph = 1;
|
|
|
|
of_node_compatible:
|
|
|
|
of_node_put(dai_node);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2017-05-18 09:28:06 +08:00
|
|
|
static void __rsnd_dai_probe(struct rsnd_priv *priv,
|
|
|
|
struct device_node *dai_np,
|
|
|
|
int dai_i, int is_graph)
|
2014-03-18 10:29:55 +08:00
|
|
|
{
|
|
|
|
struct device_node *playback, *capture;
|
2015-11-10 13:11:18 +08:00
|
|
|
struct rsnd_dai_stream *io_playback;
|
|
|
|
struct rsnd_dai_stream *io_capture;
|
2017-05-18 09:28:06 +08:00
|
|
|
struct snd_soc_dai_driver *drv;
|
2015-11-10 13:11:18 +08:00
|
|
|
struct rsnd_dai *rdai;
|
2015-11-10 13:14:12 +08:00
|
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
2017-05-18 09:28:06 +08:00
|
|
|
int io_i;
|
|
|
|
|
|
|
|
rdai = rsnd_rdai_get(priv, dai_i);
|
|
|
|
drv = priv->daidrv + dai_i;
|
|
|
|
io_playback = &rdai->playback;
|
|
|
|
io_capture = &rdai->capture;
|
|
|
|
|
|
|
|
snprintf(rdai->name, RSND_DAI_NAME_SIZE, "rsnd-dai.%d", dai_i);
|
|
|
|
|
|
|
|
rdai->priv = priv;
|
|
|
|
drv->name = rdai->name;
|
|
|
|
drv->ops = &rsnd_soc_dai_ops;
|
|
|
|
|
|
|
|
snprintf(rdai->playback.name, RSND_DAI_NAME_SIZE,
|
|
|
|
"DAI%d Playback", dai_i);
|
|
|
|
drv->playback.rates = RSND_RATES;
|
|
|
|
drv->playback.formats = RSND_FMTS;
|
|
|
|
drv->playback.channels_min = 2;
|
2017-08-09 09:46:23 +08:00
|
|
|
drv->playback.channels_max = 8;
|
2017-05-18 09:28:06 +08:00
|
|
|
drv->playback.stream_name = rdai->playback.name;
|
|
|
|
|
|
|
|
snprintf(rdai->capture.name, RSND_DAI_NAME_SIZE,
|
|
|
|
"DAI%d Capture", dai_i);
|
|
|
|
drv->capture.rates = RSND_RATES;
|
|
|
|
drv->capture.formats = RSND_FMTS;
|
|
|
|
drv->capture.channels_min = 2;
|
2017-08-09 09:46:23 +08:00
|
|
|
drv->capture.channels_max = 8;
|
2017-05-18 09:28:06 +08:00
|
|
|
drv->capture.stream_name = rdai->capture.name;
|
|
|
|
|
|
|
|
rdai->playback.rdai = rdai;
|
|
|
|
rdai->capture.rdai = rdai;
|
2017-06-15 08:49:27 +08:00
|
|
|
rsnd_rdai_channels_set(rdai, 2); /* default 2ch */
|
|
|
|
rsnd_rdai_ssi_lane_set(rdai, 1); /* default 1lane */
|
2017-05-18 09:28:06 +08:00
|
|
|
|
|
|
|
for (io_i = 0;; io_i++) {
|
|
|
|
playback = of_parse_phandle(dai_np, "playback", io_i);
|
|
|
|
capture = of_parse_phandle(dai_np, "capture", io_i);
|
|
|
|
|
|
|
|
if (!playback && !capture)
|
|
|
|
break;
|
|
|
|
|
|
|
|
rsnd_parse_connect_ssi(rdai, playback, capture);
|
|
|
|
rsnd_parse_connect_src(rdai, playback, capture);
|
|
|
|
rsnd_parse_connect_ctu(rdai, playback, capture);
|
|
|
|
rsnd_parse_connect_mix(rdai, playback, capture);
|
|
|
|
rsnd_parse_connect_dvc(rdai, playback, capture);
|
|
|
|
|
|
|
|
of_node_put(playback);
|
|
|
|
of_node_put(capture);
|
|
|
|
}
|
|
|
|
|
|
|
|
dev_dbg(dev, "%s (%s/%s)\n", rdai->name,
|
|
|
|
rsnd_io_to_mod_ssi(io_playback) ? "play" : " -- ",
|
|
|
|
rsnd_io_to_mod_ssi(io_capture) ? "capture" : " -- ");
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_dai_probe(struct rsnd_priv *priv)
|
|
|
|
{
|
|
|
|
struct device_node *dai_node;
|
|
|
|
struct device_node *dai_np;
|
|
|
|
struct snd_soc_dai_driver *rdrv;
|
|
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
|
|
|
struct rsnd_dai *rdai;
|
|
|
|
int nr;
|
2017-05-18 09:27:48 +08:00
|
|
|
int is_graph;
|
2017-05-18 09:28:06 +08:00
|
|
|
int dai_i;
|
2014-03-18 10:29:55 +08:00
|
|
|
|
2017-05-18 09:27:48 +08:00
|
|
|
dai_node = rsnd_dai_of_node(priv, &is_graph);
|
2017-05-18 09:28:06 +08:00
|
|
|
if (is_graph)
|
|
|
|
nr = of_graph_get_endpoint_count(dai_node);
|
|
|
|
else
|
|
|
|
nr = of_get_child_count(dai_node);
|
|
|
|
|
|
|
|
if (!nr)
|
|
|
|
return -EINVAL;
|
2014-03-18 10:29:55 +08:00
|
|
|
|
2015-12-01 16:31:38 +08:00
|
|
|
rdrv = devm_kzalloc(dev, sizeof(*rdrv) * nr, GFP_KERNEL);
|
2015-11-10 13:11:18 +08:00
|
|
|
rdai = devm_kzalloc(dev, sizeof(*rdai) * nr, GFP_KERNEL);
|
2017-05-18 09:28:06 +08:00
|
|
|
if (!rdrv || !rdai)
|
|
|
|
return -ENOMEM;
|
2014-03-18 10:29:55 +08:00
|
|
|
|
2015-11-10 13:11:18 +08:00
|
|
|
priv->rdai_nr = nr;
|
2015-12-01 16:31:38 +08:00
|
|
|
priv->daidrv = rdrv;
|
2015-11-10 13:11:18 +08:00
|
|
|
priv->rdai = rdai;
|
2014-03-18 10:29:55 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* parse all dai
|
|
|
|
*/
|
|
|
|
dai_i = 0;
|
2017-05-18 09:28:06 +08:00
|
|
|
if (is_graph) {
|
2017-05-18 09:28:22 +08:00
|
|
|
for_each_endpoint_of_node(dai_node, dai_np) {
|
|
|
|
__rsnd_dai_probe(priv, dai_np, dai_i, is_graph);
|
|
|
|
rsnd_ssi_parse_hdmi_connection(priv, dai_np, dai_i);
|
|
|
|
dai_i++;
|
|
|
|
}
|
2017-05-18 09:28:06 +08:00
|
|
|
} else {
|
|
|
|
for_each_child_of_node(dai_node, dai_np)
|
|
|
|
__rsnd_dai_probe(priv, dai_np, dai_i++, is_graph);
|
2013-07-22 12:35:52 +08:00
|
|
|
}
|
|
|
|
|
2017-05-18 09:28:06 +08:00
|
|
|
return 0;
|
2013-07-22 12:35:52 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* pcm ops
|
|
|
|
*/
|
|
|
|
static int rsnd_hw_params(struct snd_pcm_substream *substream,
|
|
|
|
struct snd_pcm_hw_params *hw_params)
|
|
|
|
{
|
2015-03-26 12:02:51 +08:00
|
|
|
struct snd_soc_dai *dai = rsnd_substream_to_dai(substream);
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
|
|
|
struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = rsnd_dai_call(hw_params, io, substream, hw_params);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
return snd_pcm_lib_malloc_pages(substream,
|
|
|
|
params_buffer_bytes(hw_params));
|
|
|
|
}
|
|
|
|
|
|
|
|
static snd_pcm_uframes_t rsnd_pointer(struct snd_pcm_substream *substream)
|
|
|
|
{
|
|
|
|
struct snd_soc_dai *dai = rsnd_substream_to_dai(substream);
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
|
|
|
struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
|
2017-06-07 08:20:01 +08:00
|
|
|
snd_pcm_uframes_t pointer = 0;
|
|
|
|
|
|
|
|
rsnd_dai_call(pointer, io, &pointer);
|
2013-07-22 12:35:52 +08:00
|
|
|
|
2017-06-07 08:20:01 +08:00
|
|
|
return pointer;
|
2013-07-22 12:35:52 +08:00
|
|
|
}
|
|
|
|
|
2017-08-14 13:56:32 +08:00
|
|
|
static const struct snd_pcm_ops rsnd_pcm_ops = {
|
2013-07-22 12:35:52 +08:00
|
|
|
.ioctl = snd_pcm_lib_ioctl,
|
|
|
|
.hw_params = rsnd_hw_params,
|
|
|
|
.hw_free = snd_pcm_lib_free_pages,
|
|
|
|
.pointer = rsnd_pointer,
|
|
|
|
};
|
|
|
|
|
2014-11-27 16:06:14 +08:00
|
|
|
/*
|
|
|
|
* snd_kcontrol
|
|
|
|
*/
|
|
|
|
static int rsnd_kctrl_info(struct snd_kcontrol *kctrl,
|
|
|
|
struct snd_ctl_elem_info *uinfo)
|
|
|
|
{
|
2017-07-24 09:45:59 +08:00
|
|
|
struct rsnd_kctrl_cfg *cfg = snd_kcontrol_chip(kctrl);
|
2014-11-27 16:06:14 +08:00
|
|
|
|
|
|
|
if (cfg->texts) {
|
|
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
|
|
|
|
uinfo->count = cfg->size;
|
|
|
|
uinfo->value.enumerated.items = cfg->max;
|
|
|
|
if (uinfo->value.enumerated.item >= cfg->max)
|
|
|
|
uinfo->value.enumerated.item = cfg->max - 1;
|
|
|
|
strlcpy(uinfo->value.enumerated.name,
|
|
|
|
cfg->texts[uinfo->value.enumerated.item],
|
|
|
|
sizeof(uinfo->value.enumerated.name));
|
|
|
|
} else {
|
|
|
|
uinfo->count = cfg->size;
|
|
|
|
uinfo->value.integer.min = 0;
|
|
|
|
uinfo->value.integer.max = cfg->max;
|
|
|
|
uinfo->type = (cfg->max == 1) ?
|
|
|
|
SNDRV_CTL_ELEM_TYPE_BOOLEAN :
|
|
|
|
SNDRV_CTL_ELEM_TYPE_INTEGER;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_kctrl_get(struct snd_kcontrol *kctrl,
|
|
|
|
struct snd_ctl_elem_value *uc)
|
|
|
|
{
|
2017-07-24 09:45:59 +08:00
|
|
|
struct rsnd_kctrl_cfg *cfg = snd_kcontrol_chip(kctrl);
|
2014-11-27 16:06:14 +08:00
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < cfg->size; i++)
|
|
|
|
if (cfg->texts)
|
|
|
|
uc->value.enumerated.item[i] = cfg->val[i];
|
|
|
|
else
|
|
|
|
uc->value.integer.value[i] = cfg->val[i];
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_kctrl_put(struct snd_kcontrol *kctrl,
|
|
|
|
struct snd_ctl_elem_value *uc)
|
|
|
|
{
|
2017-07-24 09:45:59 +08:00
|
|
|
struct rsnd_kctrl_cfg *cfg = snd_kcontrol_chip(kctrl);
|
2014-11-27 16:06:14 +08:00
|
|
|
int i, change = 0;
|
|
|
|
|
2017-06-07 08:11:48 +08:00
|
|
|
if (!cfg->accept(cfg->io))
|
|
|
|
return 0;
|
|
|
|
|
2014-11-27 16:06:14 +08:00
|
|
|
for (i = 0; i < cfg->size; i++) {
|
|
|
|
if (cfg->texts) {
|
|
|
|
change |= (uc->value.enumerated.item[i] != cfg->val[i]);
|
|
|
|
cfg->val[i] = uc->value.enumerated.item[i];
|
|
|
|
} else {
|
|
|
|
change |= (uc->value.integer.value[i] != cfg->val[i]);
|
|
|
|
cfg->val[i] = uc->value.integer.value[i];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-02-25 13:51:12 +08:00
|
|
|
if (change && cfg->update)
|
2017-07-24 09:45:59 +08:00
|
|
|
cfg->update(cfg->io, cfg->mod);
|
2014-11-27 16:06:14 +08:00
|
|
|
|
|
|
|
return change;
|
|
|
|
}
|
|
|
|
|
2017-06-07 08:11:48 +08:00
|
|
|
int rsnd_kctrl_accept_anytime(struct rsnd_dai_stream *io)
|
|
|
|
{
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
int rsnd_kctrl_accept_runtime(struct rsnd_dai_stream *io)
|
|
|
|
{
|
|
|
|
struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
|
|
|
|
|
|
|
|
return !!runtime;
|
|
|
|
}
|
|
|
|
|
2017-04-06 15:25:13 +08:00
|
|
|
struct rsnd_kctrl_cfg *rsnd_kctrl_init_m(struct rsnd_kctrl_cfg_m *cfg)
|
|
|
|
{
|
|
|
|
cfg->cfg.val = cfg->val;
|
|
|
|
|
|
|
|
return &cfg->cfg;
|
|
|
|
}
|
|
|
|
|
|
|
|
struct rsnd_kctrl_cfg *rsnd_kctrl_init_s(struct rsnd_kctrl_cfg_s *cfg)
|
|
|
|
{
|
|
|
|
cfg->cfg.val = &cfg->val;
|
|
|
|
|
|
|
|
return &cfg->cfg;
|
|
|
|
}
|
|
|
|
|
2017-10-02 07:49:03 +08:00
|
|
|
const char * const volume_ramp_rate[] = {
|
|
|
|
"128 dB/1 step", /* 00000 */
|
|
|
|
"64 dB/1 step", /* 00001 */
|
|
|
|
"32 dB/1 step", /* 00010 */
|
|
|
|
"16 dB/1 step", /* 00011 */
|
|
|
|
"8 dB/1 step", /* 00100 */
|
|
|
|
"4 dB/1 step", /* 00101 */
|
|
|
|
"2 dB/1 step", /* 00110 */
|
|
|
|
"1 dB/1 step", /* 00111 */
|
|
|
|
"0.5 dB/1 step", /* 01000 */
|
|
|
|
"0.25 dB/1 step", /* 01001 */
|
2017-10-02 07:49:18 +08:00
|
|
|
"0.125 dB/1 step", /* 01010 = VOLUME_RAMP_MAX_MIX */
|
2017-10-02 07:49:03 +08:00
|
|
|
"0.125 dB/2 steps", /* 01011 */
|
|
|
|
"0.125 dB/4 steps", /* 01100 */
|
|
|
|
"0.125 dB/8 steps", /* 01101 */
|
|
|
|
"0.125 dB/16 steps", /* 01110 */
|
|
|
|
"0.125 dB/32 steps", /* 01111 */
|
|
|
|
"0.125 dB/64 steps", /* 10000 */
|
|
|
|
"0.125 dB/128 steps", /* 10001 */
|
|
|
|
"0.125 dB/256 steps", /* 10010 */
|
|
|
|
"0.125 dB/512 steps", /* 10011 */
|
|
|
|
"0.125 dB/1024 steps", /* 10100 */
|
|
|
|
"0.125 dB/2048 steps", /* 10101 */
|
|
|
|
"0.125 dB/4096 steps", /* 10110 */
|
|
|
|
"0.125 dB/8192 steps", /* 10111 = VOLUME_RAMP_MAX_DVC */
|
|
|
|
};
|
|
|
|
|
2017-04-06 15:25:13 +08:00
|
|
|
int rsnd_kctrl_new(struct rsnd_mod *mod,
|
|
|
|
struct rsnd_dai_stream *io,
|
|
|
|
struct snd_soc_pcm_runtime *rtd,
|
|
|
|
const unsigned char *name,
|
2017-06-07 08:11:48 +08:00
|
|
|
int (*accept)(struct rsnd_dai_stream *io),
|
2017-04-06 15:25:13 +08:00
|
|
|
void (*update)(struct rsnd_dai_stream *io,
|
|
|
|
struct rsnd_mod *mod),
|
|
|
|
struct rsnd_kctrl_cfg *cfg,
|
|
|
|
const char * const *texts,
|
|
|
|
int size,
|
|
|
|
u32 max)
|
2014-11-27 16:06:14 +08:00
|
|
|
{
|
|
|
|
struct snd_card *card = rtd->card->snd_card;
|
|
|
|
struct snd_kcontrol *kctrl;
|
|
|
|
struct snd_kcontrol_new knew = {
|
|
|
|
.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
|
|
|
|
.name = name,
|
|
|
|
.info = rsnd_kctrl_info,
|
2015-11-18 15:34:11 +08:00
|
|
|
.index = rtd->num,
|
2014-11-27 16:06:14 +08:00
|
|
|
.get = rsnd_kctrl_get,
|
|
|
|
.put = rsnd_kctrl_put,
|
|
|
|
};
|
|
|
|
int ret;
|
|
|
|
|
2017-04-06 15:25:13 +08:00
|
|
|
if (size > RSND_MAX_CHANNELS)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2017-07-24 09:45:59 +08:00
|
|
|
kctrl = snd_ctl_new1(&knew, cfg);
|
2014-11-27 16:06:14 +08:00
|
|
|
if (!kctrl)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
ret = snd_ctl_add(card, kctrl);
|
2016-12-08 21:05:43 +08:00
|
|
|
if (ret < 0)
|
2014-11-27 16:06:14 +08:00
|
|
|
return ret;
|
|
|
|
|
2017-04-06 15:25:13 +08:00
|
|
|
cfg->texts = texts;
|
|
|
|
cfg->max = max;
|
|
|
|
cfg->size = size;
|
2017-06-07 08:11:48 +08:00
|
|
|
cfg->accept = accept;
|
2017-04-06 15:25:13 +08:00
|
|
|
cfg->update = update;
|
|
|
|
cfg->card = card;
|
|
|
|
cfg->kctrl = kctrl;
|
|
|
|
cfg->io = io;
|
2017-07-24 09:45:59 +08:00
|
|
|
cfg->mod = mod;
|
2014-11-27 16:06:14 +08:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
/*
|
|
|
|
* snd_soc_platform
|
|
|
|
*/
|
|
|
|
|
|
|
|
#define PREALLOC_BUFFER (32 * 1024)
|
|
|
|
#define PREALLOC_BUFFER_MAX (32 * 1024)
|
|
|
|
|
|
|
|
static int rsnd_pcm_new(struct snd_soc_pcm_runtime *rtd)
|
|
|
|
{
|
2014-07-31 14:53:03 +08:00
|
|
|
struct snd_soc_dai *dai = rtd->cpu_dai;
|
|
|
|
struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
|
2015-05-12 09:57:50 +08:00
|
|
|
int ret;
|
2014-05-09 08:44:49 +08:00
|
|
|
|
2015-05-12 09:57:50 +08:00
|
|
|
ret = rsnd_dai_call(pcm_new, &rdai->playback, rtd);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
2014-05-09 08:44:49 +08:00
|
|
|
|
2015-05-12 09:57:50 +08:00
|
|
|
ret = rsnd_dai_call(pcm_new, &rdai->capture, rtd);
|
2014-07-31 14:53:03 +08:00
|
|
|
if (ret)
|
|
|
|
return ret;
|
2014-05-09 08:44:49 +08:00
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
return snd_pcm_lib_preallocate_pages_for_all(
|
|
|
|
rtd->pcm,
|
2016-11-14 12:20:56 +08:00
|
|
|
SNDRV_DMA_TYPE_CONTINUOUS,
|
|
|
|
snd_dma_continuous_data(GFP_KERNEL),
|
2013-07-22 12:35:52 +08:00
|
|
|
PREALLOC_BUFFER, PREALLOC_BUFFER_MAX);
|
|
|
|
}
|
|
|
|
|
2017-08-14 19:38:48 +08:00
|
|
|
static const struct snd_soc_platform_driver rsnd_soc_platform = {
|
2013-07-22 12:35:52 +08:00
|
|
|
.ops = &rsnd_pcm_ops,
|
|
|
|
.pcm_new = rsnd_pcm_new,
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct snd_soc_component_driver rsnd_soc_component = {
|
|
|
|
.name = "rsnd",
|
|
|
|
};
|
|
|
|
|
2014-11-10 12:00:58 +08:00
|
|
|
static int rsnd_rdai_continuance_probe(struct rsnd_priv *priv,
|
2015-01-15 16:07:19 +08:00
|
|
|
struct rsnd_dai_stream *io)
|
2014-11-10 12:00:58 +08:00
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
2015-01-15 16:07:47 +08:00
|
|
|
ret = rsnd_dai_call(probe, io, priv);
|
2014-11-10 12:00:58 +08:00
|
|
|
if (ret == -EAGAIN) {
|
2015-10-26 16:40:02 +08:00
|
|
|
struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
|
2016-10-19 11:57:27 +08:00
|
|
|
struct rsnd_mod *mod;
|
2015-10-26 16:40:02 +08:00
|
|
|
int i;
|
|
|
|
|
2014-11-10 12:00:58 +08:00
|
|
|
/*
|
|
|
|
* Fallback to PIO mode
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* call "remove" for SSI/SRC/DVC
|
|
|
|
* SSI will be switch to PIO mode if it was DMA mode
|
|
|
|
* see
|
|
|
|
* rsnd_dma_init()
|
2014-11-27 16:02:43 +08:00
|
|
|
* rsnd_ssi_fallback()
|
2014-11-10 12:00:58 +08:00
|
|
|
*/
|
2015-01-15 16:07:47 +08:00
|
|
|
rsnd_dai_call(remove, io, priv);
|
2014-11-10 12:00:58 +08:00
|
|
|
|
|
|
|
/*
|
2015-10-26 16:40:02 +08:00
|
|
|
* remove all mod from io
|
|
|
|
* and, re connect ssi
|
2014-11-10 12:00:58 +08:00
|
|
|
*/
|
2016-10-19 11:57:27 +08:00
|
|
|
for_each_rsnd_mod(i, mod, io)
|
|
|
|
rsnd_dai_disconnect(mod, io, i);
|
2015-10-26 16:40:02 +08:00
|
|
|
rsnd_dai_connect(ssi_mod, io, RSND_MOD_SSI);
|
2014-11-10 12:00:58 +08:00
|
|
|
|
2014-11-27 16:02:43 +08:00
|
|
|
/*
|
|
|
|
* fallback
|
|
|
|
*/
|
2015-01-15 16:07:47 +08:00
|
|
|
rsnd_dai_call(fallback, io, priv);
|
2014-11-27 16:02:43 +08:00
|
|
|
|
2014-11-10 12:00:58 +08:00
|
|
|
/*
|
|
|
|
* retry to "probe".
|
|
|
|
* DAI has SSI which is PIO mode only now.
|
|
|
|
*/
|
2015-01-15 16:07:47 +08:00
|
|
|
ret = rsnd_dai_call(probe, io, priv);
|
2014-11-10 12:00:58 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
/*
|
|
|
|
* rsnd probe
|
|
|
|
*/
|
|
|
|
static int rsnd_probe(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
struct rsnd_priv *priv;
|
|
|
|
struct device *dev = &pdev->dev;
|
2014-03-04 12:50:33 +08:00
|
|
|
struct rsnd_dai *rdai;
|
2015-11-10 13:14:12 +08:00
|
|
|
int (*probe_func[])(struct rsnd_priv *priv) = {
|
2014-03-03 15:43:18 +08:00
|
|
|
rsnd_gen_probe,
|
2015-02-20 18:27:42 +08:00
|
|
|
rsnd_dma_probe,
|
2014-03-03 15:43:18 +08:00
|
|
|
rsnd_ssi_probe,
|
2015-10-26 16:43:41 +08:00
|
|
|
rsnd_ssiu_probe,
|
2014-03-04 12:51:21 +08:00
|
|
|
rsnd_src_probe,
|
2015-07-15 15:17:17 +08:00
|
|
|
rsnd_ctu_probe,
|
2015-07-15 15:17:36 +08:00
|
|
|
rsnd_mix_probe,
|
2014-05-09 08:44:49 +08:00
|
|
|
rsnd_dvc_probe,
|
2015-10-26 16:43:21 +08:00
|
|
|
rsnd_cmd_probe,
|
2014-03-03 15:43:18 +08:00
|
|
|
rsnd_adg_probe,
|
|
|
|
rsnd_dai_probe,
|
|
|
|
};
|
|
|
|
int ret, i;
|
2013-07-22 12:35:52 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* init priv data
|
|
|
|
*/
|
|
|
|
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
2017-08-10 23:13:19 +08:00
|
|
|
if (!priv)
|
2013-07-22 12:35:52 +08:00
|
|
|
return -ENODEV;
|
|
|
|
|
2014-05-23 14:25:30 +08:00
|
|
|
priv->pdev = pdev;
|
2016-03-02 00:39:19 +08:00
|
|
|
priv->flags = (unsigned long)of_device_get_match_data(dev);
|
2013-07-22 12:35:52 +08:00
|
|
|
spin_lock_init(&priv->lock);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* init each module
|
|
|
|
*/
|
2014-03-03 15:43:18 +08:00
|
|
|
for (i = 0; i < ARRAY_SIZE(probe_func); i++) {
|
2015-11-10 13:14:12 +08:00
|
|
|
ret = probe_func[i](priv);
|
2014-03-03 15:43:18 +08:00
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
}
|
2013-07-22 12:36:35 +08:00
|
|
|
|
2014-03-04 12:50:33 +08:00
|
|
|
for_each_rsnd_dai(rdai, priv, i) {
|
2015-01-15 16:07:19 +08:00
|
|
|
ret = rsnd_rdai_continuance_probe(priv, &rdai->playback);
|
2014-03-04 12:50:33 +08:00
|
|
|
if (ret)
|
2014-07-24 16:51:31 +08:00
|
|
|
goto exit_snd_probe;
|
2013-07-22 12:36:46 +08:00
|
|
|
|
2015-01-15 16:07:19 +08:00
|
|
|
ret = rsnd_rdai_continuance_probe(priv, &rdai->capture);
|
2014-03-04 12:50:33 +08:00
|
|
|
if (ret)
|
2014-07-24 16:51:31 +08:00
|
|
|
goto exit_snd_probe;
|
2014-03-04 12:50:33 +08:00
|
|
|
}
|
2013-07-29 09:58:29 +08:00
|
|
|
|
2015-02-09 16:05:22 +08:00
|
|
|
dev_set_drvdata(dev, priv);
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
/*
|
|
|
|
* asoc register
|
|
|
|
*/
|
|
|
|
ret = snd_soc_register_platform(dev, &rsnd_soc_platform);
|
|
|
|
if (ret < 0) {
|
|
|
|
dev_err(dev, "cannot snd soc register\n");
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = snd_soc_register_component(dev, &rsnd_soc_component,
|
2014-02-25 14:15:18 +08:00
|
|
|
priv->daidrv, rsnd_rdai_nr(priv));
|
2013-07-22 12:35:52 +08:00
|
|
|
if (ret < 0) {
|
|
|
|
dev_err(dev, "cannot snd dai register\n");
|
|
|
|
goto exit_snd_soc;
|
|
|
|
}
|
|
|
|
|
|
|
|
pm_runtime_enable(dev);
|
|
|
|
|
|
|
|
dev_info(dev, "probed\n");
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
exit_snd_soc:
|
|
|
|
snd_soc_unregister_platform(dev);
|
2014-07-24 16:51:31 +08:00
|
|
|
exit_snd_probe:
|
|
|
|
for_each_rsnd_dai(rdai, priv, i) {
|
2015-01-15 16:07:47 +08:00
|
|
|
rsnd_dai_call(remove, &rdai->playback, priv);
|
|
|
|
rsnd_dai_call(remove, &rdai->capture, priv);
|
2014-07-24 16:51:31 +08:00
|
|
|
}
|
2013-07-22 12:35:52 +08:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_remove(struct platform_device *pdev)
|
|
|
|
{
|
|
|
|
struct rsnd_priv *priv = dev_get_drvdata(&pdev->dev);
|
2014-03-04 12:50:33 +08:00
|
|
|
struct rsnd_dai *rdai;
|
2015-11-10 13:14:12 +08:00
|
|
|
void (*remove_func[])(struct rsnd_priv *priv) = {
|
2015-03-26 12:02:09 +08:00
|
|
|
rsnd_ssi_remove,
|
2015-10-26 16:43:41 +08:00
|
|
|
rsnd_ssiu_remove,
|
2015-03-26 12:02:09 +08:00
|
|
|
rsnd_src_remove,
|
2015-07-15 15:17:17 +08:00
|
|
|
rsnd_ctu_remove,
|
2015-07-15 15:17:36 +08:00
|
|
|
rsnd_mix_remove,
|
2015-03-26 12:02:09 +08:00
|
|
|
rsnd_dvc_remove,
|
2015-10-26 16:43:21 +08:00
|
|
|
rsnd_cmd_remove,
|
2015-11-05 16:51:15 +08:00
|
|
|
rsnd_adg_remove,
|
2015-03-26 12:02:09 +08:00
|
|
|
};
|
2014-07-24 16:51:31 +08:00
|
|
|
int ret = 0, i;
|
2013-07-22 12:35:52 +08:00
|
|
|
|
|
|
|
pm_runtime_disable(&pdev->dev);
|
|
|
|
|
2014-03-04 12:50:33 +08:00
|
|
|
for_each_rsnd_dai(rdai, priv, i) {
|
2015-01-15 16:07:47 +08:00
|
|
|
ret |= rsnd_dai_call(remove, &rdai->playback, priv);
|
|
|
|
ret |= rsnd_dai_call(remove, &rdai->capture, priv);
|
2014-03-04 12:50:33 +08:00
|
|
|
}
|
2013-07-22 12:35:52 +08:00
|
|
|
|
2015-03-26 12:02:09 +08:00
|
|
|
for (i = 0; i < ARRAY_SIZE(remove_func); i++)
|
2015-11-10 13:14:12 +08:00
|
|
|
remove_func[i](priv);
|
2015-03-26 12:02:09 +08:00
|
|
|
|
2015-02-02 12:54:07 +08:00
|
|
|
snd_soc_unregister_component(&pdev->dev);
|
|
|
|
snd_soc_unregister_platform(&pdev->dev);
|
|
|
|
|
2014-07-24 16:51:31 +08:00
|
|
|
return ret;
|
2013-07-22 12:35:52 +08:00
|
|
|
}
|
|
|
|
|
2016-12-07 08:29:02 +08:00
|
|
|
static int rsnd_suspend(struct device *dev)
|
|
|
|
{
|
|
|
|
struct rsnd_priv *priv = dev_get_drvdata(dev);
|
|
|
|
|
|
|
|
rsnd_adg_clk_disable(priv);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsnd_resume(struct device *dev)
|
|
|
|
{
|
|
|
|
struct rsnd_priv *priv = dev_get_drvdata(dev);
|
|
|
|
|
|
|
|
rsnd_adg_clk_enable(priv);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2017-06-29 13:10:50 +08:00
|
|
|
static const struct dev_pm_ops rsnd_pm_ops = {
|
2016-12-07 08:29:02 +08:00
|
|
|
.suspend = rsnd_suspend,
|
|
|
|
.resume = rsnd_resume,
|
|
|
|
};
|
|
|
|
|
2013-07-22 12:35:52 +08:00
|
|
|
static struct platform_driver rsnd_driver = {
|
|
|
|
.driver = {
|
|
|
|
.name = "rcar_sound",
|
2016-12-07 08:29:02 +08:00
|
|
|
.pm = &rsnd_pm_ops,
|
2014-03-18 10:29:55 +08:00
|
|
|
.of_match_table = rsnd_of_match,
|
2013-07-22 12:35:52 +08:00
|
|
|
},
|
|
|
|
.probe = rsnd_probe,
|
|
|
|
.remove = rsnd_remove,
|
|
|
|
};
|
|
|
|
module_platform_driver(rsnd_driver);
|
|
|
|
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
MODULE_DESCRIPTION("Renesas R-Car audio driver");
|
|
|
|
MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
|
|
|
|
MODULE_ALIAS("platform:rcar-pcm-audio");
|