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_mix_platform_info *info; /* rcar_snd.h */ 17 struct rsnd_mod mod; 18 }; 19 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 28 static void rsnd_mix_soft_reset(struct rsnd_mod *mod) 29 { 30 rsnd_mod_write(mod, MIX_SWRSR, 0); 31 rsnd_mod_write(mod, MIX_SWRSR, 1); 32 } 33 34 #define rsnd_mix_initialize_lock(mod) __rsnd_mix_initialize_lock(mod, 1) 35 #define rsnd_mix_initialize_unlock(mod) __rsnd_mix_initialize_lock(mod, 0) 36 static void __rsnd_mix_initialize_lock(struct rsnd_mod *mod, u32 enable) 37 { 38 rsnd_mod_write(mod, MIX_MIXIR, enable); 39 } 40 41 static void rsnd_mix_volume_update(struct rsnd_dai_stream *io, 42 struct rsnd_mod *mod) 43 { 44 45 /* Disable MIX dB setting */ 46 rsnd_mod_write(mod, MIX_MDBER, 0); 47 48 rsnd_mod_write(mod, MIX_MDBAR, 0); 49 rsnd_mod_write(mod, MIX_MDBBR, 0); 50 rsnd_mod_write(mod, MIX_MDBCR, 0); 51 rsnd_mod_write(mod, MIX_MDBDR, 0); 52 53 /* Enable MIX dB setting */ 54 rsnd_mod_write(mod, MIX_MDBER, 1); 55 } 56 57 static int rsnd_mix_init(struct rsnd_mod *mod, 58 struct rsnd_dai_stream *io, 59 struct rsnd_priv *priv) 60 { 61 rsnd_mod_hw_start(mod); 62 63 rsnd_mix_soft_reset(mod); 64 65 rsnd_mix_initialize_lock(mod); 66 67 rsnd_mod_write(mod, MIX_ADINR, rsnd_get_adinr_chan(mod, io)); 68 69 rsnd_path_parse(priv, io); 70 71 /* volume step */ 72 rsnd_mod_write(mod, MIX_MIXMR, 0); 73 rsnd_mod_write(mod, MIX_MVPDR, 0); 74 75 rsnd_mix_volume_update(io, mod); 76 77 rsnd_mix_initialize_unlock(mod); 78 79 return 0; 80 } 81 82 static int rsnd_mix_quit(struct rsnd_mod *mod, 83 struct rsnd_dai_stream *io, 84 struct rsnd_priv *priv) 85 { 86 rsnd_mod_hw_stop(mod); 87 88 return 0; 89 } 90 91 static struct rsnd_mod_ops rsnd_mix_ops = { 92 .name = MIX_NAME, 93 .init = rsnd_mix_init, 94 .quit = rsnd_mix_quit, 95 }; 96 97 struct rsnd_mod *rsnd_mix_mod_get(struct rsnd_priv *priv, int id) 98 { 99 if (WARN_ON(id < 0 || id >= rsnd_mix_nr(priv))) 100 id = 0; 101 102 return &((struct rsnd_mix *)(priv->mix) + id)->mod; 103 } 104 105 static void rsnd_of_parse_mix(struct platform_device *pdev, 106 const struct rsnd_of_data *of_data, 107 struct rsnd_priv *priv) 108 { 109 struct device_node *node; 110 struct rsnd_mix_platform_info *mix_info; 111 struct rcar_snd_info *info = rsnd_priv_to_info(priv); 112 struct device *dev = &pdev->dev; 113 int nr; 114 115 if (!of_data) 116 return; 117 118 node = of_get_child_by_name(dev->of_node, "rcar_sound,mix"); 119 if (!node) 120 return; 121 122 nr = of_get_child_count(node); 123 if (!nr) 124 goto rsnd_of_parse_mix_end; 125 126 mix_info = devm_kzalloc(dev, 127 sizeof(struct rsnd_mix_platform_info) * nr, 128 GFP_KERNEL); 129 if (!mix_info) { 130 dev_err(dev, "mix info allocation error\n"); 131 goto rsnd_of_parse_mix_end; 132 } 133 134 info->mix_info = mix_info; 135 info->mix_info_nr = nr; 136 137 rsnd_of_parse_mix_end: 138 of_node_put(node); 139 140 } 141 142 int rsnd_mix_probe(struct platform_device *pdev, 143 const struct rsnd_of_data *of_data, 144 struct rsnd_priv *priv) 145 { 146 struct rcar_snd_info *info = rsnd_priv_to_info(priv); 147 struct device *dev = rsnd_priv_to_dev(priv); 148 struct rsnd_mix *mix; 149 struct clk *clk; 150 char name[MIX_NAME_SIZE]; 151 int i, nr, ret; 152 153 /* This driver doesn't support Gen1 at this point */ 154 if (rsnd_is_gen1(priv)) { 155 dev_warn(dev, "MIX is not supported on Gen1\n"); 156 return -EINVAL; 157 } 158 159 rsnd_of_parse_mix(pdev, of_data, priv); 160 161 nr = info->mix_info_nr; 162 if (!nr) 163 return 0; 164 165 mix = devm_kzalloc(dev, sizeof(*mix) * nr, GFP_KERNEL); 166 if (!mix) 167 return -ENOMEM; 168 169 priv->mix_nr = nr; 170 priv->mix = mix; 171 172 for_each_rsnd_mix(mix, priv, i) { 173 snprintf(name, MIX_NAME_SIZE, "%s.%d", 174 MIX_NAME, i); 175 176 clk = devm_clk_get(dev, name); 177 if (IS_ERR(clk)) 178 return PTR_ERR(clk); 179 180 mix->info = &info->mix_info[i]; 181 182 ret = rsnd_mod_init(priv, &mix->mod, &rsnd_mix_ops, 183 clk, RSND_MOD_MIX, i); 184 if (ret) 185 return ret; 186 } 187 188 return 0; 189 } 190 191 void rsnd_mix_remove(struct platform_device *pdev, 192 struct rsnd_priv *priv) 193 { 194 struct rsnd_mix *mix; 195 int i; 196 197 for_each_rsnd_mix(mix, priv, i) { 198 rsnd_mod_quit(&mix->mod); 199 } 200 } 201