GNU Linux-libre 4.19.264-gnu1
[releases.git] / drivers / gpu / drm / bridge / synopsys / dw-hdmi-i2s-audio.c
1 /*
2  * dw-hdmi-i2s-audio.c
3  *
4  * Copyright (c) 2017 Renesas Solutions Corp.
5  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11 #include <drm/bridge/dw_hdmi.h>
12
13 #include <sound/hdmi-codec.h>
14
15 #include "dw-hdmi.h"
16 #include "dw-hdmi-audio.h"
17
18 #define DRIVER_NAME "dw-hdmi-i2s-audio"
19
20 static inline void hdmi_write(struct dw_hdmi_i2s_audio_data *audio,
21                               u8 val, int offset)
22 {
23         struct dw_hdmi *hdmi = audio->hdmi;
24
25         audio->write(hdmi, val, offset);
26 }
27
28 static inline u8 hdmi_read(struct dw_hdmi_i2s_audio_data *audio, int offset)
29 {
30         struct dw_hdmi *hdmi = audio->hdmi;
31
32         return audio->read(hdmi, offset);
33 }
34
35 static int dw_hdmi_i2s_hw_params(struct device *dev, void *data,
36                                  struct hdmi_codec_daifmt *fmt,
37                                  struct hdmi_codec_params *hparms)
38 {
39         struct dw_hdmi_i2s_audio_data *audio = data;
40         struct dw_hdmi *hdmi = audio->hdmi;
41         u8 conf0 = 0;
42         u8 conf1 = 0;
43         u8 inputclkfs = 0;
44
45         /* it cares I2S only */
46         if ((fmt->fmt != HDMI_I2S) ||
47             (fmt->bit_clk_master | fmt->frame_clk_master)) {
48                 dev_err(dev, "unsupported format/settings\n");
49                 return -EINVAL;
50         }
51
52         inputclkfs      = HDMI_AUD_INPUTCLKFS_64FS;
53         conf0           = HDMI_AUD_CONF0_I2S_ALL_ENABLE;
54
55         switch (hparms->sample_width) {
56         case 16:
57                 conf1 = HDMI_AUD_CONF1_WIDTH_16;
58                 break;
59         case 24:
60         case 32:
61                 conf1 = HDMI_AUD_CONF1_WIDTH_24;
62                 break;
63         }
64
65         dw_hdmi_set_sample_rate(hdmi, hparms->sample_rate);
66
67         hdmi_write(audio, inputclkfs, HDMI_AUD_INPUTCLKFS);
68         hdmi_write(audio, conf0, HDMI_AUD_CONF0);
69         hdmi_write(audio, conf1, HDMI_AUD_CONF1);
70
71         dw_hdmi_audio_enable(hdmi);
72
73         return 0;
74 }
75
76 static void dw_hdmi_i2s_audio_shutdown(struct device *dev, void *data)
77 {
78         struct dw_hdmi_i2s_audio_data *audio = data;
79         struct dw_hdmi *hdmi = audio->hdmi;
80
81         dw_hdmi_audio_disable(hdmi);
82
83         hdmi_write(audio, HDMI_AUD_CONF0_SW_RESET, HDMI_AUD_CONF0);
84 }
85
86 static int dw_hdmi_i2s_get_dai_id(struct snd_soc_component *component,
87                                   struct device_node *endpoint)
88 {
89         struct of_endpoint of_ep;
90         int ret;
91
92         ret = of_graph_parse_endpoint(endpoint, &of_ep);
93         if (ret < 0)
94                 return ret;
95
96         /*
97          * HDMI sound should be located as reg = <2>
98          * Then, it is sound port 0
99          */
100         if (of_ep.port == 2)
101                 return 0;
102
103         return -EINVAL;
104 }
105
106 static struct hdmi_codec_ops dw_hdmi_i2s_ops = {
107         .hw_params      = dw_hdmi_i2s_hw_params,
108         .audio_shutdown = dw_hdmi_i2s_audio_shutdown,
109         .get_dai_id     = dw_hdmi_i2s_get_dai_id,
110 };
111
112 static int snd_dw_hdmi_probe(struct platform_device *pdev)
113 {
114         struct dw_hdmi_i2s_audio_data *audio = pdev->dev.platform_data;
115         struct platform_device_info pdevinfo;
116         struct hdmi_codec_pdata pdata;
117         struct platform_device *platform;
118
119         pdata.ops               = &dw_hdmi_i2s_ops;
120         pdata.i2s               = 1;
121         pdata.max_i2s_channels  = 6;
122         pdata.data              = audio;
123
124         memset(&pdevinfo, 0, sizeof(pdevinfo));
125         pdevinfo.parent         = pdev->dev.parent;
126         pdevinfo.id             = PLATFORM_DEVID_AUTO;
127         pdevinfo.name           = HDMI_CODEC_DRV_NAME;
128         pdevinfo.data           = &pdata;
129         pdevinfo.size_data      = sizeof(pdata);
130         pdevinfo.dma_mask       = DMA_BIT_MASK(32);
131
132         platform = platform_device_register_full(&pdevinfo);
133         if (IS_ERR(platform))
134                 return PTR_ERR(platform);
135
136         dev_set_drvdata(&pdev->dev, platform);
137
138         return 0;
139 }
140
141 static int snd_dw_hdmi_remove(struct platform_device *pdev)
142 {
143         struct platform_device *platform = dev_get_drvdata(&pdev->dev);
144
145         platform_device_unregister(platform);
146
147         return 0;
148 }
149
150 static struct platform_driver snd_dw_hdmi_driver = {
151         .probe  = snd_dw_hdmi_probe,
152         .remove = snd_dw_hdmi_remove,
153         .driver = {
154                 .name = DRIVER_NAME,
155         },
156 };
157 module_platform_driver(snd_dw_hdmi_driver);
158
159 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
160 MODULE_DESCRIPTION("Synopsis Designware HDMI I2S ALSA SoC interface");
161 MODULE_LICENSE("GPL v2");
162 MODULE_ALIAS("platform:" DRIVER_NAME);