drivers/gpu/drm/bridge/adv7511/adv7511_audio.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Analog Devices ADV7511 HDMI transmitter driver
   4  *
   5  * Copyright 2012 Analog Devices Inc.
   6  * Copyright (c) 2016, Linaro Limited
   7  */
   8
   9 #include <sound/core.h>
  10 #include <sound/hdmi-codec.h>
  11 #include <sound/pcm.h>
  12 #include <sound/soc.h>
  13 #include <linux/of_graph.h>
  14
  15 #include "adv7511.h"
  16
  17 static void adv7511_calc_cts_n(unsigned int f_tmds, unsigned int fs,
  18                                unsigned int *cts, unsigned int *n)
  19 {
  20         switch (fs) {
  21         case 32000:
  22         case 48000:
  23         case 96000:
  24         case 192000:
  25                 *n = fs * 128 / 1000;
  26                 break;
  27         case 44100:
  28         case 88200:
  29         case 176400:
  30                 *n = fs * 128 / 900;
  31                 break;
  32         }
  33
  34         *cts = ((f_tmds * *n) / (128 * fs)) * 1000;
  35 }
  36
  37 static int adv7511_update_cts_n(struct adv7511 *adv7511)
  38 {
  39         unsigned int cts = 0;
  40         unsigned int n = 0;
  41
  42         adv7511_calc_cts_n(adv7511->f_tmds, adv7511->f_audio, &cts, &n);
  43
  44         regmap_write(adv7511->regmap, ADV7511_REG_N0, (n >> 16) & 0xf);
  45         regmap_write(adv7511->regmap, ADV7511_REG_N1, (n >> 8) & 0xff);
  46         regmap_write(adv7511->regmap, ADV7511_REG_N2, n & 0xff);
  47
  48         regmap_write(adv7511->regmap, ADV7511_REG_CTS_MANUAL0,
  49                      (cts >> 16) & 0xf);
  50         regmap_write(adv7511->regmap, ADV7511_REG_CTS_MANUAL1,
  51                      (cts >> 8) & 0xff);
  52         regmap_write(adv7511->regmap, ADV7511_REG_CTS_MANUAL2,
  53                      cts & 0xff);
  54
  55         return 0;
  56 }
  57
  58 int adv7511_hdmi_hw_params(struct device *dev, void *data,
  59                            struct hdmi_codec_daifmt *fmt,
  60                            struct hdmi_codec_params *hparms)
  61 {
  62         struct adv7511 *adv7511 = dev_get_drvdata(dev);
  63         unsigned int audio_source, i2s_format = 0;
  64         unsigned int invert_clock;
  65         unsigned int rate;
  66         unsigned int len;
  67
  68         switch (hparms->sample_rate) {
  69         case 32000:
  70                 rate = ADV7511_SAMPLE_FREQ_32000;
  71                 break;
  72         case 44100:
  73                 rate = ADV7511_SAMPLE_FREQ_44100;
  74                 break;
  75         case 48000:
  76                 rate = ADV7511_SAMPLE_FREQ_48000;
  77                 break;
  78         case 88200:
  79                 rate = ADV7511_SAMPLE_FREQ_88200;
  80                 break;
  81         case 96000:
  82                 rate = ADV7511_SAMPLE_FREQ_96000;
  83                 break;
  84         case 176400:
  85                 rate = ADV7511_SAMPLE_FREQ_176400;
  86                 break;
  87         case 192000:
  88                 rate = ADV7511_SAMPLE_FREQ_192000;
  89                 break;
  90         default:
  91                 return -EINVAL;
  92         }
  93
  94         switch (hparms->sample_width) {
  95         case 16:
  96                 len = ADV7511_I2S_SAMPLE_LEN_16;
  97                 break;
  98         case 18:
  99                 len = ADV7511_I2S_SAMPLE_LEN_18;
 100                 break;
 101         case 20:
 102                 len = ADV7511_I2S_SAMPLE_LEN_20;
 103                 break;
 104         case 24:
 105                 len = ADV7511_I2S_SAMPLE_LEN_24;
 106                 break;
 107         default:
 108                 return -EINVAL;
 109         }
 110
 111         switch (fmt->fmt) {
 112         case HDMI_I2S:
 113                 audio_source = ADV7511_AUDIO_SOURCE_I2S;
 114                 i2s_format = ADV7511_I2S_FORMAT_I2S;
 115                 break;
 116         case HDMI_RIGHT_J:
 117                 audio_source = ADV7511_AUDIO_SOURCE_I2S;
 118                 i2s_format = ADV7511_I2S_FORMAT_RIGHT_J;
 119                 break;
 120         case HDMI_LEFT_J:
 121                 audio_source = ADV7511_AUDIO_SOURCE_I2S;
 122                 i2s_format = ADV7511_I2S_FORMAT_LEFT_J;
 123                 break;
 124         default:
 125                 return -EINVAL;
 126         }
 127
 128         invert_clock = fmt->bit_clk_inv;
 129
 130         regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_SOURCE, 0x70,
 131                            audio_source << 4);
 132         regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CONFIG, BIT(6),
 133                            invert_clock << 6);
 134         regmap_update_bits(adv7511->regmap, ADV7511_REG_I2S_CONFIG, 0x03,
 135                            i2s_format);
 136
 137         adv7511->audio_source = audio_source;
 138
 139         adv7511->f_audio = hparms->sample_rate;
 140
 141         adv7511_update_cts_n(adv7511);
 142
 143         regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CFG3,
 144                            ADV7511_AUDIO_CFG3_LEN_MASK, len);
 145         regmap_update_bits(adv7511->regmap, ADV7511_REG_I2C_FREQ_ID_CFG,
 146                            ADV7511_I2C_FREQ_ID_CFG_RATE_MASK, rate << 4);
 147         regmap_write(adv7511->regmap, 0x73, 0x1);
 148
 149         return 0;
 150 }
 151
 152 static int audio_startup(struct device *dev, void *data)
 153 {
 154         struct adv7511 *adv7511 = dev_get_drvdata(dev);
 155
 156         regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CONFIG,
 157                                 BIT(7), 0);
 158
 159         /* hide Audio infoframe updates */
 160         regmap_update_bits(adv7511->regmap, ADV7511_REG_INFOFRAME_UPDATE,
 161                                 BIT(5), BIT(5));
 162         /* enable N/CTS, enable Audio sample packets */
 163         regmap_update_bits(adv7511->regmap, ADV7511_REG_PACKET_ENABLE1,
 164                                 BIT(5), BIT(5));
 165         /* enable N/CTS */
 166         regmap_update_bits(adv7511->regmap, ADV7511_REG_PACKET_ENABLE1,
 167                                 BIT(6), BIT(6));
 168         /* not copyrighted */
 169         regmap_update_bits(adv7511->regmap, ADV7511_REG_AUDIO_CFG1,
 170                                 BIT(5), BIT(5));
 171         /* enable audio infoframes */
 172         regmap_update_bits(adv7511->regmap, ADV7511_REG_PACKET_ENABLE1,
 173                                 BIT(3), BIT(3));
 174         /* AV mute disable */
 175         regmap_update_bits(adv7511->regmap, ADV7511_REG_GC(0),
 176                                 BIT(7) | BIT(6), BIT(7));
 177         /* use Audio infoframe updated info */
 178         regmap_update_bits(adv7511->regmap, ADV7511_REG_GC(1),
 179                                 BIT(5), 0);
 180         return 0;
 181 }
 182
 183 static void audio_shutdown(struct device *dev, void *data)
 184 {
 185 }
 186
 187 static int adv7511_hdmi_i2s_get_dai_id(struct snd_soc_component *component,
 188                                         struct device_node *endpoint)
 189 {
 190         struct of_endpoint of_ep;
 191         int ret;
 192
 193         ret = of_graph_parse_endpoint(endpoint, &of_ep);
 194         if (ret < 0)
 195                 return ret;
 196
 197         /*
 198          * HDMI sound should be located as reg = <2>
 199          * Then, it is sound port 0
 200          */
 201         if (of_ep.port == 2)
 202                 return 0;
 203
 204         return -EINVAL;
 205 }
 206
 207 static const struct hdmi_codec_ops adv7511_codec_ops = {
 208         .hw_params      = adv7511_hdmi_hw_params,
 209         .audio_shutdown = audio_shutdown,
 210         .audio_startup  = audio_startup,
 211         .get_dai_id     = adv7511_hdmi_i2s_get_dai_id,
 212 };
 213
 214 static const struct hdmi_codec_pdata codec_data = {
 215         .ops = &adv7511_codec_ops,
 216         .max_i2s_channels = 2,
 217         .i2s = 1,
 218 };
 219
 220 int adv7511_audio_init(struct device *dev, struct adv7511 *adv7511)
 221 {
 222         adv7511->audio_pdev = platform_device_register_data(dev,
 223                                         HDMI_CODEC_DRV_NAME,
 224                                         PLATFORM_DEVID_AUTO,
 225                                         &codec_data,
 226                                         sizeof(codec_data));
 227         return PTR_ERR_OR_ZERO(adv7511->audio_pdev);
 228 }
 229
 230 void adv7511_audio_exit(struct adv7511 *adv7511)
 231 {
 232         if (adv7511->audio_pdev) {
 233                 platform_device_unregister(adv7511->audio_pdev);
 234                 adv7511->audio_pdev = NULL;
 235         }
 236 }