356 lines
7.4 KiB
C
356 lines
7.4 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// Renesas R-Car SSIU support
|
|
//
|
|
// Copyright (c) 2015 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
|
|
|
|
#include "rsnd.h"
|
|
|
|
#define SSIU_NAME "ssiu"
|
|
|
|
struct rsnd_ssiu {
|
|
struct rsnd_mod mod;
|
|
u32 busif_status[8]; /* for BUSIF0 - BUSIF7 */
|
|
unsigned int usrcnt;
|
|
};
|
|
|
|
#define rsnd_ssiu_nr(priv) ((priv)->ssiu_nr)
|
|
#define rsnd_mod_to_ssiu(_mod) container_of((_mod), struct rsnd_ssiu, mod)
|
|
#define for_each_rsnd_ssiu(pos, priv, i) \
|
|
for (i = 0; \
|
|
(i < rsnd_ssiu_nr(priv)) && \
|
|
((pos) = ((struct rsnd_ssiu *)(priv)->ssiu + i)); \
|
|
i++)
|
|
|
|
static u32 *rsnd_ssiu_get_status(struct rsnd_mod *mod,
|
|
struct rsnd_dai_stream *io,
|
|
enum rsnd_mod_type type)
|
|
{
|
|
struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
|
|
int busif = rsnd_ssi_get_busif(io);
|
|
|
|
return &ssiu->busif_status[busif];
|
|
}
|
|
|
|
static int rsnd_ssiu_init(struct rsnd_mod *mod,
|
|
struct rsnd_dai_stream *io,
|
|
struct rsnd_priv *priv)
|
|
{
|
|
struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
|
|
u32 multi_ssi_slaves = rsnd_ssi_multi_slaves_runtime(io);
|
|
int use_busif = rsnd_ssi_use_busif(io);
|
|
int id = rsnd_mod_id(mod);
|
|
u32 mask1, val1;
|
|
u32 mask2, val2;
|
|
|
|
/* clear status */
|
|
switch (id) {
|
|
case 0:
|
|
case 1:
|
|
case 2:
|
|
case 3:
|
|
case 4:
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS0, 0xf << (id * 4));
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS2, 0xf << (id * 4));
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS4, 0xf << (id * 4));
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS6, 0xf << (id * 4));
|
|
break;
|
|
case 9:
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS1, 0xf << 4);
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS3, 0xf << 4);
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS5, 0xf << 4);
|
|
rsnd_mod_write(mod, SSI_SYS_STATUS7, 0xf << 4);
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* SSI_MODE0
|
|
*/
|
|
rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
|
|
|
|
/*
|
|
* SSI_MODE1
|
|
*/
|
|
mask1 = (1 << 4) | (1 << 20); /* mask sync bit */
|
|
mask2 = (1 << 4); /* mask sync bit */
|
|
val1 = val2 = 0;
|
|
if (id == 8) {
|
|
/*
|
|
* SSI8 pin is sharing with SSI7, nothing to do.
|
|
*/
|
|
} else if (rsnd_ssi_is_pin_sharing(io)) {
|
|
int shift = -1;
|
|
|
|
switch (id) {
|
|
case 1:
|
|
shift = 0;
|
|
break;
|
|
case 2:
|
|
shift = 2;
|
|
break;
|
|
case 4:
|
|
shift = 16;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
mask1 |= 0x3 << shift;
|
|
val1 = rsnd_rdai_is_clk_master(rdai) ?
|
|
0x2 << shift : 0x1 << shift;
|
|
|
|
} else if (multi_ssi_slaves) {
|
|
|
|
mask2 |= 0x00000007;
|
|
mask1 |= 0x0000000f;
|
|
|
|
switch (multi_ssi_slaves) {
|
|
case 0x0206: /* SSI0/1/2/9 */
|
|
val2 = (1 << 4) | /* SSI0129 sync */
|
|
(rsnd_rdai_is_clk_master(rdai) ? 0x2 : 0x1);
|
|
/* fall through */
|
|
case 0x0006: /* SSI0/1/2 */
|
|
val1 = rsnd_rdai_is_clk_master(rdai) ?
|
|
0xa : 0x5;
|
|
|
|
if (!val2) /* SSI012 sync */
|
|
val1 |= (1 << 4);
|
|
}
|
|
}
|
|
|
|
rsnd_mod_bset(mod, SSI_MODE1, mask1, val1);
|
|
rsnd_mod_bset(mod, SSI_MODE2, mask2, val2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
|
|
.name = SSIU_NAME,
|
|
.init = rsnd_ssiu_init,
|
|
.get_status = rsnd_ssiu_get_status,
|
|
};
|
|
|
|
static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod,
|
|
struct rsnd_dai_stream *io,
|
|
struct rsnd_priv *priv)
|
|
{
|
|
struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
|
|
u32 has_hdmi0 = rsnd_flags_has(io, RSND_STREAM_HDMI0);
|
|
u32 has_hdmi1 = rsnd_flags_has(io, RSND_STREAM_HDMI1);
|
|
int ret;
|
|
u32 mode = 0;
|
|
|
|
ret = rsnd_ssiu_init(mod, io, priv);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ssiu->usrcnt++;
|
|
|
|
if (rsnd_runtime_is_tdm(io)) {
|
|
/*
|
|
* TDM Extend Mode
|
|
* see
|
|
* rsnd_ssi_config_init()
|
|
*/
|
|
mode = 0x1;
|
|
}
|
|
|
|
rsnd_mod_write(mod, SSI_MODE, mode);
|
|
|
|
if (rsnd_ssi_use_busif(io)) {
|
|
int id = rsnd_mod_id(mod);
|
|
int busif = rsnd_ssi_get_busif(io);
|
|
|
|
/*
|
|
* FIXME
|
|
*
|
|
* We can't support SSI9-4/5/6/7, because its address is
|
|
* out of calculation rule
|
|
*/
|
|
if ((id == 9) && (busif >= 4)) {
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
|
|
|
dev_err(dev, "This driver doesn't support SSI%d-%d, so far",
|
|
id, busif);
|
|
}
|
|
|
|
#define RSND_WRITE_BUSIF(i) \
|
|
rsnd_mod_write(mod, SSI_BUSIF##i##_ADINR, \
|
|
rsnd_get_adinr_bit(mod, io) | \
|
|
(rsnd_io_is_play(io) ? \
|
|
rsnd_runtime_channel_after_ctu(io) : \
|
|
rsnd_runtime_channel_original(io))); \
|
|
rsnd_mod_write(mod, SSI_BUSIF##i##_MODE, \
|
|
rsnd_get_busif_shift(io, mod) | 1); \
|
|
rsnd_mod_write(mod, SSI_BUSIF##i##_DALIGN, \
|
|
rsnd_get_dalign(mod, io))
|
|
|
|
switch (busif) {
|
|
case 0:
|
|
RSND_WRITE_BUSIF(0);
|
|
break;
|
|
case 1:
|
|
RSND_WRITE_BUSIF(1);
|
|
break;
|
|
case 2:
|
|
RSND_WRITE_BUSIF(2);
|
|
break;
|
|
case 3:
|
|
RSND_WRITE_BUSIF(3);
|
|
break;
|
|
case 4:
|
|
RSND_WRITE_BUSIF(4);
|
|
break;
|
|
case 5:
|
|
RSND_WRITE_BUSIF(5);
|
|
break;
|
|
case 6:
|
|
RSND_WRITE_BUSIF(6);
|
|
break;
|
|
case 7:
|
|
RSND_WRITE_BUSIF(7);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (has_hdmi0 || has_hdmi1) {
|
|
enum rsnd_mod_type rsnd_ssi_array[] = {
|
|
RSND_MOD_SSIM1,
|
|
RSND_MOD_SSIM2,
|
|
RSND_MOD_SSIM3,
|
|
};
|
|
struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
|
|
struct rsnd_mod *pos;
|
|
u32 val;
|
|
int i, shift;
|
|
|
|
i = rsnd_mod_id(ssi_mod);
|
|
|
|
/* output all same SSI as default */
|
|
val = i << 16 |
|
|
i << 20 |
|
|
i << 24 |
|
|
i << 28 |
|
|
i;
|
|
|
|
for_each_rsnd_mod_array(i, pos, io, rsnd_ssi_array) {
|
|
shift = (i * 4) + 16;
|
|
val = (val & ~(0xF << shift)) |
|
|
rsnd_mod_id(pos) << shift;
|
|
}
|
|
|
|
if (has_hdmi0)
|
|
rsnd_mod_write(mod, HDMI0_SEL, val);
|
|
if (has_hdmi1)
|
|
rsnd_mod_write(mod, HDMI1_SEL, val);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rsnd_ssiu_start_gen2(struct rsnd_mod *mod,
|
|
struct rsnd_dai_stream *io,
|
|
struct rsnd_priv *priv)
|
|
{
|
|
int busif = rsnd_ssi_get_busif(io);
|
|
|
|
if (!rsnd_ssi_use_busif(io))
|
|
return 0;
|
|
|
|
rsnd_mod_bset(mod, SSI_CTRL, 1 << (busif * 4), 1 << (busif * 4));
|
|
|
|
if (rsnd_ssi_multi_slaves_runtime(io))
|
|
rsnd_mod_write(mod, SSI_CONTROL, 0x1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rsnd_ssiu_stop_gen2(struct rsnd_mod *mod,
|
|
struct rsnd_dai_stream *io,
|
|
struct rsnd_priv *priv)
|
|
{
|
|
struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
|
|
int busif = rsnd_ssi_get_busif(io);
|
|
|
|
if (!rsnd_ssi_use_busif(io))
|
|
return 0;
|
|
|
|
rsnd_mod_bset(mod, SSI_CTRL, 1 << (busif * 4), 0);
|
|
|
|
if (--ssiu->usrcnt)
|
|
return 0;
|
|
|
|
if (rsnd_ssi_multi_slaves_runtime(io))
|
|
rsnd_mod_write(mod, SSI_CONTROL, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct rsnd_mod_ops rsnd_ssiu_ops_gen2 = {
|
|
.name = SSIU_NAME,
|
|
.init = rsnd_ssiu_init_gen2,
|
|
.start = rsnd_ssiu_start_gen2,
|
|
.stop = rsnd_ssiu_stop_gen2,
|
|
.get_status = rsnd_ssiu_get_status,
|
|
};
|
|
|
|
static struct rsnd_mod *rsnd_ssiu_mod_get(struct rsnd_priv *priv, int id)
|
|
{
|
|
if (WARN_ON(id < 0 || id >= rsnd_ssiu_nr(priv)))
|
|
id = 0;
|
|
|
|
return rsnd_mod_get((struct rsnd_ssiu *)(priv->ssiu) + id);
|
|
}
|
|
|
|
int rsnd_ssiu_attach(struct rsnd_dai_stream *io,
|
|
struct rsnd_mod *ssi_mod)
|
|
{
|
|
struct rsnd_priv *priv = rsnd_io_to_priv(io);
|
|
struct rsnd_mod *mod = rsnd_ssiu_mod_get(priv, rsnd_mod_id(ssi_mod));
|
|
|
|
rsnd_mod_confirm_ssi(ssi_mod);
|
|
|
|
return rsnd_dai_connect(mod, io, mod->type);
|
|
}
|
|
|
|
int rsnd_ssiu_probe(struct rsnd_priv *priv)
|
|
{
|
|
struct device *dev = rsnd_priv_to_dev(priv);
|
|
struct rsnd_ssiu *ssiu;
|
|
struct rsnd_mod_ops *ops;
|
|
int i, nr, ret;
|
|
|
|
/* same number to SSI */
|
|
nr = priv->ssi_nr;
|
|
ssiu = devm_kcalloc(dev, nr, sizeof(*ssiu), GFP_KERNEL);
|
|
if (!ssiu)
|
|
return -ENOMEM;
|
|
|
|
priv->ssiu = ssiu;
|
|
priv->ssiu_nr = nr;
|
|
|
|
if (rsnd_is_gen1(priv))
|
|
ops = &rsnd_ssiu_ops_gen1;
|
|
else
|
|
ops = &rsnd_ssiu_ops_gen2;
|
|
|
|
for_each_rsnd_ssiu(ssiu, priv, i) {
|
|
ret = rsnd_mod_init(priv, rsnd_mod_get(ssiu),
|
|
ops, NULL, RSND_MOD_SSIU, i);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void rsnd_ssiu_remove(struct rsnd_priv *priv)
|
|
{
|
|
struct rsnd_ssiu *ssiu;
|
|
int i;
|
|
|
|
for_each_rsnd_ssiu(ssiu, priv, i) {
|
|
rsnd_mod_quit(rsnd_mod_get(ssiu));
|
|
}
|
|
}
|