1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include "hdmi.h"
25
26void
27gk104_hdmi_ctrl(struct nvkm_ior *ior, int head, bool enable, u8 max_ac_packet,
28 u8 rekey, u8 *avi, u8 avi_size, u8 *vendor, u8 vendor_size)
29{
30 struct nvkm_device *device = ior->disp->engine.subdev.device;
31 const u32 ctrl = 0x40000000 * enable |
32 max_ac_packet << 16 |
33 rekey;
34 const u32 hoff = head * 0x800;
35 const u32 hdmi = head * 0x400;
36 struct packed_hdmi_infoframe avi_infoframe;
37 struct packed_hdmi_infoframe vendor_infoframe;
38
39 pack_hdmi_infoframe(&avi_infoframe, avi, avi_size);
40 pack_hdmi_infoframe(&vendor_infoframe, vendor, vendor_size);
41
42 if (!(ctrl & 0x40000000)) {
43 nvkm_mask(device, 0x616798 + hoff, 0x40000000, 0x00000000);
44 nvkm_mask(device, 0x690100 + hdmi, 0x00000001, 0x00000000);
45 nvkm_mask(device, 0x6900c0 + hdmi, 0x00000001, 0x00000000);
46 nvkm_mask(device, 0x690000 + hdmi, 0x00000001, 0x00000000);
47 return;
48 }
49
50
51 nvkm_mask(device, 0x690000 + hdmi, 0x00000001, 0x00000000);
52 if (avi_size) {
53 nvkm_wr32(device, 0x690008 + hdmi, avi_infoframe.header);
54 nvkm_wr32(device, 0x69000c + hdmi, avi_infoframe.subpack0_low);
55 nvkm_wr32(device, 0x690010 + hdmi, avi_infoframe.subpack0_high);
56 nvkm_wr32(device, 0x690014 + hdmi, avi_infoframe.subpack1_low);
57 nvkm_wr32(device, 0x690018 + hdmi, avi_infoframe.subpack1_high);
58 nvkm_mask(device, 0x690000 + hdmi, 0x00000001, 0x00000001);
59 }
60
61
62 nvkm_mask(device, 0x690100 + hdmi, 0x00010001, 0x00000000);
63 if (vendor_size) {
64 nvkm_wr32(device, 0x690108 + hdmi, vendor_infoframe.header);
65 nvkm_wr32(device, 0x69010c + hdmi, vendor_infoframe.subpack0_low);
66 nvkm_wr32(device, 0x690110 + hdmi, vendor_infoframe.subpack0_high);
67
68 nvkm_mask(device, 0x690100 + hdmi, 0x00000001, 0x00000001);
69 }
70
71
72
73 nvkm_mask(device, 0x6900c0 + hdmi, 0x00000001, 0x00000000);
74 nvkm_wr32(device, 0x6900cc + hdmi, 0x00000010);
75 nvkm_mask(device, 0x6900c0 + hdmi, 0x00000001, 0x00000001);
76
77
78 nvkm_wr32(device, 0x690080 + hdmi, 0x82000000);
79
80
81 nvkm_mask(device, 0x616798 + hoff, 0x401f007f, ctrl);
82}
83