1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (C) 2015 Broadcom
4 * Copyright (c) 2014 The Linux Foundation. All rights reserved.
5 * Copyright (C) 2013 Red Hat
6 * Author: Rob Clark <robdclark@gmail.com>
10 * DOC: VC4 Falcon HDMI module
12 * The HDMI core has a state machine and a PHY. On BCM2835, most of
13 * the unit operates off of the HSM clock from CPRMAN. It also
14 * internally uses the PLLH_PIX clock for the PHY.
16 * HDMI infoframes are kept within a small packet ram, where each
17 * packet can be individually enabled for including in a frame.
19 * HDMI audio is implemented entirely within the HDMI IP block. A
20 * register in the HDMI encoder takes SPDIF frames from the DMA engine
21 * and transfers them over an internal MAI (multi-channel audio
22 * interconnect) bus to the encoder side for insertion into the video
25 * The driver's HDMI encoder does not yet support power management.
26 * The HDMI encoder's power domain and the HSM/pixel clocks are kept
27 * continuously running, and only the HDMI logic and packet ram are
28 * powered off/on at disable/enable time.
30 * The driver does not yet support CEC control, though the HDMI
31 * encoder block has CEC support.
34 #include <drm/drm_atomic_helper.h>
35 #include <drm/drm_edid.h>
36 #include <drm/drm_probe_helper.h>
37 #include <linux/clk.h>
38 #include <linux/component.h>
39 #include <linux/i2c.h>
40 #include <linux/of_address.h>
41 #include <linux/of_gpio.h>
42 #include <linux/of_platform.h>
43 #include <linux/pm_runtime.h>
44 #include <linux/rational.h>
45 #include <sound/dmaengine_pcm.h>
46 #include <sound/pcm_drm_eld.h>
47 #include <sound/pcm_params.h>
48 #include <sound/soc.h>
49 #include "media/cec.h"
53 #define HSM_CLOCK_FREQ 163682864
54 #define CEC_CLOCK_FREQ 40000
55 #define CEC_CLOCK_DIV (HSM_CLOCK_FREQ / CEC_CLOCK_FREQ)
57 /* HDMI audio information */
58 struct vc4_hdmi_audio
{
59 struct snd_soc_card card
;
60 struct snd_soc_dai_link link
;
61 struct snd_soc_dai_link_component cpu
;
62 struct snd_soc_dai_link_component codec
;
63 struct snd_soc_dai_link_component platform
;
66 struct snd_dmaengine_dai_dma_data dma_data
;
67 struct snd_pcm_substream
*substream
;
70 /* General HDMI hardware state. */
72 struct platform_device
*pdev
;
74 struct drm_encoder
*encoder
;
75 struct drm_connector
*connector
;
77 struct vc4_hdmi_audio audio
;
79 struct i2c_adapter
*ddc
;
80 void __iomem
*hdmicore_regs
;
81 void __iomem
*hd_regs
;
85 struct cec_adapter
*cec_adap
;
86 struct cec_msg cec_rx_msg
;
90 struct clk
*pixel_clock
;
91 struct clk
*hsm_clock
;
93 struct debugfs_regset32 hdmi_regset
;
94 struct debugfs_regset32 hd_regset
;
97 #define HDMI_READ(offset) readl(vc4->hdmi->hdmicore_regs + offset)
98 #define HDMI_WRITE(offset, val) writel(val, vc4->hdmi->hdmicore_regs + offset)
99 #define HD_READ(offset) readl(vc4->hdmi->hd_regs + offset)
100 #define HD_WRITE(offset, val) writel(val, vc4->hdmi->hd_regs + offset)
102 /* VC4 HDMI encoder KMS struct */
103 struct vc4_hdmi_encoder
{
104 struct vc4_encoder base
;
106 bool limited_rgb_range
;
109 static inline struct vc4_hdmi_encoder
*
110 to_vc4_hdmi_encoder(struct drm_encoder
*encoder
)
112 return container_of(encoder
, struct vc4_hdmi_encoder
, base
.base
);
115 /* VC4 HDMI connector KMS struct */
116 struct vc4_hdmi_connector
{
117 struct drm_connector base
;
119 /* Since the connector is attached to just the one encoder,
120 * this is the reference to it so we can do the best_encoder()
123 struct drm_encoder
*encoder
;
126 static inline struct vc4_hdmi_connector
*
127 to_vc4_hdmi_connector(struct drm_connector
*connector
)
129 return container_of(connector
, struct vc4_hdmi_connector
, base
);
132 static const struct debugfs_reg32 hdmi_regs
[] = {
133 VC4_REG32(VC4_HDMI_CORE_REV
),
134 VC4_REG32(VC4_HDMI_SW_RESET_CONTROL
),
135 VC4_REG32(VC4_HDMI_HOTPLUG_INT
),
136 VC4_REG32(VC4_HDMI_HOTPLUG
),
137 VC4_REG32(VC4_HDMI_MAI_CHANNEL_MAP
),
138 VC4_REG32(VC4_HDMI_MAI_CONFIG
),
139 VC4_REG32(VC4_HDMI_MAI_FORMAT
),
140 VC4_REG32(VC4_HDMI_AUDIO_PACKET_CONFIG
),
141 VC4_REG32(VC4_HDMI_RAM_PACKET_CONFIG
),
142 VC4_REG32(VC4_HDMI_HORZA
),
143 VC4_REG32(VC4_HDMI_HORZB
),
144 VC4_REG32(VC4_HDMI_FIFO_CTL
),
145 VC4_REG32(VC4_HDMI_SCHEDULER_CONTROL
),
146 VC4_REG32(VC4_HDMI_VERTA0
),
147 VC4_REG32(VC4_HDMI_VERTA1
),
148 VC4_REG32(VC4_HDMI_VERTB0
),
149 VC4_REG32(VC4_HDMI_VERTB1
),
150 VC4_REG32(VC4_HDMI_TX_PHY_RESET_CTL
),
151 VC4_REG32(VC4_HDMI_TX_PHY_CTL0
),
153 VC4_REG32(VC4_HDMI_CEC_CNTRL_1
),
154 VC4_REG32(VC4_HDMI_CEC_CNTRL_2
),
155 VC4_REG32(VC4_HDMI_CEC_CNTRL_3
),
156 VC4_REG32(VC4_HDMI_CEC_CNTRL_4
),
157 VC4_REG32(VC4_HDMI_CEC_CNTRL_5
),
158 VC4_REG32(VC4_HDMI_CPU_STATUS
),
159 VC4_REG32(VC4_HDMI_CPU_MASK_STATUS
),
161 VC4_REG32(VC4_HDMI_CEC_RX_DATA_1
),
162 VC4_REG32(VC4_HDMI_CEC_RX_DATA_2
),
163 VC4_REG32(VC4_HDMI_CEC_RX_DATA_3
),
164 VC4_REG32(VC4_HDMI_CEC_RX_DATA_4
),
165 VC4_REG32(VC4_HDMI_CEC_TX_DATA_1
),
166 VC4_REG32(VC4_HDMI_CEC_TX_DATA_2
),
167 VC4_REG32(VC4_HDMI_CEC_TX_DATA_3
),
168 VC4_REG32(VC4_HDMI_CEC_TX_DATA_4
),
171 static const struct debugfs_reg32 hd_regs
[] = {
172 VC4_REG32(VC4_HD_M_CTL
),
173 VC4_REG32(VC4_HD_MAI_CTL
),
174 VC4_REG32(VC4_HD_MAI_THR
),
175 VC4_REG32(VC4_HD_MAI_FMT
),
176 VC4_REG32(VC4_HD_MAI_SMP
),
177 VC4_REG32(VC4_HD_VID_CTL
),
178 VC4_REG32(VC4_HD_CSC_CTL
),
179 VC4_REG32(VC4_HD_FRAME_COUNT
),
182 static int vc4_hdmi_debugfs_regs(struct seq_file
*m
, void *unused
)
184 struct drm_info_node
*node
= (struct drm_info_node
*)m
->private;
185 struct drm_device
*dev
= node
->minor
->dev
;
186 struct vc4_dev
*vc4
= to_vc4_dev(dev
);
187 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
188 struct drm_printer p
= drm_seq_file_printer(m
);
190 drm_print_regset32(&p
, &hdmi
->hdmi_regset
);
191 drm_print_regset32(&p
, &hdmi
->hd_regset
);
196 static enum drm_connector_status
197 vc4_hdmi_connector_detect(struct drm_connector
*connector
, bool force
)
199 struct drm_device
*dev
= connector
->dev
;
200 struct vc4_dev
*vc4
= to_vc4_dev(dev
);
202 if (vc4
->hdmi
->hpd_gpio
) {
203 if (gpio_get_value_cansleep(vc4
->hdmi
->hpd_gpio
) ^
204 vc4
->hdmi
->hpd_active_low
)
205 return connector_status_connected
;
206 cec_phys_addr_invalidate(vc4
->hdmi
->cec_adap
);
207 return connector_status_disconnected
;
210 if (drm_probe_ddc(vc4
->hdmi
->ddc
))
211 return connector_status_connected
;
213 if (HDMI_READ(VC4_HDMI_HOTPLUG
) & VC4_HDMI_HOTPLUG_CONNECTED
)
214 return connector_status_connected
;
215 cec_phys_addr_invalidate(vc4
->hdmi
->cec_adap
);
216 return connector_status_disconnected
;
219 static void vc4_hdmi_connector_destroy(struct drm_connector
*connector
)
221 drm_connector_unregister(connector
);
222 drm_connector_cleanup(connector
);
225 static int vc4_hdmi_connector_get_modes(struct drm_connector
*connector
)
227 struct vc4_hdmi_connector
*vc4_connector
=
228 to_vc4_hdmi_connector(connector
);
229 struct drm_encoder
*encoder
= vc4_connector
->encoder
;
230 struct vc4_hdmi_encoder
*vc4_encoder
= to_vc4_hdmi_encoder(encoder
);
231 struct drm_device
*dev
= connector
->dev
;
232 struct vc4_dev
*vc4
= to_vc4_dev(dev
);
236 edid
= drm_get_edid(connector
, vc4
->hdmi
->ddc
);
237 cec_s_phys_addr_from_edid(vc4
->hdmi
->cec_adap
, edid
);
241 vc4_encoder
->hdmi_monitor
= drm_detect_hdmi_monitor(edid
);
243 drm_connector_update_edid_property(connector
, edid
);
244 ret
= drm_add_edid_modes(connector
, edid
);
250 static void vc4_hdmi_connector_reset(struct drm_connector
*connector
)
252 drm_atomic_helper_connector_reset(connector
);
253 drm_atomic_helper_connector_tv_reset(connector
);
256 static const struct drm_connector_funcs vc4_hdmi_connector_funcs
= {
257 .detect
= vc4_hdmi_connector_detect
,
258 .fill_modes
= drm_helper_probe_single_connector_modes
,
259 .destroy
= vc4_hdmi_connector_destroy
,
260 .reset
= vc4_hdmi_connector_reset
,
261 .atomic_duplicate_state
= drm_atomic_helper_connector_duplicate_state
,
262 .atomic_destroy_state
= drm_atomic_helper_connector_destroy_state
,
265 static const struct drm_connector_helper_funcs vc4_hdmi_connector_helper_funcs
= {
266 .get_modes
= vc4_hdmi_connector_get_modes
,
269 static struct drm_connector
*vc4_hdmi_connector_init(struct drm_device
*dev
,
270 struct drm_encoder
*encoder
)
272 struct drm_connector
*connector
;
273 struct vc4_hdmi_connector
*hdmi_connector
;
276 hdmi_connector
= devm_kzalloc(dev
->dev
, sizeof(*hdmi_connector
),
279 return ERR_PTR(-ENOMEM
);
280 connector
= &hdmi_connector
->base
;
282 hdmi_connector
->encoder
= encoder
;
284 drm_connector_init(dev
, connector
, &vc4_hdmi_connector_funcs
,
285 DRM_MODE_CONNECTOR_HDMIA
);
286 drm_connector_helper_add(connector
, &vc4_hdmi_connector_helper_funcs
);
288 /* Create and attach TV margin props to this connector. */
289 ret
= drm_mode_create_tv_margin_properties(dev
);
293 drm_connector_attach_tv_margin_properties(connector
);
295 connector
->polled
= (DRM_CONNECTOR_POLL_CONNECT
|
296 DRM_CONNECTOR_POLL_DISCONNECT
);
298 connector
->interlace_allowed
= 1;
299 connector
->doublescan_allowed
= 0;
301 drm_connector_attach_encoder(connector
, encoder
);
306 static void vc4_hdmi_encoder_destroy(struct drm_encoder
*encoder
)
308 drm_encoder_cleanup(encoder
);
311 static const struct drm_encoder_funcs vc4_hdmi_encoder_funcs
= {
312 .destroy
= vc4_hdmi_encoder_destroy
,
315 static int vc4_hdmi_stop_packet(struct drm_encoder
*encoder
,
316 enum hdmi_infoframe_type type
)
318 struct drm_device
*dev
= encoder
->dev
;
319 struct vc4_dev
*vc4
= to_vc4_dev(dev
);
320 u32 packet_id
= type
- 0x80;
322 HDMI_WRITE(VC4_HDMI_RAM_PACKET_CONFIG
,
323 HDMI_READ(VC4_HDMI_RAM_PACKET_CONFIG
) & ~BIT(packet_id
));
325 return wait_for(!(HDMI_READ(VC4_HDMI_RAM_PACKET_STATUS
) &
326 BIT(packet_id
)), 100);
329 static void vc4_hdmi_write_infoframe(struct drm_encoder
*encoder
,
330 union hdmi_infoframe
*frame
)
332 struct drm_device
*dev
= encoder
->dev
;
333 struct vc4_dev
*vc4
= to_vc4_dev(dev
);
334 u32 packet_id
= frame
->any
.type
- 0x80;
335 u32 packet_reg
= VC4_HDMI_RAM_PACKET(packet_id
);
336 uint8_t buffer
[VC4_HDMI_PACKET_STRIDE
];
340 WARN_ONCE(!(HDMI_READ(VC4_HDMI_RAM_PACKET_CONFIG
) &
341 VC4_HDMI_RAM_PACKET_ENABLE
),
342 "Packet RAM has to be on to store the packet.");
344 len
= hdmi_infoframe_pack(frame
, buffer
, sizeof(buffer
));
348 ret
= vc4_hdmi_stop_packet(encoder
, frame
->any
.type
);
350 DRM_ERROR("Failed to wait for infoframe to go idle: %d\n", ret
);
354 for (i
= 0; i
< len
; i
+= 7) {
355 HDMI_WRITE(packet_reg
,
358 buffer
[i
+ 2] << 16);
361 HDMI_WRITE(packet_reg
,
364 buffer
[i
+ 5] << 16 |
365 buffer
[i
+ 6] << 24);
369 HDMI_WRITE(VC4_HDMI_RAM_PACKET_CONFIG
,
370 HDMI_READ(VC4_HDMI_RAM_PACKET_CONFIG
) | BIT(packet_id
));
371 ret
= wait_for((HDMI_READ(VC4_HDMI_RAM_PACKET_STATUS
) &
372 BIT(packet_id
)), 100);
374 DRM_ERROR("Failed to wait for infoframe to start: %d\n", ret
);
377 static void vc4_hdmi_set_avi_infoframe(struct drm_encoder
*encoder
)
379 struct vc4_hdmi_encoder
*vc4_encoder
= to_vc4_hdmi_encoder(encoder
);
380 struct vc4_dev
*vc4
= encoder
->dev
->dev_private
;
381 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
382 struct drm_connector_state
*cstate
= hdmi
->connector
->state
;
383 struct drm_crtc
*crtc
= encoder
->crtc
;
384 const struct drm_display_mode
*mode
= &crtc
->state
->adjusted_mode
;
385 union hdmi_infoframe frame
;
388 ret
= drm_hdmi_avi_infoframe_from_display_mode(&frame
.avi
,
389 hdmi
->connector
, mode
);
391 DRM_ERROR("couldn't fill AVI infoframe\n");
395 drm_hdmi_avi_infoframe_quant_range(&frame
.avi
,
396 hdmi
->connector
, mode
,
397 vc4_encoder
->limited_rgb_range
?
398 HDMI_QUANTIZATION_RANGE_LIMITED
:
399 HDMI_QUANTIZATION_RANGE_FULL
);
401 frame
.avi
.right_bar
= cstate
->tv
.margins
.right
;
402 frame
.avi
.left_bar
= cstate
->tv
.margins
.left
;
403 frame
.avi
.top_bar
= cstate
->tv
.margins
.top
;
404 frame
.avi
.bottom_bar
= cstate
->tv
.margins
.bottom
;
406 vc4_hdmi_write_infoframe(encoder
, &frame
);
409 static void vc4_hdmi_set_spd_infoframe(struct drm_encoder
*encoder
)
411 union hdmi_infoframe frame
;
414 ret
= hdmi_spd_infoframe_init(&frame
.spd
, "Broadcom", "Videocore");
416 DRM_ERROR("couldn't fill SPD infoframe\n");
420 frame
.spd
.sdi
= HDMI_SPD_SDI_PC
;
422 vc4_hdmi_write_infoframe(encoder
, &frame
);
425 static void vc4_hdmi_set_audio_infoframe(struct drm_encoder
*encoder
)
427 struct drm_device
*drm
= encoder
->dev
;
428 struct vc4_dev
*vc4
= drm
->dev_private
;
429 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
430 union hdmi_infoframe frame
;
433 ret
= hdmi_audio_infoframe_init(&frame
.audio
);
435 frame
.audio
.coding_type
= HDMI_AUDIO_CODING_TYPE_STREAM
;
436 frame
.audio
.sample_frequency
= HDMI_AUDIO_SAMPLE_FREQUENCY_STREAM
;
437 frame
.audio
.sample_size
= HDMI_AUDIO_SAMPLE_SIZE_STREAM
;
438 frame
.audio
.channels
= hdmi
->audio
.channels
;
440 vc4_hdmi_write_infoframe(encoder
, &frame
);
443 static void vc4_hdmi_set_infoframes(struct drm_encoder
*encoder
)
445 vc4_hdmi_set_avi_infoframe(encoder
);
446 vc4_hdmi_set_spd_infoframe(encoder
);
449 static void vc4_hdmi_encoder_disable(struct drm_encoder
*encoder
)
451 struct drm_device
*dev
= encoder
->dev
;
452 struct vc4_dev
*vc4
= to_vc4_dev(dev
);
453 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
456 HDMI_WRITE(VC4_HDMI_RAM_PACKET_CONFIG
, 0);
458 HDMI_WRITE(VC4_HDMI_TX_PHY_RESET_CTL
, 0xf << 16);
459 HD_WRITE(VC4_HD_VID_CTL
,
460 HD_READ(VC4_HD_VID_CTL
) & ~VC4_HD_VID_CTL_ENABLE
);
462 clk_disable_unprepare(hdmi
->pixel_clock
);
464 ret
= pm_runtime_put(&hdmi
->pdev
->dev
);
466 DRM_ERROR("Failed to release power domain: %d\n", ret
);
469 static void vc4_hdmi_encoder_enable(struct drm_encoder
*encoder
)
471 struct drm_display_mode
*mode
= &encoder
->crtc
->state
->adjusted_mode
;
472 struct vc4_hdmi_encoder
*vc4_encoder
= to_vc4_hdmi_encoder(encoder
);
473 struct drm_device
*dev
= encoder
->dev
;
474 struct vc4_dev
*vc4
= to_vc4_dev(dev
);
475 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
476 bool debug_dump_regs
= false;
477 bool hsync_pos
= mode
->flags
& DRM_MODE_FLAG_PHSYNC
;
478 bool vsync_pos
= mode
->flags
& DRM_MODE_FLAG_PVSYNC
;
479 bool interlaced
= mode
->flags
& DRM_MODE_FLAG_INTERLACE
;
480 u32 pixel_rep
= (mode
->flags
& DRM_MODE_FLAG_DBLCLK
) ? 2 : 1;
481 u32 verta
= (VC4_SET_FIELD(mode
->crtc_vsync_end
- mode
->crtc_vsync_start
,
482 VC4_HDMI_VERTA_VSP
) |
483 VC4_SET_FIELD(mode
->crtc_vsync_start
- mode
->crtc_vdisplay
,
484 VC4_HDMI_VERTA_VFP
) |
485 VC4_SET_FIELD(mode
->crtc_vdisplay
, VC4_HDMI_VERTA_VAL
));
486 u32 vertb
= (VC4_SET_FIELD(0, VC4_HDMI_VERTB_VSPO
) |
487 VC4_SET_FIELD(mode
->crtc_vtotal
- mode
->crtc_vsync_end
,
488 VC4_HDMI_VERTB_VBP
));
489 u32 vertb_even
= (VC4_SET_FIELD(0, VC4_HDMI_VERTB_VSPO
) |
490 VC4_SET_FIELD(mode
->crtc_vtotal
-
491 mode
->crtc_vsync_end
-
493 VC4_HDMI_VERTB_VBP
));
497 ret
= pm_runtime_get_sync(&hdmi
->pdev
->dev
);
499 DRM_ERROR("Failed to retain power domain: %d\n", ret
);
503 ret
= clk_set_rate(hdmi
->pixel_clock
,
505 ((mode
->flags
& DRM_MODE_FLAG_DBLCLK
) ? 2 : 1));
507 DRM_ERROR("Failed to set pixel clock rate: %d\n", ret
);
511 ret
= clk_prepare_enable(hdmi
->pixel_clock
);
513 DRM_ERROR("Failed to turn on pixel clock: %d\n", ret
);
517 HDMI_WRITE(VC4_HDMI_SW_RESET_CONTROL
,
518 VC4_HDMI_SW_RESET_HDMI
|
519 VC4_HDMI_SW_RESET_FORMAT_DETECT
);
521 HDMI_WRITE(VC4_HDMI_SW_RESET_CONTROL
, 0);
523 /* PHY should be in reset, like
524 * vc4_hdmi_encoder_disable() does.
526 HDMI_WRITE(VC4_HDMI_TX_PHY_RESET_CTL
, 0xf << 16);
528 HDMI_WRITE(VC4_HDMI_TX_PHY_RESET_CTL
, 0);
530 if (debug_dump_regs
) {
531 struct drm_printer p
= drm_info_printer(&hdmi
->pdev
->dev
);
533 dev_info(&hdmi
->pdev
->dev
, "HDMI regs before:\n");
534 drm_print_regset32(&p
, &hdmi
->hdmi_regset
);
535 drm_print_regset32(&p
, &hdmi
->hd_regset
);
538 HD_WRITE(VC4_HD_VID_CTL
, 0);
540 HDMI_WRITE(VC4_HDMI_SCHEDULER_CONTROL
,
541 HDMI_READ(VC4_HDMI_SCHEDULER_CONTROL
) |
542 VC4_HDMI_SCHEDULER_CONTROL_MANUAL_FORMAT
|
543 VC4_HDMI_SCHEDULER_CONTROL_IGNORE_VSYNC_PREDICTS
);
545 HDMI_WRITE(VC4_HDMI_HORZA
,
546 (vsync_pos
? VC4_HDMI_HORZA_VPOS
: 0) |
547 (hsync_pos
? VC4_HDMI_HORZA_HPOS
: 0) |
548 VC4_SET_FIELD(mode
->hdisplay
* pixel_rep
,
549 VC4_HDMI_HORZA_HAP
));
551 HDMI_WRITE(VC4_HDMI_HORZB
,
552 VC4_SET_FIELD((mode
->htotal
-
553 mode
->hsync_end
) * pixel_rep
,
554 VC4_HDMI_HORZB_HBP
) |
555 VC4_SET_FIELD((mode
->hsync_end
-
556 mode
->hsync_start
) * pixel_rep
,
557 VC4_HDMI_HORZB_HSP
) |
558 VC4_SET_FIELD((mode
->hsync_start
-
559 mode
->hdisplay
) * pixel_rep
,
560 VC4_HDMI_HORZB_HFP
));
562 HDMI_WRITE(VC4_HDMI_VERTA0
, verta
);
563 HDMI_WRITE(VC4_HDMI_VERTA1
, verta
);
565 HDMI_WRITE(VC4_HDMI_VERTB0
, vertb_even
);
566 HDMI_WRITE(VC4_HDMI_VERTB1
, vertb
);
568 HD_WRITE(VC4_HD_VID_CTL
,
569 (vsync_pos
? 0 : VC4_HD_VID_CTL_VSYNC_LOW
) |
570 (hsync_pos
? 0 : VC4_HD_VID_CTL_HSYNC_LOW
));
572 csc_ctl
= VC4_SET_FIELD(VC4_HD_CSC_CTL_ORDER_BGR
,
573 VC4_HD_CSC_CTL_ORDER
);
575 if (vc4_encoder
->hdmi_monitor
&&
576 drm_default_rgb_quant_range(mode
) ==
577 HDMI_QUANTIZATION_RANGE_LIMITED
) {
578 /* CEA VICs other than #1 requre limited range RGB
579 * output unless overridden by an AVI infoframe.
580 * Apply a colorspace conversion to squash 0-255 down
581 * to 16-235. The matrix here is:
588 csc_ctl
|= VC4_HD_CSC_CTL_ENABLE
;
589 csc_ctl
|= VC4_HD_CSC_CTL_RGB2YCC
;
590 csc_ctl
|= VC4_SET_FIELD(VC4_HD_CSC_CTL_MODE_CUSTOM
,
591 VC4_HD_CSC_CTL_MODE
);
593 HD_WRITE(VC4_HD_CSC_12_11
, (0x000 << 16) | 0x000);
594 HD_WRITE(VC4_HD_CSC_14_13
, (0x100 << 16) | 0x6e0);
595 HD_WRITE(VC4_HD_CSC_22_21
, (0x6e0 << 16) | 0x000);
596 HD_WRITE(VC4_HD_CSC_24_23
, (0x100 << 16) | 0x000);
597 HD_WRITE(VC4_HD_CSC_32_31
, (0x000 << 16) | 0x6e0);
598 HD_WRITE(VC4_HD_CSC_34_33
, (0x100 << 16) | 0x000);
599 vc4_encoder
->limited_rgb_range
= true;
601 vc4_encoder
->limited_rgb_range
= false;
604 /* The RGB order applies even when CSC is disabled. */
605 HD_WRITE(VC4_HD_CSC_CTL
, csc_ctl
);
607 HDMI_WRITE(VC4_HDMI_FIFO_CTL
, VC4_HDMI_FIFO_CTL_MASTER_SLAVE_N
);
609 if (debug_dump_regs
) {
610 struct drm_printer p
= drm_info_printer(&hdmi
->pdev
->dev
);
612 dev_info(&hdmi
->pdev
->dev
, "HDMI regs after:\n");
613 drm_print_regset32(&p
, &hdmi
->hdmi_regset
);
614 drm_print_regset32(&p
, &hdmi
->hd_regset
);
617 HD_WRITE(VC4_HD_VID_CTL
,
618 HD_READ(VC4_HD_VID_CTL
) |
619 VC4_HD_VID_CTL_ENABLE
|
620 VC4_HD_VID_CTL_UNDERFLOW_ENABLE
|
621 VC4_HD_VID_CTL_FRAME_COUNTER_RESET
);
623 if (vc4_encoder
->hdmi_monitor
) {
624 HDMI_WRITE(VC4_HDMI_SCHEDULER_CONTROL
,
625 HDMI_READ(VC4_HDMI_SCHEDULER_CONTROL
) |
626 VC4_HDMI_SCHEDULER_CONTROL_MODE_HDMI
);
628 ret
= wait_for(HDMI_READ(VC4_HDMI_SCHEDULER_CONTROL
) &
629 VC4_HDMI_SCHEDULER_CONTROL_HDMI_ACTIVE
, 1000);
630 WARN_ONCE(ret
, "Timeout waiting for "
631 "VC4_HDMI_SCHEDULER_CONTROL_HDMI_ACTIVE\n");
633 HDMI_WRITE(VC4_HDMI_RAM_PACKET_CONFIG
,
634 HDMI_READ(VC4_HDMI_RAM_PACKET_CONFIG
) &
635 ~(VC4_HDMI_RAM_PACKET_ENABLE
));
636 HDMI_WRITE(VC4_HDMI_SCHEDULER_CONTROL
,
637 HDMI_READ(VC4_HDMI_SCHEDULER_CONTROL
) &
638 ~VC4_HDMI_SCHEDULER_CONTROL_MODE_HDMI
);
640 ret
= wait_for(!(HDMI_READ(VC4_HDMI_SCHEDULER_CONTROL
) &
641 VC4_HDMI_SCHEDULER_CONTROL_HDMI_ACTIVE
), 1000);
642 WARN_ONCE(ret
, "Timeout waiting for "
643 "!VC4_HDMI_SCHEDULER_CONTROL_HDMI_ACTIVE\n");
646 if (vc4_encoder
->hdmi_monitor
) {
649 WARN_ON(!(HDMI_READ(VC4_HDMI_SCHEDULER_CONTROL
) &
650 VC4_HDMI_SCHEDULER_CONTROL_HDMI_ACTIVE
));
651 HDMI_WRITE(VC4_HDMI_SCHEDULER_CONTROL
,
652 HDMI_READ(VC4_HDMI_SCHEDULER_CONTROL
) |
653 VC4_HDMI_SCHEDULER_CONTROL_VERT_ALWAYS_KEEPOUT
);
655 HDMI_WRITE(VC4_HDMI_RAM_PACKET_CONFIG
,
656 VC4_HDMI_RAM_PACKET_ENABLE
);
658 vc4_hdmi_set_infoframes(encoder
);
660 drift
= HDMI_READ(VC4_HDMI_FIFO_CTL
);
661 drift
&= VC4_HDMI_FIFO_VALID_WRITE_MASK
;
663 HDMI_WRITE(VC4_HDMI_FIFO_CTL
,
664 drift
& ~VC4_HDMI_FIFO_CTL_RECENTER
);
665 HDMI_WRITE(VC4_HDMI_FIFO_CTL
,
666 drift
| VC4_HDMI_FIFO_CTL_RECENTER
);
667 usleep_range(1000, 1100);
668 HDMI_WRITE(VC4_HDMI_FIFO_CTL
,
669 drift
& ~VC4_HDMI_FIFO_CTL_RECENTER
);
670 HDMI_WRITE(VC4_HDMI_FIFO_CTL
,
671 drift
| VC4_HDMI_FIFO_CTL_RECENTER
);
673 ret
= wait_for(HDMI_READ(VC4_HDMI_FIFO_CTL
) &
674 VC4_HDMI_FIFO_CTL_RECENTER_DONE
, 1);
675 WARN_ONCE(ret
, "Timeout waiting for "
676 "VC4_HDMI_FIFO_CTL_RECENTER_DONE");
680 static enum drm_mode_status
681 vc4_hdmi_encoder_mode_valid(struct drm_encoder
*crtc
,
682 const struct drm_display_mode
*mode
)
685 * As stated in RPi's vc4 firmware "HDMI state machine (HSM) clock must
686 * be faster than pixel clock, infinitesimally faster, tested in
687 * simulation. Otherwise, exact value is unimportant for HDMI
688 * operation." This conflicts with bcm2835's vc4 documentation, which
689 * states HSM's clock has to be at least 108% of the pixel clock.
691 * Real life tests reveal that vc4's firmware statement holds up, and
692 * users are able to use pixel clocks closer to HSM's, namely for
693 * 1920x1200@60Hz. So it was decided to have leave a 1% margin between
694 * both clocks. Which, for RPi0-3 implies a maximum pixel clock of
697 * Additionally, the AXI clock needs to be at least 25% of
698 * pixel clock, but HSM ends up being the limiting factor.
700 if (mode
->clock
> HSM_CLOCK_FREQ
/ (1000 * 101 / 100))
701 return MODE_CLOCK_HIGH
;
706 static const struct drm_encoder_helper_funcs vc4_hdmi_encoder_helper_funcs
= {
707 .mode_valid
= vc4_hdmi_encoder_mode_valid
,
708 .disable
= vc4_hdmi_encoder_disable
,
709 .enable
= vc4_hdmi_encoder_enable
,
712 /* HDMI audio codec callbacks */
713 static void vc4_hdmi_audio_set_mai_clock(struct vc4_hdmi
*hdmi
)
715 struct drm_device
*drm
= hdmi
->encoder
->dev
;
716 struct vc4_dev
*vc4
= to_vc4_dev(drm
);
717 u32 hsm_clock
= clk_get_rate(hdmi
->hsm_clock
);
720 rational_best_approximation(hsm_clock
, hdmi
->audio
.samplerate
,
721 VC4_HD_MAI_SMP_N_MASK
>>
722 VC4_HD_MAI_SMP_N_SHIFT
,
723 (VC4_HD_MAI_SMP_M_MASK
>>
724 VC4_HD_MAI_SMP_M_SHIFT
) + 1,
727 HD_WRITE(VC4_HD_MAI_SMP
,
728 VC4_SET_FIELD(n
, VC4_HD_MAI_SMP_N
) |
729 VC4_SET_FIELD(m
- 1, VC4_HD_MAI_SMP_M
));
732 static void vc4_hdmi_set_n_cts(struct vc4_hdmi
*hdmi
)
734 struct drm_encoder
*encoder
= hdmi
->encoder
;
735 struct drm_crtc
*crtc
= encoder
->crtc
;
736 struct drm_device
*drm
= encoder
->dev
;
737 struct vc4_dev
*vc4
= to_vc4_dev(drm
);
738 const struct drm_display_mode
*mode
= &crtc
->state
->adjusted_mode
;
739 u32 samplerate
= hdmi
->audio
.samplerate
;
743 n
= 128 * samplerate
/ 1000;
744 tmp
= (u64
)(mode
->clock
* 1000) * n
;
745 do_div(tmp
, 128 * samplerate
);
748 HDMI_WRITE(VC4_HDMI_CRP_CFG
,
749 VC4_HDMI_CRP_CFG_EXTERNAL_CTS_EN
|
750 VC4_SET_FIELD(n
, VC4_HDMI_CRP_CFG_N
));
753 * We could get slightly more accurate clocks in some cases by
754 * providing a CTS_1 value. The two CTS values are alternated
755 * between based on the period fields
757 HDMI_WRITE(VC4_HDMI_CTS_0
, cts
);
758 HDMI_WRITE(VC4_HDMI_CTS_1
, cts
);
761 static inline struct vc4_hdmi
*dai_to_hdmi(struct snd_soc_dai
*dai
)
763 struct snd_soc_card
*card
= snd_soc_dai_get_drvdata(dai
);
765 return snd_soc_card_get_drvdata(card
);
768 static int vc4_hdmi_audio_startup(struct snd_pcm_substream
*substream
,
769 struct snd_soc_dai
*dai
)
771 struct vc4_hdmi
*hdmi
= dai_to_hdmi(dai
);
772 struct drm_encoder
*encoder
= hdmi
->encoder
;
773 struct vc4_dev
*vc4
= to_vc4_dev(encoder
->dev
);
776 if (hdmi
->audio
.substream
&& hdmi
->audio
.substream
!= substream
)
779 hdmi
->audio
.substream
= substream
;
782 * If the HDMI encoder hasn't probed, or the encoder is
783 * currently in DVI mode, treat the codec dai as missing.
785 if (!encoder
->crtc
|| !(HDMI_READ(VC4_HDMI_RAM_PACKET_CONFIG
) &
786 VC4_HDMI_RAM_PACKET_ENABLE
))
789 ret
= snd_pcm_hw_constraint_eld(substream
->runtime
,
790 hdmi
->connector
->eld
);
797 static int vc4_hdmi_audio_set_fmt(struct snd_soc_dai
*dai
, unsigned int fmt
)
802 static void vc4_hdmi_audio_reset(struct vc4_hdmi
*hdmi
)
804 struct drm_encoder
*encoder
= hdmi
->encoder
;
805 struct drm_device
*drm
= encoder
->dev
;
806 struct device
*dev
= &hdmi
->pdev
->dev
;
807 struct vc4_dev
*vc4
= to_vc4_dev(drm
);
810 ret
= vc4_hdmi_stop_packet(encoder
, HDMI_INFOFRAME_TYPE_AUDIO
);
812 dev_err(dev
, "Failed to stop audio infoframe: %d\n", ret
);
814 HD_WRITE(VC4_HD_MAI_CTL
, VC4_HD_MAI_CTL_RESET
);
815 HD_WRITE(VC4_HD_MAI_CTL
, VC4_HD_MAI_CTL_ERRORF
);
816 HD_WRITE(VC4_HD_MAI_CTL
, VC4_HD_MAI_CTL_FLUSH
);
819 static void vc4_hdmi_audio_shutdown(struct snd_pcm_substream
*substream
,
820 struct snd_soc_dai
*dai
)
822 struct vc4_hdmi
*hdmi
= dai_to_hdmi(dai
);
824 if (substream
!= hdmi
->audio
.substream
)
827 vc4_hdmi_audio_reset(hdmi
);
829 hdmi
->audio
.substream
= NULL
;
832 /* HDMI audio codec callbacks */
833 static int vc4_hdmi_audio_hw_params(struct snd_pcm_substream
*substream
,
834 struct snd_pcm_hw_params
*params
,
835 struct snd_soc_dai
*dai
)
837 struct vc4_hdmi
*hdmi
= dai_to_hdmi(dai
);
838 struct drm_encoder
*encoder
= hdmi
->encoder
;
839 struct drm_device
*drm
= encoder
->dev
;
840 struct device
*dev
= &hdmi
->pdev
->dev
;
841 struct vc4_dev
*vc4
= to_vc4_dev(drm
);
842 u32 audio_packet_config
, channel_mask
;
845 if (substream
!= hdmi
->audio
.substream
)
848 dev_dbg(dev
, "%s: %u Hz, %d bit, %d channels\n", __func__
,
849 params_rate(params
), params_width(params
),
850 params_channels(params
));
852 hdmi
->audio
.channels
= params_channels(params
);
853 hdmi
->audio
.samplerate
= params_rate(params
);
855 HD_WRITE(VC4_HD_MAI_CTL
,
856 VC4_HD_MAI_CTL_RESET
|
857 VC4_HD_MAI_CTL_FLUSH
|
858 VC4_HD_MAI_CTL_DLATE
|
859 VC4_HD_MAI_CTL_ERRORE
|
860 VC4_HD_MAI_CTL_ERRORF
);
862 vc4_hdmi_audio_set_mai_clock(hdmi
);
864 audio_packet_config
=
865 VC4_HDMI_AUDIO_PACKET_ZERO_DATA_ON_SAMPLE_FLAT
|
866 VC4_HDMI_AUDIO_PACKET_ZERO_DATA_ON_INACTIVE_CHANNELS
|
867 VC4_SET_FIELD(0xf, VC4_HDMI_AUDIO_PACKET_B_FRAME_IDENTIFIER
);
869 channel_mask
= GENMASK(hdmi
->audio
.channels
- 1, 0);
870 audio_packet_config
|= VC4_SET_FIELD(channel_mask
,
871 VC4_HDMI_AUDIO_PACKET_CEA_MASK
);
873 /* Set the MAI threshold. This logic mimics the firmware's. */
874 if (hdmi
->audio
.samplerate
> 96000) {
875 HD_WRITE(VC4_HD_MAI_THR
,
876 VC4_SET_FIELD(0x12, VC4_HD_MAI_THR_DREQHIGH
) |
877 VC4_SET_FIELD(0x12, VC4_HD_MAI_THR_DREQLOW
));
878 } else if (hdmi
->audio
.samplerate
> 48000) {
879 HD_WRITE(VC4_HD_MAI_THR
,
880 VC4_SET_FIELD(0x14, VC4_HD_MAI_THR_DREQHIGH
) |
881 VC4_SET_FIELD(0x12, VC4_HD_MAI_THR_DREQLOW
));
883 HD_WRITE(VC4_HD_MAI_THR
,
884 VC4_SET_FIELD(0x10, VC4_HD_MAI_THR_PANICHIGH
) |
885 VC4_SET_FIELD(0x10, VC4_HD_MAI_THR_PANICLOW
) |
886 VC4_SET_FIELD(0x10, VC4_HD_MAI_THR_DREQHIGH
) |
887 VC4_SET_FIELD(0x10, VC4_HD_MAI_THR_DREQLOW
));
890 HDMI_WRITE(VC4_HDMI_MAI_CONFIG
,
891 VC4_HDMI_MAI_CONFIG_BIT_REVERSE
|
892 VC4_SET_FIELD(channel_mask
, VC4_HDMI_MAI_CHANNEL_MASK
));
895 for (i
= 0; i
< 8; i
++) {
896 if (channel_mask
& BIT(i
))
897 channel_map
|= i
<< (3 * i
);
900 HDMI_WRITE(VC4_HDMI_MAI_CHANNEL_MAP
, channel_map
);
901 HDMI_WRITE(VC4_HDMI_AUDIO_PACKET_CONFIG
, audio_packet_config
);
902 vc4_hdmi_set_n_cts(hdmi
);
907 static int vc4_hdmi_audio_trigger(struct snd_pcm_substream
*substream
, int cmd
,
908 struct snd_soc_dai
*dai
)
910 struct vc4_hdmi
*hdmi
= dai_to_hdmi(dai
);
911 struct drm_encoder
*encoder
= hdmi
->encoder
;
912 struct drm_device
*drm
= encoder
->dev
;
913 struct vc4_dev
*vc4
= to_vc4_dev(drm
);
916 case SNDRV_PCM_TRIGGER_START
:
917 vc4_hdmi_set_audio_infoframe(encoder
);
918 HDMI_WRITE(VC4_HDMI_TX_PHY_CTL0
,
919 HDMI_READ(VC4_HDMI_TX_PHY_CTL0
) &
920 ~VC4_HDMI_TX_PHY_RNG_PWRDN
);
921 HD_WRITE(VC4_HD_MAI_CTL
,
922 VC4_SET_FIELD(hdmi
->audio
.channels
,
923 VC4_HD_MAI_CTL_CHNUM
) |
924 VC4_HD_MAI_CTL_ENABLE
);
926 case SNDRV_PCM_TRIGGER_STOP
:
927 HD_WRITE(VC4_HD_MAI_CTL
,
928 VC4_HD_MAI_CTL_DLATE
|
929 VC4_HD_MAI_CTL_ERRORE
|
930 VC4_HD_MAI_CTL_ERRORF
);
931 HDMI_WRITE(VC4_HDMI_TX_PHY_CTL0
,
932 HDMI_READ(VC4_HDMI_TX_PHY_CTL0
) |
933 VC4_HDMI_TX_PHY_RNG_PWRDN
);
942 static inline struct vc4_hdmi
*
943 snd_component_to_hdmi(struct snd_soc_component
*component
)
945 struct snd_soc_card
*card
= snd_soc_component_get_drvdata(component
);
947 return snd_soc_card_get_drvdata(card
);
950 static int vc4_hdmi_audio_eld_ctl_info(struct snd_kcontrol
*kcontrol
,
951 struct snd_ctl_elem_info
*uinfo
)
953 struct snd_soc_component
*component
= snd_kcontrol_chip(kcontrol
);
954 struct vc4_hdmi
*hdmi
= snd_component_to_hdmi(component
);
956 uinfo
->type
= SNDRV_CTL_ELEM_TYPE_BYTES
;
957 uinfo
->count
= sizeof(hdmi
->connector
->eld
);
962 static int vc4_hdmi_audio_eld_ctl_get(struct snd_kcontrol
*kcontrol
,
963 struct snd_ctl_elem_value
*ucontrol
)
965 struct snd_soc_component
*component
= snd_kcontrol_chip(kcontrol
);
966 struct vc4_hdmi
*hdmi
= snd_component_to_hdmi(component
);
968 memcpy(ucontrol
->value
.bytes
.data
, hdmi
->connector
->eld
,
969 sizeof(hdmi
->connector
->eld
));
974 static const struct snd_kcontrol_new vc4_hdmi_audio_controls
[] = {
976 .access
= SNDRV_CTL_ELEM_ACCESS_READ
|
977 SNDRV_CTL_ELEM_ACCESS_VOLATILE
,
978 .iface
= SNDRV_CTL_ELEM_IFACE_PCM
,
980 .info
= vc4_hdmi_audio_eld_ctl_info
,
981 .get
= vc4_hdmi_audio_eld_ctl_get
,
985 static const struct snd_soc_dapm_widget vc4_hdmi_audio_widgets
[] = {
986 SND_SOC_DAPM_OUTPUT("TX"),
989 static const struct snd_soc_dapm_route vc4_hdmi_audio_routes
[] = {
990 { "TX", NULL
, "Playback" },
993 static const struct snd_soc_component_driver vc4_hdmi_audio_component_drv
= {
994 .controls
= vc4_hdmi_audio_controls
,
995 .num_controls
= ARRAY_SIZE(vc4_hdmi_audio_controls
),
996 .dapm_widgets
= vc4_hdmi_audio_widgets
,
997 .num_dapm_widgets
= ARRAY_SIZE(vc4_hdmi_audio_widgets
),
998 .dapm_routes
= vc4_hdmi_audio_routes
,
999 .num_dapm_routes
= ARRAY_SIZE(vc4_hdmi_audio_routes
),
1001 .use_pmdown_time
= 1,
1003 .non_legacy_dai_naming
= 1,
1006 static const struct snd_soc_dai_ops vc4_hdmi_audio_dai_ops
= {
1007 .startup
= vc4_hdmi_audio_startup
,
1008 .shutdown
= vc4_hdmi_audio_shutdown
,
1009 .hw_params
= vc4_hdmi_audio_hw_params
,
1010 .set_fmt
= vc4_hdmi_audio_set_fmt
,
1011 .trigger
= vc4_hdmi_audio_trigger
,
1014 static struct snd_soc_dai_driver vc4_hdmi_audio_codec_dai_drv
= {
1015 .name
= "vc4-hdmi-hifi",
1017 .stream_name
= "Playback",
1020 .rates
= SNDRV_PCM_RATE_32000
| SNDRV_PCM_RATE_44100
|
1021 SNDRV_PCM_RATE_48000
| SNDRV_PCM_RATE_88200
|
1022 SNDRV_PCM_RATE_96000
| SNDRV_PCM_RATE_176400
|
1023 SNDRV_PCM_RATE_192000
,
1024 .formats
= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
,
1028 static const struct snd_soc_component_driver vc4_hdmi_audio_cpu_dai_comp
= {
1029 .name
= "vc4-hdmi-cpu-dai-component",
1032 static int vc4_hdmi_audio_cpu_dai_probe(struct snd_soc_dai
*dai
)
1034 struct vc4_hdmi
*hdmi
= dai_to_hdmi(dai
);
1036 snd_soc_dai_init_dma_data(dai
, &hdmi
->audio
.dma_data
, NULL
);
1041 static struct snd_soc_dai_driver vc4_hdmi_audio_cpu_dai_drv
= {
1042 .name
= "vc4-hdmi-cpu-dai",
1043 .probe
= vc4_hdmi_audio_cpu_dai_probe
,
1045 .stream_name
= "Playback",
1048 .rates
= SNDRV_PCM_RATE_32000
| SNDRV_PCM_RATE_44100
|
1049 SNDRV_PCM_RATE_48000
| SNDRV_PCM_RATE_88200
|
1050 SNDRV_PCM_RATE_96000
| SNDRV_PCM_RATE_176400
|
1051 SNDRV_PCM_RATE_192000
,
1052 .formats
= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
,
1054 .ops
= &vc4_hdmi_audio_dai_ops
,
1057 static const struct snd_dmaengine_pcm_config pcm_conf
= {
1058 .chan_names
[SNDRV_PCM_STREAM_PLAYBACK
] = "audio-rx",
1059 .prepare_slave_config
= snd_dmaengine_pcm_prepare_slave_config
,
1062 static int vc4_hdmi_audio_init(struct vc4_hdmi
*hdmi
)
1064 struct snd_soc_dai_link
*dai_link
= &hdmi
->audio
.link
;
1065 struct snd_soc_card
*card
= &hdmi
->audio
.card
;
1066 struct device
*dev
= &hdmi
->pdev
->dev
;
1070 if (!of_find_property(dev
->of_node
, "dmas", NULL
)) {
1072 "'dmas' DT property is missing, no HDMI audio\n");
1077 * Get the physical address of VC4_HD_MAI_DATA. We need to retrieve
1078 * the bus address specified in the DT, because the physical address
1079 * (the one returned by platform_get_resource()) is not appropriate
1080 * for DMA transfers.
1081 * This VC/MMU should probably be exposed to avoid this kind of hacks.
1083 addr
= of_get_address(dev
->of_node
, 1, NULL
, NULL
);
1084 hdmi
->audio
.dma_data
.addr
= be32_to_cpup(addr
) + VC4_HD_MAI_DATA
;
1085 hdmi
->audio
.dma_data
.addr_width
= DMA_SLAVE_BUSWIDTH_4_BYTES
;
1086 hdmi
->audio
.dma_data
.maxburst
= 2;
1088 ret
= devm_snd_dmaengine_pcm_register(dev
, &pcm_conf
, 0);
1090 dev_err(dev
, "Could not register PCM component: %d\n", ret
);
1094 ret
= devm_snd_soc_register_component(dev
, &vc4_hdmi_audio_cpu_dai_comp
,
1095 &vc4_hdmi_audio_cpu_dai_drv
, 1);
1097 dev_err(dev
, "Could not register CPU DAI: %d\n", ret
);
1101 /* register component and codec dai */
1102 ret
= devm_snd_soc_register_component(dev
, &vc4_hdmi_audio_component_drv
,
1103 &vc4_hdmi_audio_codec_dai_drv
, 1);
1105 dev_err(dev
, "Could not register component: %d\n", ret
);
1109 dai_link
->cpus
= &hdmi
->audio
.cpu
;
1110 dai_link
->codecs
= &hdmi
->audio
.codec
;
1111 dai_link
->platforms
= &hdmi
->audio
.platform
;
1113 dai_link
->num_cpus
= 1;
1114 dai_link
->num_codecs
= 1;
1115 dai_link
->num_platforms
= 1;
1117 dai_link
->name
= "MAI";
1118 dai_link
->stream_name
= "MAI PCM";
1119 dai_link
->codecs
->dai_name
= vc4_hdmi_audio_codec_dai_drv
.name
;
1120 dai_link
->cpus
->dai_name
= dev_name(dev
);
1121 dai_link
->codecs
->name
= dev_name(dev
);
1122 dai_link
->platforms
->name
= dev_name(dev
);
1124 card
->dai_link
= dai_link
;
1125 card
->num_links
= 1;
1126 card
->name
= "vc4-hdmi";
1128 card
->owner
= THIS_MODULE
;
1131 * Be careful, snd_soc_register_card() calls dev_set_drvdata() and
1132 * stores a pointer to the snd card object in dev->driver_data. This
1133 * means we cannot use it for something else. The hdmi back-pointer is
1134 * now stored in card->drvdata and should be retrieved with
1135 * snd_soc_card_get_drvdata() if needed.
1137 snd_soc_card_set_drvdata(card
, hdmi
);
1138 ret
= devm_snd_soc_register_card(dev
, card
);
1140 dev_err(dev
, "Could not register sound card: %d\n", ret
);
1146 #ifdef CONFIG_DRM_VC4_HDMI_CEC
1147 static irqreturn_t
vc4_cec_irq_handler_thread(int irq
, void *priv
)
1149 struct vc4_dev
*vc4
= priv
;
1150 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
1152 if (hdmi
->cec_irq_was_rx
) {
1153 if (hdmi
->cec_rx_msg
.len
)
1154 cec_received_msg(hdmi
->cec_adap
, &hdmi
->cec_rx_msg
);
1155 } else if (hdmi
->cec_tx_ok
) {
1156 cec_transmit_done(hdmi
->cec_adap
, CEC_TX_STATUS_OK
,
1160 * This CEC implementation makes 1 retry, so if we
1161 * get a NACK, then that means it made 2 attempts.
1163 cec_transmit_done(hdmi
->cec_adap
, CEC_TX_STATUS_NACK
,
1169 static void vc4_cec_read_msg(struct vc4_dev
*vc4
, u32 cntrl1
)
1171 struct cec_msg
*msg
= &vc4
->hdmi
->cec_rx_msg
;
1174 msg
->len
= 1 + ((cntrl1
& VC4_HDMI_CEC_REC_WRD_CNT_MASK
) >>
1175 VC4_HDMI_CEC_REC_WRD_CNT_SHIFT
);
1176 for (i
= 0; i
< msg
->len
; i
+= 4) {
1177 u32 val
= HDMI_READ(VC4_HDMI_CEC_RX_DATA_1
+ i
);
1179 msg
->msg
[i
] = val
& 0xff;
1180 msg
->msg
[i
+ 1] = (val
>> 8) & 0xff;
1181 msg
->msg
[i
+ 2] = (val
>> 16) & 0xff;
1182 msg
->msg
[i
+ 3] = (val
>> 24) & 0xff;
1186 static irqreturn_t
vc4_cec_irq_handler(int irq
, void *priv
)
1188 struct vc4_dev
*vc4
= priv
;
1189 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
1190 u32 stat
= HDMI_READ(VC4_HDMI_CPU_STATUS
);
1193 if (!(stat
& VC4_HDMI_CPU_CEC
))
1195 hdmi
->cec_rx_msg
.len
= 0;
1196 cntrl1
= HDMI_READ(VC4_HDMI_CEC_CNTRL_1
);
1197 cntrl5
= HDMI_READ(VC4_HDMI_CEC_CNTRL_5
);
1198 hdmi
->cec_irq_was_rx
= cntrl5
& VC4_HDMI_CEC_RX_CEC_INT
;
1199 if (hdmi
->cec_irq_was_rx
) {
1200 vc4_cec_read_msg(vc4
, cntrl1
);
1201 cntrl1
|= VC4_HDMI_CEC_CLEAR_RECEIVE_OFF
;
1202 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_1
, cntrl1
);
1203 cntrl1
&= ~VC4_HDMI_CEC_CLEAR_RECEIVE_OFF
;
1205 hdmi
->cec_tx_ok
= cntrl1
& VC4_HDMI_CEC_TX_STATUS_GOOD
;
1206 cntrl1
&= ~VC4_HDMI_CEC_START_XMIT_BEGIN
;
1208 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_1
, cntrl1
);
1209 HDMI_WRITE(VC4_HDMI_CPU_CLEAR
, VC4_HDMI_CPU_CEC
);
1211 return IRQ_WAKE_THREAD
;
1214 static int vc4_hdmi_cec_adap_enable(struct cec_adapter
*adap
, bool enable
)
1216 struct vc4_dev
*vc4
= cec_get_drvdata(adap
);
1217 /* clock period in microseconds */
1218 const u32 usecs
= 1000000 / CEC_CLOCK_FREQ
;
1219 u32 val
= HDMI_READ(VC4_HDMI_CEC_CNTRL_5
);
1221 val
&= ~(VC4_HDMI_CEC_TX_SW_RESET
| VC4_HDMI_CEC_RX_SW_RESET
|
1222 VC4_HDMI_CEC_CNT_TO_4700_US_MASK
|
1223 VC4_HDMI_CEC_CNT_TO_4500_US_MASK
);
1224 val
|= ((4700 / usecs
) << VC4_HDMI_CEC_CNT_TO_4700_US_SHIFT
) |
1225 ((4500 / usecs
) << VC4_HDMI_CEC_CNT_TO_4500_US_SHIFT
);
1228 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_5
, val
|
1229 VC4_HDMI_CEC_TX_SW_RESET
| VC4_HDMI_CEC_RX_SW_RESET
);
1230 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_5
, val
);
1231 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_2
,
1232 ((1500 / usecs
) << VC4_HDMI_CEC_CNT_TO_1500_US_SHIFT
) |
1233 ((1300 / usecs
) << VC4_HDMI_CEC_CNT_TO_1300_US_SHIFT
) |
1234 ((800 / usecs
) << VC4_HDMI_CEC_CNT_TO_800_US_SHIFT
) |
1235 ((600 / usecs
) << VC4_HDMI_CEC_CNT_TO_600_US_SHIFT
) |
1236 ((400 / usecs
) << VC4_HDMI_CEC_CNT_TO_400_US_SHIFT
));
1237 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_3
,
1238 ((2750 / usecs
) << VC4_HDMI_CEC_CNT_TO_2750_US_SHIFT
) |
1239 ((2400 / usecs
) << VC4_HDMI_CEC_CNT_TO_2400_US_SHIFT
) |
1240 ((2050 / usecs
) << VC4_HDMI_CEC_CNT_TO_2050_US_SHIFT
) |
1241 ((1700 / usecs
) << VC4_HDMI_CEC_CNT_TO_1700_US_SHIFT
));
1242 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_4
,
1243 ((4300 / usecs
) << VC4_HDMI_CEC_CNT_TO_4300_US_SHIFT
) |
1244 ((3900 / usecs
) << VC4_HDMI_CEC_CNT_TO_3900_US_SHIFT
) |
1245 ((3600 / usecs
) << VC4_HDMI_CEC_CNT_TO_3600_US_SHIFT
) |
1246 ((3500 / usecs
) << VC4_HDMI_CEC_CNT_TO_3500_US_SHIFT
));
1248 HDMI_WRITE(VC4_HDMI_CPU_MASK_CLEAR
, VC4_HDMI_CPU_CEC
);
1250 HDMI_WRITE(VC4_HDMI_CPU_MASK_SET
, VC4_HDMI_CPU_CEC
);
1251 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_5
, val
|
1252 VC4_HDMI_CEC_TX_SW_RESET
| VC4_HDMI_CEC_RX_SW_RESET
);
1257 static int vc4_hdmi_cec_adap_log_addr(struct cec_adapter
*adap
, u8 log_addr
)
1259 struct vc4_dev
*vc4
= cec_get_drvdata(adap
);
1261 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_1
,
1262 (HDMI_READ(VC4_HDMI_CEC_CNTRL_1
) & ~VC4_HDMI_CEC_ADDR_MASK
) |
1263 (log_addr
& 0xf) << VC4_HDMI_CEC_ADDR_SHIFT
);
1267 static int vc4_hdmi_cec_adap_transmit(struct cec_adapter
*adap
, u8 attempts
,
1268 u32 signal_free_time
, struct cec_msg
*msg
)
1270 struct vc4_dev
*vc4
= cec_get_drvdata(adap
);
1274 for (i
= 0; i
< msg
->len
; i
+= 4)
1275 HDMI_WRITE(VC4_HDMI_CEC_TX_DATA_1
+ i
,
1277 (msg
->msg
[i
+ 1] << 8) |
1278 (msg
->msg
[i
+ 2] << 16) |
1279 (msg
->msg
[i
+ 3] << 24));
1281 val
= HDMI_READ(VC4_HDMI_CEC_CNTRL_1
);
1282 val
&= ~VC4_HDMI_CEC_START_XMIT_BEGIN
;
1283 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_1
, val
);
1284 val
&= ~VC4_HDMI_CEC_MESSAGE_LENGTH_MASK
;
1285 val
|= (msg
->len
- 1) << VC4_HDMI_CEC_MESSAGE_LENGTH_SHIFT
;
1286 val
|= VC4_HDMI_CEC_START_XMIT_BEGIN
;
1288 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_1
, val
);
1292 static const struct cec_adap_ops vc4_hdmi_cec_adap_ops
= {
1293 .adap_enable
= vc4_hdmi_cec_adap_enable
,
1294 .adap_log_addr
= vc4_hdmi_cec_adap_log_addr
,
1295 .adap_transmit
= vc4_hdmi_cec_adap_transmit
,
1299 static int vc4_hdmi_bind(struct device
*dev
, struct device
*master
, void *data
)
1301 #ifdef CONFIG_DRM_VC4_HDMI_CEC
1302 struct cec_connector_info conn_info
;
1304 struct platform_device
*pdev
= to_platform_device(dev
);
1305 struct drm_device
*drm
= dev_get_drvdata(master
);
1306 struct vc4_dev
*vc4
= drm
->dev_private
;
1307 struct vc4_hdmi
*hdmi
;
1308 struct vc4_hdmi_encoder
*vc4_hdmi_encoder
;
1309 struct device_node
*ddc_node
;
1313 hdmi
= devm_kzalloc(dev
, sizeof(*hdmi
), GFP_KERNEL
);
1317 vc4_hdmi_encoder
= devm_kzalloc(dev
, sizeof(*vc4_hdmi_encoder
),
1319 if (!vc4_hdmi_encoder
)
1321 vc4_hdmi_encoder
->base
.type
= VC4_ENCODER_TYPE_HDMI
;
1322 hdmi
->encoder
= &vc4_hdmi_encoder
->base
.base
;
1325 hdmi
->hdmicore_regs
= vc4_ioremap_regs(pdev
, 0);
1326 if (IS_ERR(hdmi
->hdmicore_regs
))
1327 return PTR_ERR(hdmi
->hdmicore_regs
);
1329 hdmi
->hd_regs
= vc4_ioremap_regs(pdev
, 1);
1330 if (IS_ERR(hdmi
->hd_regs
))
1331 return PTR_ERR(hdmi
->hd_regs
);
1333 hdmi
->hdmi_regset
.base
= hdmi
->hdmicore_regs
;
1334 hdmi
->hdmi_regset
.regs
= hdmi_regs
;
1335 hdmi
->hdmi_regset
.nregs
= ARRAY_SIZE(hdmi_regs
);
1336 hdmi
->hd_regset
.base
= hdmi
->hd_regs
;
1337 hdmi
->hd_regset
.regs
= hd_regs
;
1338 hdmi
->hd_regset
.nregs
= ARRAY_SIZE(hd_regs
);
1340 hdmi
->pixel_clock
= devm_clk_get(dev
, "pixel");
1341 if (IS_ERR(hdmi
->pixel_clock
)) {
1342 DRM_ERROR("Failed to get pixel clock\n");
1343 return PTR_ERR(hdmi
->pixel_clock
);
1345 hdmi
->hsm_clock
= devm_clk_get(dev
, "hdmi");
1346 if (IS_ERR(hdmi
->hsm_clock
)) {
1347 DRM_ERROR("Failed to get HDMI state machine clock\n");
1348 return PTR_ERR(hdmi
->hsm_clock
);
1351 ddc_node
= of_parse_phandle(dev
->of_node
, "ddc", 0);
1353 DRM_ERROR("Failed to find ddc node in device tree\n");
1357 hdmi
->ddc
= of_find_i2c_adapter_by_node(ddc_node
);
1358 of_node_put(ddc_node
);
1360 DRM_DEBUG("Failed to get ddc i2c adapter by node\n");
1361 return -EPROBE_DEFER
;
1364 /* This is the rate that is set by the firmware. The number
1365 * needs to be a bit higher than the pixel clock rate
1366 * (generally 148.5Mhz).
1368 ret
= clk_set_rate(hdmi
->hsm_clock
, HSM_CLOCK_FREQ
);
1370 DRM_ERROR("Failed to set HSM clock rate: %d\n", ret
);
1374 ret
= clk_prepare_enable(hdmi
->hsm_clock
);
1376 DRM_ERROR("Failed to turn on HDMI state machine clock: %d\n",
1381 /* Only use the GPIO HPD pin if present in the DT, otherwise
1382 * we'll use the HDMI core's register.
1384 if (of_find_property(dev
->of_node
, "hpd-gpios", &value
)) {
1385 enum of_gpio_flags hpd_gpio_flags
;
1387 hdmi
->hpd_gpio
= of_get_named_gpio_flags(dev
->of_node
,
1390 if (hdmi
->hpd_gpio
< 0) {
1391 ret
= hdmi
->hpd_gpio
;
1392 goto err_unprepare_hsm
;
1395 hdmi
->hpd_active_low
= hpd_gpio_flags
& OF_GPIO_ACTIVE_LOW
;
1400 /* HDMI core must be enabled. */
1401 if (!(HD_READ(VC4_HD_M_CTL
) & VC4_HD_M_ENABLE
)) {
1402 HD_WRITE(VC4_HD_M_CTL
, VC4_HD_M_SW_RST
);
1404 HD_WRITE(VC4_HD_M_CTL
, 0);
1406 HD_WRITE(VC4_HD_M_CTL
, VC4_HD_M_ENABLE
);
1408 pm_runtime_enable(dev
);
1410 drm_encoder_init(drm
, hdmi
->encoder
, &vc4_hdmi_encoder_funcs
,
1411 DRM_MODE_ENCODER_TMDS
, NULL
);
1412 drm_encoder_helper_add(hdmi
->encoder
, &vc4_hdmi_encoder_helper_funcs
);
1414 hdmi
->connector
= vc4_hdmi_connector_init(drm
, hdmi
->encoder
);
1415 if (IS_ERR(hdmi
->connector
)) {
1416 ret
= PTR_ERR(hdmi
->connector
);
1417 goto err_destroy_encoder
;
1419 #ifdef CONFIG_DRM_VC4_HDMI_CEC
1420 hdmi
->cec_adap
= cec_allocate_adapter(&vc4_hdmi_cec_adap_ops
,
1423 CEC_CAP_CONNECTOR_INFO
, 1);
1424 ret
= PTR_ERR_OR_ZERO(hdmi
->cec_adap
);
1426 goto err_destroy_conn
;
1428 cec_fill_conn_info_from_drm(&conn_info
, hdmi
->connector
);
1429 cec_s_conn_info(hdmi
->cec_adap
, &conn_info
);
1431 HDMI_WRITE(VC4_HDMI_CPU_MASK_SET
, 0xffffffff);
1432 value
= HDMI_READ(VC4_HDMI_CEC_CNTRL_1
);
1433 value
&= ~VC4_HDMI_CEC_DIV_CLK_CNT_MASK
;
1435 * Set the logical address to Unregistered and set the clock
1436 * divider: the hsm_clock rate and this divider setting will
1437 * give a 40 kHz CEC clock.
1439 value
|= VC4_HDMI_CEC_ADDR_MASK
|
1440 (4091 << VC4_HDMI_CEC_DIV_CLK_CNT_SHIFT
);
1441 HDMI_WRITE(VC4_HDMI_CEC_CNTRL_1
, value
);
1442 ret
= devm_request_threaded_irq(dev
, platform_get_irq(pdev
, 0),
1443 vc4_cec_irq_handler
,
1444 vc4_cec_irq_handler_thread
, 0,
1445 "vc4 hdmi cec", vc4
);
1447 goto err_delete_cec_adap
;
1448 ret
= cec_register_adapter(hdmi
->cec_adap
, dev
);
1450 goto err_delete_cec_adap
;
1453 ret
= vc4_hdmi_audio_init(hdmi
);
1455 goto err_destroy_encoder
;
1457 vc4_debugfs_add_file(drm
, "hdmi_regs", vc4_hdmi_debugfs_regs
, hdmi
);
1461 #ifdef CONFIG_DRM_VC4_HDMI_CEC
1462 err_delete_cec_adap
:
1463 cec_delete_adapter(hdmi
->cec_adap
);
1465 vc4_hdmi_connector_destroy(hdmi
->connector
);
1467 err_destroy_encoder
:
1468 vc4_hdmi_encoder_destroy(hdmi
->encoder
);
1470 clk_disable_unprepare(hdmi
->hsm_clock
);
1471 pm_runtime_disable(dev
);
1473 put_device(&hdmi
->ddc
->dev
);
1478 static void vc4_hdmi_unbind(struct device
*dev
, struct device
*master
,
1481 struct drm_device
*drm
= dev_get_drvdata(master
);
1482 struct vc4_dev
*vc4
= drm
->dev_private
;
1483 struct vc4_hdmi
*hdmi
= vc4
->hdmi
;
1485 cec_unregister_adapter(hdmi
->cec_adap
);
1486 vc4_hdmi_connector_destroy(hdmi
->connector
);
1487 vc4_hdmi_encoder_destroy(hdmi
->encoder
);
1489 clk_disable_unprepare(hdmi
->hsm_clock
);
1490 pm_runtime_disable(dev
);
1492 put_device(&hdmi
->ddc
->dev
);
1497 static const struct component_ops vc4_hdmi_ops
= {
1498 .bind
= vc4_hdmi_bind
,
1499 .unbind
= vc4_hdmi_unbind
,
1502 static int vc4_hdmi_dev_probe(struct platform_device
*pdev
)
1504 return component_add(&pdev
->dev
, &vc4_hdmi_ops
);
1507 static int vc4_hdmi_dev_remove(struct platform_device
*pdev
)
1509 component_del(&pdev
->dev
, &vc4_hdmi_ops
);
1513 static const struct of_device_id vc4_hdmi_dt_match
[] = {
1514 { .compatible
= "brcm,bcm2835-hdmi" },
1518 struct platform_driver vc4_hdmi_driver
= {
1519 .probe
= vc4_hdmi_dev_probe
,
1520 .remove
= vc4_hdmi_dev_remove
,
1523 .of_match_table
= vc4_hdmi_dt_match
,