|
@@ -78,6 +78,8 @@
|
|
|
/* CKG1 */
|
|
|
#define ACKMD_MASK 0x00007000
|
|
|
#define BPFMD_MASK 0x00000700
|
|
|
+#define DIMD (1 << 4)
|
|
|
+#define DOMD (1 << 0)
|
|
|
|
|
|
/* A/B MST_CTLR */
|
|
|
#define BP (1 << 4) /* Fix the signal of Biphase output */
|
|
@@ -292,21 +294,6 @@ static inline struct fsi_stream *fsi_get_stream(struct fsi_priv *fsi,
|
|
|
return is_play ? &fsi->playback : &fsi->capture;
|
|
|
}
|
|
|
|
|
|
-static int fsi_is_master_mode(struct fsi_priv *fsi, int is_play)
|
|
|
-{
|
|
|
- u32 mode;
|
|
|
- u32 flags = fsi_get_info_flags(fsi);
|
|
|
-
|
|
|
- mode = is_play ? SH_FSI_OUT_SLAVE_MODE : SH_FSI_IN_SLAVE_MODE;
|
|
|
-
|
|
|
- /* return
|
|
|
- * 1 : master mode
|
|
|
- * 0 : slave mode
|
|
|
- */
|
|
|
-
|
|
|
- return (mode & flags) != mode;
|
|
|
-}
|
|
|
-
|
|
|
static u32 fsi_get_port_shift(struct fsi_priv *fsi, int is_play)
|
|
|
{
|
|
|
int is_porta = fsi_is_port_a(fsi);
|
|
@@ -764,19 +751,11 @@ static int fsi_dai_startup(struct snd_pcm_substream *substream,
|
|
|
u32 fmt;
|
|
|
u32 data;
|
|
|
int is_play = fsi_is_play(substream);
|
|
|
- int is_master;
|
|
|
|
|
|
io = fsi_get_stream(fsi, is_play);
|
|
|
|
|
|
pm_runtime_get_sync(dai->dev);
|
|
|
|
|
|
- /* CKG1 */
|
|
|
- data = is_play ? (1 << 0) : (1 << 4);
|
|
|
- is_master = fsi_is_master_mode(fsi, is_play);
|
|
|
- if (is_master)
|
|
|
- fsi_reg_mask_set(fsi, CKG1, data, data);
|
|
|
- else
|
|
|
- fsi_reg_mask_set(fsi, CKG1, data, 0);
|
|
|
|
|
|
/* clock inversion (CKG2) */
|
|
|
data = 0;
|
|
@@ -893,6 +872,34 @@ static int fsi_dai_trigger(struct snd_pcm_substream *substream, int cmd,
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
+static int fsi_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
|
|
|
+{
|
|
|
+ struct fsi_priv *fsi = fsi_get_priv_frm_dai(dai);
|
|
|
+ u32 data = 0;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ pm_runtime_get_sync(dai->dev);
|
|
|
+
|
|
|
+ /* set master/slave audio interface */
|
|
|
+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
|
|
+ case SND_SOC_DAIFMT_CBM_CFM:
|
|
|
+ data = DIMD | DOMD;
|
|
|
+ break;
|
|
|
+ case SND_SOC_DAIFMT_CBS_CFS:
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto set_fmt_exit;
|
|
|
+ }
|
|
|
+ fsi_reg_mask_set(fsi, CKG1, (DIMD | DOMD), data);
|
|
|
+ ret = 0;
|
|
|
+
|
|
|
+set_fmt_exit:
|
|
|
+ pm_runtime_put_sync(dai->dev);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
static int fsi_dai_hw_params(struct snd_pcm_substream *substream,
|
|
|
struct snd_pcm_hw_params *params,
|
|
|
struct snd_soc_dai *dai)
|
|
@@ -979,6 +986,7 @@ static struct snd_soc_dai_ops fsi_dai_ops = {
|
|
|
.startup = fsi_dai_startup,
|
|
|
.shutdown = fsi_dai_shutdown,
|
|
|
.trigger = fsi_dai_trigger,
|
|
|
+ .set_fmt = fsi_dai_set_fmt,
|
|
|
.hw_params = fsi_dai_hw_params,
|
|
|
};
|
|
|
|