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

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