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#include "outp.h"
26
27#include <core/client.h>
28#include <subdev/timer.h>
29
30#include <nvif/class.h>
31#include <nvif/unpack.h>
32
33int
34nv50_dac_power(NV50_DISP_MTHD_V1)
35{
36 struct nvkm_device *device = disp->base.engine.subdev.device;
37 const u32 doff = outp->or * 0x800;
38 union {
39 struct nv50_disp_dac_pwr_v0 v0;
40 } *args = data;
41 u32 stat;
42 int ret;
43
44 nvif_ioctl(object, "disp dac pwr size %d\n", size);
45 if (nvif_unpack(args->v0, 0, 0, false)) {
46 nvif_ioctl(object, "disp dac pwr vers %d state %d data %d "
47 "vsync %d hsync %d\n",
48 args->v0.version, args->v0.state, args->v0.data,
49 args->v0.vsync, args->v0.hsync);
50 stat = 0x00000040 * !args->v0.state;
51 stat |= 0x00000010 * !args->v0.data;
52 stat |= 0x00000004 * !args->v0.vsync;
53 stat |= 0x00000001 * !args->v0.hsync;
54 } else
55 return ret;
56
57 nvkm_msec(device, 2000,
58 if (!(nvkm_rd32(device, 0x61a004 + doff) & 0x80000000))
59 break;
60 );
61 nvkm_mask(device, 0x61a004 + doff, 0xc000007f, 0x80000000 | stat);
62 nvkm_msec(device, 2000,
63 if (!(nvkm_rd32(device, 0x61a004 + doff) & 0x80000000))
64 break;
65 );
66 return 0;
67}
68
69int
70nv50_dac_sense(NV50_DISP_MTHD_V1)
71{
72 struct nvkm_subdev *subdev = &disp->base.engine.subdev;
73 struct nvkm_device *device = subdev->device;
74 union {
75 struct nv50_disp_dac_load_v0 v0;
76 } *args = data;
77 const u32 doff = outp->or * 0x800;
78 u32 loadval;
79 int ret;
80
81 nvif_ioctl(object, "disp dac load size %d\n", size);
82 if (nvif_unpack(args->v0, 0, 0, false)) {
83 nvif_ioctl(object, "disp dac load vers %d data %08x\n",
84 args->v0.version, args->v0.data);
85 if (args->v0.data & 0xfff00000)
86 return -EINVAL;
87 loadval = args->v0.data;
88 } else
89 return ret;
90
91 nvkm_mask(device, 0x61a004 + doff, 0x807f0000, 0x80150000);
92 nvkm_msec(device, 2000,
93 if (!(nvkm_rd32(device, 0x61a004 + doff) & 0x80000000))
94 break;
95 );
96
97 nvkm_wr32(device, 0x61a00c + doff, 0x00100000 | loadval);
98 mdelay(9);
99 udelay(500);
100 loadval = nvkm_mask(device, 0x61a00c + doff, 0xffffffff, 0x00000000);
101
102 nvkm_mask(device, 0x61a004 + doff, 0x807f0000, 0x80550000);
103 nvkm_msec(device, 2000,
104 if (!(nvkm_rd32(device, 0x61a004 + doff) & 0x80000000))
105 break;
106 );
107
108 nvkm_debug(subdev, "DAC%d sense: %08x\n", outp->or, loadval);
109 if (!(loadval & 0x80000000))
110 return -ETIMEDOUT;
111
112 args->v0.load = (loadval & 0x38000000) >> 27;
113 return 0;
114}
115
116static const struct nvkm_output_func
117nv50_dac_output_func = {
118};
119
120int
121nv50_dac_output_new(struct nvkm_disp *disp, int index,
122 struct dcb_output *dcbE, struct nvkm_output **poutp)
123{
124 return nvkm_output_new_(&nv50_dac_output_func, disp,
125 index, dcbE, poutp);
126}
127