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 "nv50.h"
25
26#include <core/client.h>
27
28#include <nvif/cl5070.h>
29#include <nvif/unpack.h>
30
31int
32gk104_hdmi_ctrl(NV50_DISP_MTHD_V1)
33{
34 struct nvkm_device *device = disp->base.engine.subdev.device;
35 const u32 hoff = (head * 0x800);
36 const u32 hdmi = (head * 0x400);
37 union {
38 struct nv50_disp_sor_hdmi_pwr_v0 v0;
39 } *args = data;
40 u32 ctrl;
41 int ret = -ENOSYS;
42
43 nvif_ioctl(object, "disp sor hdmi ctrl size %d\n", size);
44 if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) {
45 nvif_ioctl(object, "disp sor hdmi ctrl vers %d state %d "
46 "max_ac_packet %d rekey %d\n",
47 args->v0.version, args->v0.state,
48 args->v0.max_ac_packet, args->v0.rekey);
49 if (args->v0.max_ac_packet > 0x1f || args->v0.rekey > 0x7f)
50 return -EINVAL;
51 ctrl = 0x40000000 * !!args->v0.state;
52 ctrl |= args->v0.max_ac_packet << 16;
53 ctrl |= args->v0.rekey;
54 } else
55 return ret;
56
57 if (!(ctrl & 0x40000000)) {
58 nvkm_mask(device, 0x616798 + hoff, 0x40000000, 0x00000000);
59 nvkm_mask(device, 0x6900c0 + hdmi, 0x00000001, 0x00000000);
60 nvkm_mask(device, 0x690000 + hdmi, 0x00000001, 0x00000000);
61 return 0;
62 }
63
64
65 nvkm_mask(device, 0x690000 + hdmi, 0x00000001, 0x00000000);
66 nvkm_wr32(device, 0x690008 + hdmi, 0x000d0282);
67 nvkm_wr32(device, 0x69000c + hdmi, 0x0000006f);
68 nvkm_wr32(device, 0x690010 + hdmi, 0x00000000);
69 nvkm_wr32(device, 0x690014 + hdmi, 0x00000000);
70 nvkm_wr32(device, 0x690018 + hdmi, 0x00000000);
71 nvkm_mask(device, 0x690000 + hdmi, 0x00000001, 0x00000001);
72
73
74 nvkm_mask(device, 0x6900c0 + hdmi, 0x00000001, 0x00000000);
75 nvkm_wr32(device, 0x6900cc + hdmi, 0x00000010);
76 nvkm_mask(device, 0x6900c0 + hdmi, 0x00000001, 0x00000001);
77
78
79 nvkm_wr32(device, 0x690080 + hdmi, 0x82000000);
80
81
82 nvkm_mask(device, 0x616798 + hoff, 0x401f007f, ctrl);
83 return 0;
84}
85