Olivier Deprez | 157378f | 2022-04-04 15:47:50 +0200 | [diff] [blame^] | 1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | // |
| 3 | // Copyright (c) 2020 BayLibre, SAS. |
| 4 | // Author: Jerome Brunet <jbrunet@baylibre.com> |
| 5 | |
| 6 | #include <linux/bitfield.h> |
| 7 | #include <linux/clk.h> |
| 8 | #include <linux/module.h> |
| 9 | #include <sound/pcm_params.h> |
| 10 | #include <linux/regmap.h> |
| 11 | #include <linux/regulator/consumer.h> |
| 12 | #include <linux/reset.h> |
| 13 | #include <sound/soc.h> |
| 14 | #include <sound/soc-dai.h> |
| 15 | |
| 16 | #include <dt-bindings/sound/meson-g12a-toacodec.h> |
| 17 | #include "axg-tdm.h" |
| 18 | #include "meson-codec-glue.h" |
| 19 | |
| 20 | #define G12A_TOACODEC_DRV_NAME "g12a-toacodec" |
| 21 | |
| 22 | #define TOACODEC_CTRL0 0x0 |
| 23 | #define CTRL0_ENABLE_SHIFT 31 |
| 24 | #define CTRL0_DAT_SEL_SHIFT 14 |
| 25 | #define CTRL0_DAT_SEL (0x3 << CTRL0_DAT_SEL_SHIFT) |
| 26 | #define CTRL0_LANE_SEL 12 |
| 27 | #define CTRL0_LRCLK_SEL GENMASK(9, 8) |
| 28 | #define CTRL0_BLK_CAP_INV BIT(7) |
| 29 | #define CTRL0_BCLK_O_INV BIT(6) |
| 30 | #define CTRL0_BCLK_SEL GENMASK(5, 4) |
| 31 | #define CTRL0_MCLK_SEL GENMASK(2, 0) |
| 32 | |
| 33 | #define TOACODEC_OUT_CHMAX 2 |
| 34 | |
| 35 | static const char * const g12a_toacodec_mux_texts[] = { |
| 36 | "I2S A", "I2S B", "I2S C", |
| 37 | }; |
| 38 | |
| 39 | static int g12a_toacodec_mux_put_enum(struct snd_kcontrol *kcontrol, |
| 40 | struct snd_ctl_elem_value *ucontrol) |
| 41 | { |
| 42 | struct snd_soc_component *component = |
| 43 | snd_soc_dapm_kcontrol_component(kcontrol); |
| 44 | struct snd_soc_dapm_context *dapm = |
| 45 | snd_soc_dapm_kcontrol_dapm(kcontrol); |
| 46 | struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; |
| 47 | unsigned int mux, changed; |
| 48 | |
| 49 | mux = snd_soc_enum_item_to_val(e, ucontrol->value.enumerated.item[0]); |
| 50 | changed = snd_soc_component_test_bits(component, e->reg, |
| 51 | CTRL0_DAT_SEL, |
| 52 | FIELD_PREP(CTRL0_DAT_SEL, mux)); |
| 53 | |
| 54 | if (!changed) |
| 55 | return 0; |
| 56 | |
| 57 | /* Force disconnect of the mux while updating */ |
| 58 | snd_soc_dapm_mux_update_power(dapm, kcontrol, 0, NULL, NULL); |
| 59 | |
| 60 | snd_soc_component_update_bits(component, e->reg, |
| 61 | CTRL0_DAT_SEL | |
| 62 | CTRL0_LRCLK_SEL | |
| 63 | CTRL0_BCLK_SEL, |
| 64 | FIELD_PREP(CTRL0_DAT_SEL, mux) | |
| 65 | FIELD_PREP(CTRL0_LRCLK_SEL, mux) | |
| 66 | FIELD_PREP(CTRL0_BCLK_SEL, mux)); |
| 67 | |
| 68 | /* |
| 69 | * FIXME: |
| 70 | * On this soc, the glue gets the MCLK directly from the clock |
| 71 | * controller instead of going the through the TDM interface. |
| 72 | * |
| 73 | * Here we assume interface A uses clock A, etc ... While it is |
| 74 | * true for now, it could be different. Instead the glue should |
| 75 | * find out the clock used by the interface and select the same |
| 76 | * source. For that, we will need regmap backed clock mux which |
| 77 | * is a work in progress |
| 78 | */ |
| 79 | snd_soc_component_update_bits(component, e->reg, |
| 80 | CTRL0_MCLK_SEL, |
| 81 | FIELD_PREP(CTRL0_MCLK_SEL, mux)); |
| 82 | |
| 83 | snd_soc_dapm_mux_update_power(dapm, kcontrol, mux, e, NULL); |
| 84 | |
| 85 | return 0; |
| 86 | } |
| 87 | |
| 88 | static SOC_ENUM_SINGLE_DECL(g12a_toacodec_mux_enum, TOACODEC_CTRL0, |
| 89 | CTRL0_DAT_SEL_SHIFT, |
| 90 | g12a_toacodec_mux_texts); |
| 91 | |
| 92 | static const struct snd_kcontrol_new g12a_toacodec_mux = |
| 93 | SOC_DAPM_ENUM_EXT("Source", g12a_toacodec_mux_enum, |
| 94 | snd_soc_dapm_get_enum_double, |
| 95 | g12a_toacodec_mux_put_enum); |
| 96 | |
| 97 | static const struct snd_kcontrol_new g12a_toacodec_out_enable = |
| 98 | SOC_DAPM_SINGLE_AUTODISABLE("Switch", TOACODEC_CTRL0, |
| 99 | CTRL0_ENABLE_SHIFT, 1, 0); |
| 100 | |
| 101 | static const struct snd_soc_dapm_widget g12a_toacodec_widgets[] = { |
| 102 | SND_SOC_DAPM_MUX("SRC", SND_SOC_NOPM, 0, 0, |
| 103 | &g12a_toacodec_mux), |
| 104 | SND_SOC_DAPM_SWITCH("OUT EN", SND_SOC_NOPM, 0, 0, |
| 105 | &g12a_toacodec_out_enable), |
| 106 | }; |
| 107 | |
| 108 | static int g12a_toacodec_input_hw_params(struct snd_pcm_substream *substream, |
| 109 | struct snd_pcm_hw_params *params, |
| 110 | struct snd_soc_dai *dai) |
| 111 | { |
| 112 | struct meson_codec_glue_input *data; |
| 113 | int ret; |
| 114 | |
| 115 | ret = meson_codec_glue_input_hw_params(substream, params, dai); |
| 116 | if (ret) |
| 117 | return ret; |
| 118 | |
| 119 | /* The glue will provide 1 lane out of the 4 to the output */ |
| 120 | data = meson_codec_glue_input_get_data(dai); |
| 121 | data->params.channels_min = min_t(unsigned int, TOACODEC_OUT_CHMAX, |
| 122 | data->params.channels_min); |
| 123 | data->params.channels_max = min_t(unsigned int, TOACODEC_OUT_CHMAX, |
| 124 | data->params.channels_max); |
| 125 | |
| 126 | return 0; |
| 127 | } |
| 128 | |
| 129 | static const struct snd_soc_dai_ops g12a_toacodec_input_ops = { |
| 130 | .hw_params = g12a_toacodec_input_hw_params, |
| 131 | .set_fmt = meson_codec_glue_input_set_fmt, |
| 132 | }; |
| 133 | |
| 134 | static const struct snd_soc_dai_ops g12a_toacodec_output_ops = { |
| 135 | .startup = meson_codec_glue_output_startup, |
| 136 | }; |
| 137 | |
| 138 | #define TOACODEC_STREAM(xname, xsuffix, xchmax) \ |
| 139 | { \ |
| 140 | .stream_name = xname " " xsuffix, \ |
| 141 | .channels_min = 1, \ |
| 142 | .channels_max = (xchmax), \ |
| 143 | .rate_min = 5512, \ |
| 144 | .rate_max = 192000, \ |
| 145 | .formats = AXG_TDM_FORMATS, \ |
| 146 | } |
| 147 | |
| 148 | #define TOACODEC_INPUT(xname, xid) { \ |
| 149 | .name = xname, \ |
| 150 | .id = (xid), \ |
| 151 | .playback = TOACODEC_STREAM(xname, "Playback", 8), \ |
| 152 | .ops = &g12a_toacodec_input_ops, \ |
| 153 | .probe = meson_codec_glue_input_dai_probe, \ |
| 154 | .remove = meson_codec_glue_input_dai_remove, \ |
| 155 | } |
| 156 | |
| 157 | #define TOACODEC_OUTPUT(xname, xid) { \ |
| 158 | .name = xname, \ |
| 159 | .id = (xid), \ |
| 160 | .capture = TOACODEC_STREAM(xname, "Capture", TOACODEC_OUT_CHMAX), \ |
| 161 | .ops = &g12a_toacodec_output_ops, \ |
| 162 | } |
| 163 | |
| 164 | static struct snd_soc_dai_driver g12a_toacodec_dai_drv[] = { |
| 165 | TOACODEC_INPUT("IN A", TOACODEC_IN_A), |
| 166 | TOACODEC_INPUT("IN B", TOACODEC_IN_B), |
| 167 | TOACODEC_INPUT("IN C", TOACODEC_IN_C), |
| 168 | TOACODEC_OUTPUT("OUT", TOACODEC_OUT), |
| 169 | }; |
| 170 | |
| 171 | static int g12a_toacodec_component_probe(struct snd_soc_component *c) |
| 172 | { |
| 173 | /* Initialize the static clock parameters */ |
| 174 | return snd_soc_component_write(c, TOACODEC_CTRL0, |
| 175 | CTRL0_BLK_CAP_INV); |
| 176 | } |
| 177 | |
| 178 | static const struct snd_soc_dapm_route g12a_toacodec_routes[] = { |
| 179 | { "SRC", "I2S A", "IN A Playback" }, |
| 180 | { "SRC", "I2S B", "IN B Playback" }, |
| 181 | { "SRC", "I2S C", "IN C Playback" }, |
| 182 | { "OUT EN", "Switch", "SRC" }, |
| 183 | { "OUT Capture", NULL, "OUT EN" }, |
| 184 | }; |
| 185 | |
| 186 | static const struct snd_kcontrol_new g12a_toacodec_controls[] = { |
| 187 | SOC_SINGLE("Lane Select", TOACODEC_CTRL0, CTRL0_LANE_SEL, 3, 0), |
| 188 | }; |
| 189 | |
| 190 | static const struct snd_soc_component_driver g12a_toacodec_component_drv = { |
| 191 | .probe = g12a_toacodec_component_probe, |
| 192 | .controls = g12a_toacodec_controls, |
| 193 | .num_controls = ARRAY_SIZE(g12a_toacodec_controls), |
| 194 | .dapm_widgets = g12a_toacodec_widgets, |
| 195 | .num_dapm_widgets = ARRAY_SIZE(g12a_toacodec_widgets), |
| 196 | .dapm_routes = g12a_toacodec_routes, |
| 197 | .num_dapm_routes = ARRAY_SIZE(g12a_toacodec_routes), |
| 198 | .endianness = 1, |
| 199 | .non_legacy_dai_naming = 1, |
| 200 | }; |
| 201 | |
| 202 | static const struct regmap_config g12a_toacodec_regmap_cfg = { |
| 203 | .reg_bits = 32, |
| 204 | .val_bits = 32, |
| 205 | .reg_stride = 4, |
| 206 | }; |
| 207 | |
| 208 | static const struct of_device_id g12a_toacodec_of_match[] = { |
| 209 | { .compatible = "amlogic,g12a-toacodec", }, |
| 210 | {} |
| 211 | }; |
| 212 | MODULE_DEVICE_TABLE(of, g12a_toacodec_of_match); |
| 213 | |
| 214 | static int g12a_toacodec_probe(struct platform_device *pdev) |
| 215 | { |
| 216 | struct device *dev = &pdev->dev; |
| 217 | void __iomem *regs; |
| 218 | struct regmap *map; |
| 219 | int ret; |
| 220 | |
| 221 | ret = device_reset(dev); |
| 222 | if (ret) |
| 223 | return ret; |
| 224 | |
| 225 | regs = devm_platform_ioremap_resource(pdev, 0); |
| 226 | if (IS_ERR(regs)) |
| 227 | return PTR_ERR(regs); |
| 228 | |
| 229 | map = devm_regmap_init_mmio(dev, regs, &g12a_toacodec_regmap_cfg); |
| 230 | if (IS_ERR(map)) { |
| 231 | dev_err(dev, "failed to init regmap: %ld\n", |
| 232 | PTR_ERR(map)); |
| 233 | return PTR_ERR(map); |
| 234 | } |
| 235 | |
| 236 | return devm_snd_soc_register_component(dev, |
| 237 | &g12a_toacodec_component_drv, g12a_toacodec_dai_drv, |
| 238 | ARRAY_SIZE(g12a_toacodec_dai_drv)); |
| 239 | } |
| 240 | |
| 241 | static struct platform_driver g12a_toacodec_pdrv = { |
| 242 | .driver = { |
| 243 | .name = G12A_TOACODEC_DRV_NAME, |
| 244 | .of_match_table = g12a_toacodec_of_match, |
| 245 | }, |
| 246 | .probe = g12a_toacodec_probe, |
| 247 | }; |
| 248 | module_platform_driver(g12a_toacodec_pdrv); |
| 249 | |
| 250 | MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>"); |
| 251 | MODULE_DESCRIPTION("Amlogic G12a To Internal DAC Codec Driver"); |
| 252 | MODULE_LICENSE("GPL v2"); |