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 "ior.h"
25#include "head.h"
26
27#include <subdev/i2c.h>
28#include <subdev/timer.h>
29
30static void
31nv50_pior_clock(struct nvkm_ior *pior)
32{
33 struct nvkm_device *device = pior->disp->engine.subdev.device;
34 const u32 poff = nv50_ior_base(pior);
35 nvkm_mask(device, 0x614380 + poff, 0x00000707, 0x00000001);
36}
37
38static int
39nv50_pior_dp_links(struct nvkm_ior *pior, struct nvkm_i2c_aux *aux)
40{
41 int ret = nvkm_i2c_aux_lnk_ctl(aux, pior->dp.nr, pior->dp.bw,
42 pior->dp.ef);
43 if (ret)
44 return ret;
45 return 1;
46}
47
48static void
49nv50_pior_power_wait(struct nvkm_device *device, u32 poff)
50{
51 nvkm_msec(device, 2000,
52 if (!(nvkm_rd32(device, 0x61e004 + poff) & 0x80000000))
53 break;
54 );
55}
56
57static void
58nv50_pior_power(struct nvkm_ior *pior, bool normal, bool pu,
59 bool data, bool vsync, bool hsync)
60{
61 struct nvkm_device *device = pior->disp->engine.subdev.device;
62 const u32 poff = nv50_ior_base(pior);
63 const u32 shift = normal ? 0 : 16;
64 const u32 state = 0x80000000 | (0x00000001 * !!pu) << shift;
65 const u32 field = 0x80000000 | (0x00000101 << shift);
66
67 nv50_pior_power_wait(device, poff);
68 nvkm_mask(device, 0x61e004 + poff, field, state);
69 nv50_pior_power_wait(device, poff);
70}
71
72void
73nv50_pior_depth(struct nvkm_ior *ior, struct nvkm_ior_state *state, u32 ctrl)
74{
75
76
77
78 if (state->head && state == &ior->asy) {
79 struct nvkm_head *head =
80 nvkm_head_find(ior->disp, __ffs(state->head));
81 if (!WARN_ON(!head)) {
82 struct nvkm_head_state *state = &head->asy;
83 switch ((ctrl & 0x000f0000) >> 16) {
84 case 6: state->or.depth = 30; break;
85 case 5: state->or.depth = 24; break;
86 case 2: state->or.depth = 18; break;
87 case 0: state->or.depth = 18; break;
88 default:
89 state->or.depth = 18;
90 WARN_ON(1);
91 break;
92 }
93 }
94 }
95}
96
97static void
98nv50_pior_state(struct nvkm_ior *pior, struct nvkm_ior_state *state)
99{
100 struct nvkm_device *device = pior->disp->engine.subdev.device;
101 const u32 coff = pior->id * 8 + (state == &pior->arm) * 4;
102 u32 ctrl = nvkm_rd32(device, 0x610b80 + coff);
103
104 state->proto_evo = (ctrl & 0x00000f00) >> 8;
105 state->rgdiv = 1;
106 switch (state->proto_evo) {
107 case 0: state->proto = TMDS; break;
108 default:
109 state->proto = UNKNOWN;
110 break;
111 }
112
113 state->head = ctrl & 0x00000003;
114 nv50_pior_depth(pior, state, ctrl);
115}
116
117static const struct nvkm_ior_func
118nv50_pior = {
119 .state = nv50_pior_state,
120 .power = nv50_pior_power,
121 .clock = nv50_pior_clock,
122 .dp = {
123 .links = nv50_pior_dp_links,
124 },
125};
126
127int
128nv50_pior_new(struct nvkm_disp *disp, int id)
129{
130 return nvkm_ior_new_(&nv50_pior, disp, PIOR, id);
131}
132
133int
134nv50_pior_cnt(struct nvkm_disp *disp, unsigned long *pmask)
135{
136 struct nvkm_device *device = disp->engine.subdev.device;
137 *pmask = (nvkm_rd32(device, 0x610184) & 0x70000000) >> 28;
138 return 3;
139}
140