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 "outp.h"
25#include "ior.h"
26
27#include <subdev/bios.h>
28#include <subdev/bios/dcb.h>
29#include <subdev/i2c.h>
30
31void
32nvkm_outp_route(struct nvkm_disp *disp)
33{
34 struct nvkm_outp *outp;
35 struct nvkm_ior *ior;
36
37 list_for_each_entry(ior, &disp->ior, head) {
38 if ((outp = ior->arm.outp) && ior->arm.outp != ior->asy.outp) {
39 OUTP_DBG(outp, "release %s", ior->name);
40 if (ior->func->route.set)
41 ior->func->route.set(outp, NULL);
42 ior->arm.outp = NULL;
43 }
44 }
45
46 list_for_each_entry(ior, &disp->ior, head) {
47 if ((outp = ior->asy.outp)) {
48 OUTP_DBG(outp, "acquire %s", ior->name);
49 if (ior->asy.outp != ior->arm.outp) {
50 if (ior->func->route.set)
51 ior->func->route.set(outp, ior);
52 ior->arm.outp = ior->asy.outp;
53 }
54 }
55 }
56}
57
58static enum nvkm_ior_proto
59nvkm_outp_xlat(struct nvkm_outp *outp, enum nvkm_ior_type *type)
60{
61 switch (outp->info.location) {
62 case 0:
63 switch (outp->info.type) {
64 case DCB_OUTPUT_ANALOG: *type = DAC; return CRT;
65 case DCB_OUTPUT_TV : *type = DAC; return TV;
66 case DCB_OUTPUT_TMDS : *type = SOR; return TMDS;
67 case DCB_OUTPUT_LVDS : *type = SOR; return LVDS;
68 case DCB_OUTPUT_DP : *type = SOR; return DP;
69 default:
70 break;
71 }
72 break;
73 case 1:
74 switch (outp->info.type) {
75 case DCB_OUTPUT_TMDS: *type = PIOR; return TMDS;
76 case DCB_OUTPUT_DP : *type = PIOR; return TMDS;
77 default:
78 break;
79 }
80 break;
81 default:
82 break;
83 }
84 WARN_ON(1);
85 return UNKNOWN;
86}
87
88void
89nvkm_outp_release(struct nvkm_outp *outp, u8 user)
90{
91 struct nvkm_ior *ior = outp->ior;
92 OUTP_TRACE(outp, "release %02x &= %02x %p", outp->acquired, ~user, ior);
93 if (ior) {
94 outp->acquired &= ~user;
95 if (!outp->acquired) {
96 if (outp->func->release && outp->ior)
97 outp->func->release(outp);
98 outp->ior->asy.outp = NULL;
99 outp->ior = NULL;
100 }
101 }
102}
103
104static inline int
105nvkm_outp_acquire_ior(struct nvkm_outp *outp, u8 user, struct nvkm_ior *ior)
106{
107 outp->ior = ior;
108 outp->ior->asy.outp = outp;
109 outp->ior->asy.link = outp->info.sorconf.link;
110 outp->acquired |= user;
111 return 0;
112}
113
114int
115nvkm_outp_acquire(struct nvkm_outp *outp, u8 user)
116{
117 struct nvkm_ior *ior = outp->ior;
118 enum nvkm_ior_proto proto;
119 enum nvkm_ior_type type;
120
121 OUTP_TRACE(outp, "acquire %02x |= %02x %p", outp->acquired, user, ior);
122 if (ior) {
123 outp->acquired |= user;
124 return 0;
125 }
126
127
128 proto = nvkm_outp_xlat(outp, &type);
129 if (proto == UNKNOWN)
130 return -ENOSYS;
131
132
133 if (outp->identity) {
134 ior = nvkm_ior_find(outp->disp, SOR, ffs(outp->info.or) - 1);
135 if (WARN_ON(!ior))
136 return -ENOSPC;
137 return nvkm_outp_acquire_ior(outp, user, ior);
138 }
139
140
141
142
143 list_for_each_entry(ior, &outp->disp->ior, head) {
144 if (!ior->identity && !ior->asy.outp && ior->arm.outp == outp)
145 return nvkm_outp_acquire_ior(outp, user, ior);
146 }
147
148
149 list_for_each_entry(ior, &outp->disp->ior, head) {
150 if (!ior->identity &&
151 !ior->asy.outp && ior->type == type && !ior->arm.outp &&
152 (ior->func->route.set || ior->id == __ffs(outp->info.or)))
153 return nvkm_outp_acquire_ior(outp, user, ior);
154 }
155
156
157
158
159 list_for_each_entry(ior, &outp->disp->ior, head) {
160 if (!ior->identity && !ior->asy.outp && ior->type == type &&
161 (ior->func->route.set || ior->id == __ffs(outp->info.or)))
162 return nvkm_outp_acquire_ior(outp, user, ior);
163 }
164
165 return -ENOSPC;
166}
167
168void
169nvkm_outp_fini(struct nvkm_outp *outp)
170{
171 if (outp->func->fini)
172 outp->func->fini(outp);
173}
174
175static void
176nvkm_outp_init_route(struct nvkm_outp *outp)
177{
178 struct nvkm_disp *disp = outp->disp;
179 enum nvkm_ior_proto proto;
180 enum nvkm_ior_type type;
181 struct nvkm_ior *ior;
182 int id, link;
183
184
185 proto = nvkm_outp_xlat(outp, &type);
186 if (proto == UNKNOWN)
187 return;
188
189 ior = nvkm_ior_find(disp, type, -1);
190 if (!ior) {
191 WARN_ON(1);
192 return;
193 }
194
195
196 if (ior->func->route.get) {
197 id = ior->func->route.get(outp, &link);
198 if (id < 0) {
199 OUTP_DBG(outp, "no route");
200 return;
201 }
202 } else {
203
204 id = ffs(outp->info.or) - 1;
205 link = (ior->type == SOR) ? outp->info.sorconf.link : 0;
206 }
207
208 ior = nvkm_ior_find(disp, type, id);
209 if (!ior) {
210 WARN_ON(1);
211 return;
212 }
213
214
215 ior->func->state(ior, &ior->arm);
216 if (!ior->arm.head || ior->arm.proto != proto) {
217 OUTP_DBG(outp, "no heads (%x %d %d)", ior->arm.head,
218 ior->arm.proto, proto);
219 return;
220 }
221
222 OUTP_DBG(outp, "on %s link %x", ior->name, ior->arm.link);
223 ior->arm.outp = outp;
224}
225
226void
227nvkm_outp_init(struct nvkm_outp *outp)
228{
229 nvkm_outp_init_route(outp);
230 if (outp->func->init)
231 outp->func->init(outp);
232}
233
234void
235nvkm_outp_del(struct nvkm_outp **poutp)
236{
237 struct nvkm_outp *outp = *poutp;
238 if (outp && !WARN_ON(!outp->func)) {
239 if (outp->func->dtor)
240 *poutp = outp->func->dtor(outp);
241 kfree(*poutp);
242 *poutp = NULL;
243 }
244}
245
246int
247nvkm_outp_ctor(const struct nvkm_outp_func *func, struct nvkm_disp *disp,
248 int index, struct dcb_output *dcbE, struct nvkm_outp *outp)
249{
250 struct nvkm_i2c *i2c = disp->engine.subdev.device->i2c;
251 enum nvkm_ior_proto proto;
252 enum nvkm_ior_type type;
253
254 outp->func = func;
255 outp->disp = disp;
256 outp->index = index;
257 outp->info = *dcbE;
258 outp->i2c = nvkm_i2c_bus_find(i2c, dcbE->i2c_index);
259
260 OUTP_DBG(outp, "type %02x loc %d or %d link %d con %x "
261 "edid %x bus %d head %x",
262 outp->info.type, outp->info.location, outp->info.or,
263 outp->info.type >= 2 ? outp->info.sorconf.link : 0,
264 outp->info.connector, outp->info.i2c_index,
265 outp->info.bus, outp->info.heads);
266
267
268 proto = nvkm_outp_xlat(outp, &type);
269 if (proto == UNKNOWN)
270 return -ENODEV;
271
272 return 0;
273}
274
275static const struct nvkm_outp_func
276nvkm_outp = {
277};
278
279int
280nvkm_outp_new(struct nvkm_disp *disp, int index, struct dcb_output *dcbE,
281 struct nvkm_outp **poutp)
282{
283 if (!(*poutp = kzalloc(sizeof(**poutp), GFP_KERNEL)))
284 return -ENOMEM;
285 return nvkm_outp_ctor(&nvkm_outp, disp, index, dcbE, *poutp);
286}
287