sound/soc/sh/rcar/mix.c

   1 /*
   2  * mix.c
   3  *
   4  * Copyright (c) 2015 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10 #include "rsnd.h"
  11
  12 #define MIX_NAME_SIZE   16
  13 #define MIX_NAME "mix"
  14
  15 struct rsnd_mix {
  16         struct rsnd_mod mod;
  17 };
  18
  19 #define rsnd_mix_get(priv, id) ((struct rsnd_mix *)(priv->mix) + id)
  20 #define rsnd_mix_nr(priv) ((priv)->mix_nr)
  21 #define for_each_rsnd_mix(pos, priv, i)                                 \
  22         for ((i) = 0;                                                   \
  23              ((i) < rsnd_mix_nr(priv)) &&                               \
  24                      ((pos) = (struct rsnd_mix *)(priv)->mix + i);      \
  25              i++)
  26
  27 static void rsnd_mix_activation(struct rsnd_mod *mod)
  28 {
  29         rsnd_mod_write(mod, MIX_SWRSR, 0);
  30         rsnd_mod_write(mod, MIX_SWRSR, 1);
  31 }
  32
  33 static void rsnd_mix_halt(struct rsnd_mod *mod)
  34 {
  35         rsnd_mod_write(mod, MIX_MIXIR, 1);
  36         rsnd_mod_write(mod, MIX_SWRSR, 0);
  37 }
  38
  39 static void rsnd_mix_volume_parameter(struct rsnd_dai_stream *io,
  40                                       struct rsnd_mod *mod)
  41 {
  42         rsnd_mod_write(mod, MIX_MDBAR, 0);
  43         rsnd_mod_write(mod, MIX_MDBBR, 0);
  44         rsnd_mod_write(mod, MIX_MDBCR, 0);
  45         rsnd_mod_write(mod, MIX_MDBDR, 0);
  46 }
  47
  48 static void rsnd_mix_volume_init(struct rsnd_dai_stream *io,
  49                                  struct rsnd_mod *mod)
  50 {
  51         rsnd_mod_write(mod, MIX_MIXIR, 1);
  52
  53         /* General Information */
  54         rsnd_mod_write(mod, MIX_ADINR, rsnd_runtime_channel_after_ctu(io));
  55
  56         /* volume step */
  57         rsnd_mod_write(mod, MIX_MIXMR, 0);
  58         rsnd_mod_write(mod, MIX_MVPDR, 0);
  59
  60         /* common volume parameter */
  61         rsnd_mix_volume_parameter(io, mod);
  62
  63         rsnd_mod_write(mod, MIX_MIXIR, 0);
  64 }
  65
  66 static void rsnd_mix_volume_update(struct rsnd_dai_stream *io,
  67                                   struct rsnd_mod *mod)
  68 {
  69         /* Disable MIX dB setting */
  70         rsnd_mod_write(mod, MIX_MDBER, 0);
  71
  72         /* common volume parameter */
  73         rsnd_mix_volume_parameter(io, mod);
  74
  75         /* Enable MIX dB setting */
  76         rsnd_mod_write(mod, MIX_MDBER, 1);
  77 }
  78
  79 static int rsnd_mix_probe_(struct rsnd_mod *mod,
  80                            struct rsnd_dai_stream *io,
  81                            struct rsnd_priv *priv)
  82 {
  83         return rsnd_cmd_attach(io, rsnd_mod_id(mod));
  84 }
  85
  86 static int rsnd_mix_init(struct rsnd_mod *mod,
  87                          struct rsnd_dai_stream *io,
  88                          struct rsnd_priv *priv)
  89 {
  90         rsnd_mod_power_on(mod);
  91
  92         rsnd_mix_activation(mod);
  93
  94         rsnd_mix_volume_init(io, mod);
  95
  96         rsnd_mix_volume_update(io, mod);
  97
  98         return 0;
  99 }
 100
 101 static int rsnd_mix_quit(struct rsnd_mod *mod,
 102                          struct rsnd_dai_stream *io,
 103                          struct rsnd_priv *priv)
 104 {
 105         rsnd_mix_halt(mod);
 106
 107         rsnd_mod_power_off(mod);
 108
 109         return 0;
 110 }
 111
 112 static struct rsnd_mod_ops rsnd_mix_ops = {
 113         .name           = MIX_NAME,
 114         .probe          = rsnd_mix_probe_,
 115         .init           = rsnd_mix_init,
 116         .quit           = rsnd_mix_quit,
 117 };
 118
 119 struct rsnd_mod *rsnd_mix_mod_get(struct rsnd_priv *priv, int id)
 120 {
 121         if (WARN_ON(id < 0 || id >= rsnd_mix_nr(priv)))
 122                 id = 0;
 123
 124         return rsnd_mod_get(rsnd_mix_get(priv, id));
 125 }
 126
 127 int rsnd_mix_probe(struct rsnd_priv *priv)
 128 {
 129         struct device_node *node;
 130         struct device_node *np;
 131         struct device *dev = rsnd_priv_to_dev(priv);
 132         struct rsnd_mix *mix;
 133         struct clk *clk;
 134         char name[MIX_NAME_SIZE];
 135         int i, nr, ret;
 136
 137         /* This driver doesn't support Gen1 at this point */
 138         if (rsnd_is_gen1(priv))
 139                 return 0;
 140
 141         node = rsnd_mix_of_node(priv);
 142         if (!node)
 143                 return 0; /* not used is not error */
 144
 145         nr = of_get_child_count(node);
 146         if (!nr) {
 147                 ret = -EINVAL;
 148                 goto rsnd_mix_probe_done;
 149         }
 150
 151         mix     = devm_kzalloc(dev, sizeof(*mix) * nr, GFP_KERNEL);
 152         if (!mix) {
 153                 ret = -ENOMEM;
 154                 goto rsnd_mix_probe_done;
 155         }
 156
 157         priv->mix_nr    = nr;
 158         priv->mix       = mix;
 159
 160         i = 0;
 161         ret = 0;
 162         for_each_child_of_node(node, np) {
 163                 mix = rsnd_mix_get(priv, i);
 164
 165                 snprintf(name, MIX_NAME_SIZE, "%s.%d",
 166                          MIX_NAME, i);
 167
 168                 clk = devm_clk_get(dev, name);
 169                 if (IS_ERR(clk)) {
 170                         ret = PTR_ERR(clk);
 171                         of_node_put(np);
 172                         goto rsnd_mix_probe_done;
 173                 }
 174
 175                 ret = rsnd_mod_init(priv, rsnd_mod_get(mix), &rsnd_mix_ops,
 176                                     clk, rsnd_mod_get_status, RSND_MOD_MIX, i);
 177                 if (ret) {
 178                         of_node_put(np);
 179                         goto rsnd_mix_probe_done;
 180                 }
 181
 182                 i++;
 183         }
 184
 185 rsnd_mix_probe_done:
 186         of_node_put(node);
 187
 188         return ret;
 189 }
 190
 191 void rsnd_mix_remove(struct rsnd_priv *priv)
 192 {
 193         struct rsnd_mix *mix;
 194         int i;
 195
 196         for_each_rsnd_mix(mix, priv, i) {
 197                 rsnd_mod_quit(rsnd_mod_get(mix));
 198         }
 199 }