1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * dw-hdmi-i2s-audio.c 4 * 5 * Copyright (c) 2017 Renesas Solutions Corp. 6 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> 7 */ 8 9 #include <linux/dma-mapping.h> 10 #include <linux/module.h> 11 12 #include <drm/bridge/dw_hdmi.h> 13 #include <drm/drm_crtc.h> 14 15 #include <sound/hdmi-codec.h> 16 17 #include "dw-hdmi.h" 18 #include "dw-hdmi-audio.h" 19 20 #define DRIVER_NAME "dw-hdmi-i2s-audio" 21 22 static inline void hdmi_write(struct dw_hdmi_i2s_audio_data *audio, 23 u8 val, int offset) 24 { 25 struct dw_hdmi *hdmi = audio->hdmi; 26 27 audio->write(hdmi, val, offset); 28 } 29 30 static inline u8 hdmi_read(struct dw_hdmi_i2s_audio_data *audio, int offset) 31 { 32 struct dw_hdmi *hdmi = audio->hdmi; 33 34 return audio->read(hdmi, offset); 35 } 36 37 static int dw_hdmi_i2s_hw_params(struct device *dev, void *data, 38 struct hdmi_codec_daifmt *fmt, 39 struct hdmi_codec_params *hparms) 40 { 41 struct dw_hdmi_i2s_audio_data *audio = data; 42 struct dw_hdmi *hdmi = audio->hdmi; 43 u8 conf0 = 0; 44 u8 conf1 = 0; 45 u8 inputclkfs = 0; 46 47 /* it cares I2S only */ 48 if (fmt->bit_clk_master | fmt->frame_clk_master) { 49 dev_err(dev, "unsupported clock settings\n"); 50 return -EINVAL; 51 } 52 53 /* Reset the FIFOs before applying new params */ 54 hdmi_write(audio, HDMI_AUD_CONF0_SW_RESET, HDMI_AUD_CONF0); 55 hdmi_write(audio, (u8)~HDMI_MC_SWRSTZ_I2SSWRST_REQ, HDMI_MC_SWRSTZ); 56 57 inputclkfs = HDMI_AUD_INPUTCLKFS_64FS; 58 conf0 = (HDMI_AUD_CONF0_I2S_SELECT | HDMI_AUD_CONF0_I2S_EN0); 59 60 /* Enable the required i2s lanes */ 61 switch (hparms->channels) { 62 case 7 ... 8: 63 conf0 |= HDMI_AUD_CONF0_I2S_EN3; 64 /* Fall-thru */ 65 case 5 ... 6: 66 conf0 |= HDMI_AUD_CONF0_I2S_EN2; 67 /* Fall-thru */ 68 case 3 ... 4: 69 conf0 |= HDMI_AUD_CONF0_I2S_EN1; 70 /* Fall-thru */ 71 } 72 73 switch (hparms->sample_width) { 74 case 16: 75 conf1 = HDMI_AUD_CONF1_WIDTH_16; 76 break; 77 case 24: 78 case 32: 79 conf1 = HDMI_AUD_CONF1_WIDTH_24; 80 break; 81 } 82 83 switch (fmt->fmt) { 84 case HDMI_I2S: 85 conf1 |= HDMI_AUD_CONF1_MODE_I2S; 86 break; 87 case HDMI_RIGHT_J: 88 conf1 |= HDMI_AUD_CONF1_MODE_RIGHT_J; 89 break; 90 case HDMI_LEFT_J: 91 conf1 |= HDMI_AUD_CONF1_MODE_LEFT_J; 92 break; 93 case HDMI_DSP_A: 94 conf1 |= HDMI_AUD_CONF1_MODE_BURST_1; 95 break; 96 case HDMI_DSP_B: 97 conf1 |= HDMI_AUD_CONF1_MODE_BURST_2; 98 break; 99 default: 100 dev_err(dev, "unsupported format\n"); 101 return -EINVAL; 102 } 103 104 dw_hdmi_set_sample_rate(hdmi, hparms->sample_rate); 105 dw_hdmi_set_channel_status(hdmi, hparms->iec.status); 106 dw_hdmi_set_channel_count(hdmi, hparms->channels); 107 dw_hdmi_set_channel_allocation(hdmi, hparms->cea.channel_allocation); 108 109 hdmi_write(audio, inputclkfs, HDMI_AUD_INPUTCLKFS); 110 hdmi_write(audio, conf0, HDMI_AUD_CONF0); 111 hdmi_write(audio, conf1, HDMI_AUD_CONF1); 112 113 return 0; 114 } 115 116 static int dw_hdmi_i2s_audio_startup(struct device *dev, void *data) 117 { 118 struct dw_hdmi_i2s_audio_data *audio = data; 119 struct dw_hdmi *hdmi = audio->hdmi; 120 121 dw_hdmi_audio_enable(hdmi); 122 123 return 0; 124 } 125 126 static void dw_hdmi_i2s_audio_shutdown(struct device *dev, void *data) 127 { 128 struct dw_hdmi_i2s_audio_data *audio = data; 129 struct dw_hdmi *hdmi = audio->hdmi; 130 131 dw_hdmi_audio_disable(hdmi); 132 } 133 134 static int dw_hdmi_i2s_get_eld(struct device *dev, void *data, uint8_t *buf, 135 size_t len) 136 { 137 struct dw_hdmi_i2s_audio_data *audio = data; 138 139 memcpy(buf, audio->eld, min_t(size_t, MAX_ELD_BYTES, len)); 140 return 0; 141 } 142 143 static int dw_hdmi_i2s_get_dai_id(struct snd_soc_component *component, 144 struct device_node *endpoint) 145 { 146 struct of_endpoint of_ep; 147 int ret; 148 149 ret = of_graph_parse_endpoint(endpoint, &of_ep); 150 if (ret < 0) 151 return ret; 152 153 /* 154 * HDMI sound should be located as reg = <2> 155 * Then, it is sound port 0 156 */ 157 if (of_ep.port == 2) 158 return 0; 159 160 return -EINVAL; 161 } 162 163 static struct hdmi_codec_ops dw_hdmi_i2s_ops = { 164 .hw_params = dw_hdmi_i2s_hw_params, 165 .audio_startup = dw_hdmi_i2s_audio_startup, 166 .audio_shutdown = dw_hdmi_i2s_audio_shutdown, 167 .get_eld = dw_hdmi_i2s_get_eld, 168 .get_dai_id = dw_hdmi_i2s_get_dai_id, 169 }; 170 171 static int snd_dw_hdmi_probe(struct platform_device *pdev) 172 { 173 struct dw_hdmi_i2s_audio_data *audio = pdev->dev.platform_data; 174 struct platform_device_info pdevinfo; 175 struct hdmi_codec_pdata pdata; 176 struct platform_device *platform; 177 178 pdata.ops = &dw_hdmi_i2s_ops; 179 pdata.i2s = 1; 180 pdata.max_i2s_channels = 8; 181 pdata.data = audio; 182 183 memset(&pdevinfo, 0, sizeof(pdevinfo)); 184 pdevinfo.parent = pdev->dev.parent; 185 pdevinfo.id = PLATFORM_DEVID_AUTO; 186 pdevinfo.name = HDMI_CODEC_DRV_NAME; 187 pdevinfo.data = &pdata; 188 pdevinfo.size_data = sizeof(pdata); 189 pdevinfo.dma_mask = DMA_BIT_MASK(32); 190 191 platform = platform_device_register_full(&pdevinfo); 192 if (IS_ERR(platform)) 193 return PTR_ERR(platform); 194 195 dev_set_drvdata(&pdev->dev, platform); 196 197 return 0; 198 } 199 200 static int snd_dw_hdmi_remove(struct platform_device *pdev) 201 { 202 struct platform_device *platform = dev_get_drvdata(&pdev->dev); 203 204 platform_device_unregister(platform); 205 206 return 0; 207 } 208 209 static struct platform_driver snd_dw_hdmi_driver = { 210 .probe = snd_dw_hdmi_probe, 211 .remove = snd_dw_hdmi_remove, 212 .driver = { 213 .name = DRIVER_NAME, 214 }, 215 }; 216 module_platform_driver(snd_dw_hdmi_driver); 217 218 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>"); 219 MODULE_DESCRIPTION("Synopsis Designware HDMI I2S ALSA SoC interface"); 220 MODULE_LICENSE("GPL v2"); 221 MODULE_ALIAS("platform:" DRIVER_NAME); 222