1 | /* Copyright 2021 Advanced Micro Devices, Inc. All rights reserved. |
2 | * |
3 | * Permission is hereby granted, free of charge, to any person obtaining a |
4 | * copy of this software and associated documentation files (the "Software"), |
5 | * to deal in the Software without restriction, including without limitation |
6 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
7 | * and/or sell copies of the Software, and to permit persons to whom the |
8 | * Software is furnished to do so, subject to the following conditions: |
9 | * |
10 | * The above copyright notice and this permission notice shall be included in |
11 | * all copies or substantial portions of the Software. |
12 | * |
13 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
14 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
15 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
16 | * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR |
17 | * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
18 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
19 | * OTHER DEALINGS IN THE SOFTWARE. |
20 | * |
21 | * Authors: AMD |
22 | * |
23 | */ |
24 | |
25 | #include "link_enc_cfg.h" |
26 | #include "resource.h" |
27 | #include "link.h" |
28 | |
29 | #define DC_LOGGER dc->ctx->logger |
30 | |
31 | /* Check whether stream is supported by DIG link encoders. */ |
32 | static bool is_dig_link_enc_stream(struct dc_stream_state *stream) |
33 | { |
34 | bool is_dig_stream = false; |
35 | struct link_encoder *link_enc = NULL; |
36 | int i; |
37 | |
38 | /* Loop over created link encoder objects. */ |
39 | if (stream) { |
40 | for (i = 0; i < stream->ctx->dc->res_pool->res_cap->num_dig_link_enc; i++) { |
41 | link_enc = stream->ctx->dc->res_pool->link_encoders[i]; |
42 | |
43 | /* Need to check link signal type rather than stream signal type which may not |
44 | * yet match. |
45 | */ |
46 | if (link_enc && ((uint32_t)stream->link->connector_signal & link_enc->output_signals)) { |
47 | if (dc_is_dp_signal(signal: stream->signal)) { |
48 | /* DIGs do not support DP2.0 streams with 128b/132b encoding. */ |
49 | struct dc_link_settings link_settings = {0}; |
50 | |
51 | stream->ctx->dc->link_srv->dp_decide_link_settings(stream, &link_settings); |
52 | if ((link_settings.link_rate >= LINK_RATE_LOW) && |
53 | link_settings.link_rate <= LINK_RATE_HIGH3) { |
54 | is_dig_stream = true; |
55 | break; |
56 | } |
57 | } else { |
58 | is_dig_stream = true; |
59 | break; |
60 | } |
61 | } |
62 | } |
63 | } |
64 | return is_dig_stream; |
65 | } |
66 | |
67 | static struct link_enc_assignment get_assignment(struct dc *dc, int i) |
68 | { |
69 | struct link_enc_assignment assignment; |
70 | |
71 | if (dc->current_state->res_ctx.link_enc_cfg_ctx.mode == LINK_ENC_CFG_TRANSIENT) |
72 | assignment = dc->current_state->res_ctx.link_enc_cfg_ctx.transient_assignments[i]; |
73 | else /* LINK_ENC_CFG_STEADY */ |
74 | assignment = dc->current_state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
75 | |
76 | return assignment; |
77 | } |
78 | |
79 | /* Return stream using DIG link encoder resource. NULL if unused. */ |
80 | static struct dc_stream_state *get_stream_using_link_enc( |
81 | struct dc_state *state, |
82 | enum engine_id eng_id) |
83 | { |
84 | struct dc_stream_state *stream = NULL; |
85 | int i; |
86 | |
87 | for (i = 0; i < state->stream_count; i++) { |
88 | struct link_enc_assignment assignment = state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
89 | |
90 | if ((assignment.valid == true) && (assignment.eng_id == eng_id)) { |
91 | stream = state->streams[i]; |
92 | break; |
93 | } |
94 | } |
95 | |
96 | return stream; |
97 | } |
98 | |
99 | static void remove_link_enc_assignment( |
100 | struct dc_state *state, |
101 | struct dc_stream_state *stream, |
102 | enum engine_id eng_id) |
103 | { |
104 | int eng_idx; |
105 | int i; |
106 | |
107 | if (eng_id != ENGINE_ID_UNKNOWN) { |
108 | eng_idx = eng_id - ENGINE_ID_DIGA; |
109 | |
110 | /* stream ptr of stream in dc_state used to update correct entry in |
111 | * link_enc_assignments table. |
112 | */ |
113 | for (i = 0; i < MAX_PIPES; i++) { |
114 | struct link_enc_assignment assignment = state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
115 | |
116 | if (assignment.valid && assignment.stream == stream) { |
117 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].valid = false; |
118 | /* Only add link encoder back to availability pool if not being |
119 | * used by any other stream (i.e. removing SST stream or last MST stream). |
120 | */ |
121 | if (get_stream_using_link_enc(state, eng_id) == NULL) |
122 | state->res_ctx.link_enc_cfg_ctx.link_enc_avail[eng_idx] = eng_id; |
123 | |
124 | stream->link_enc = NULL; |
125 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].eng_id = ENGINE_ID_UNKNOWN; |
126 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].stream = NULL; |
127 | dc_stream_release(dc_stream: stream); |
128 | break; |
129 | } |
130 | } |
131 | } |
132 | } |
133 | |
134 | static void add_link_enc_assignment( |
135 | struct dc_state *state, |
136 | struct dc_stream_state *stream, |
137 | enum engine_id eng_id) |
138 | { |
139 | int eng_idx; |
140 | int i; |
141 | |
142 | if (eng_id != ENGINE_ID_UNKNOWN) { |
143 | eng_idx = eng_id - ENGINE_ID_DIGA; |
144 | |
145 | /* stream ptr of stream in dc_state used to update correct entry in |
146 | * link_enc_assignments table. |
147 | */ |
148 | for (i = 0; i < state->stream_count; i++) { |
149 | if (stream == state->streams[i]) { |
150 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i] = (struct link_enc_assignment){ |
151 | .valid = true, |
152 | .ep_id = (struct display_endpoint_id) { |
153 | .link_id = stream->link->link_id, |
154 | .ep_type = stream->link->ep_type}, |
155 | .eng_id = eng_id, |
156 | .stream = stream}; |
157 | dc_stream_retain(dc_stream: stream); |
158 | state->res_ctx.link_enc_cfg_ctx.link_enc_avail[eng_idx] = ENGINE_ID_UNKNOWN; |
159 | stream->link_enc = stream->ctx->dc->res_pool->link_encoders[eng_idx]; |
160 | break; |
161 | } |
162 | } |
163 | |
164 | /* Attempted to add an encoder assignment for a stream not in dc_state. */ |
165 | ASSERT(i != state->stream_count); |
166 | } |
167 | } |
168 | |
169 | /* Return first available DIG link encoder. */ |
170 | static enum engine_id find_first_avail_link_enc( |
171 | const struct dc_context *ctx, |
172 | const struct dc_state *state, |
173 | enum engine_id eng_id_requested) |
174 | { |
175 | enum engine_id eng_id = ENGINE_ID_UNKNOWN; |
176 | int i; |
177 | |
178 | if (eng_id_requested != ENGINE_ID_UNKNOWN) { |
179 | |
180 | for (i = 0; i < ctx->dc->res_pool->res_cap->num_dig_link_enc; i++) { |
181 | eng_id = state->res_ctx.link_enc_cfg_ctx.link_enc_avail[i]; |
182 | if (eng_id == eng_id_requested) |
183 | return eng_id; |
184 | } |
185 | } |
186 | |
187 | eng_id = ENGINE_ID_UNKNOWN; |
188 | |
189 | for (i = 0; i < ctx->dc->res_pool->res_cap->num_dig_link_enc; i++) { |
190 | eng_id = state->res_ctx.link_enc_cfg_ctx.link_enc_avail[i]; |
191 | if (eng_id != ENGINE_ID_UNKNOWN) |
192 | break; |
193 | } |
194 | |
195 | return eng_id; |
196 | } |
197 | |
198 | /* Check for availability of link encoder eng_id. */ |
199 | static bool is_avail_link_enc(struct dc_state *state, enum engine_id eng_id, struct dc_stream_state *stream) |
200 | { |
201 | bool is_avail = false; |
202 | int eng_idx = eng_id - ENGINE_ID_DIGA; |
203 | |
204 | /* An encoder is available if it is still in the availability pool. */ |
205 | if (eng_id != ENGINE_ID_UNKNOWN && state->res_ctx.link_enc_cfg_ctx.link_enc_avail[eng_idx] != ENGINE_ID_UNKNOWN) { |
206 | is_avail = true; |
207 | } else { |
208 | struct dc_stream_state *stream_assigned = NULL; |
209 | |
210 | /* MST streams share the same link and should share the same encoder. |
211 | * If a stream that has already been assigned a link encoder uses as the |
212 | * same link as the stream checking for availability, it is an MST stream |
213 | * and should use the same link encoder. |
214 | */ |
215 | stream_assigned = get_stream_using_link_enc(state, eng_id); |
216 | if (stream_assigned && stream != stream_assigned && stream->link == stream_assigned->link) |
217 | is_avail = true; |
218 | } |
219 | |
220 | return is_avail; |
221 | } |
222 | |
223 | /* Test for display_endpoint_id equality. */ |
224 | static bool are_ep_ids_equal(struct display_endpoint_id *lhs, struct display_endpoint_id *rhs) |
225 | { |
226 | bool are_equal = false; |
227 | |
228 | if (lhs->link_id.id == rhs->link_id.id && |
229 | lhs->link_id.enum_id == rhs->link_id.enum_id && |
230 | lhs->link_id.type == rhs->link_id.type && |
231 | lhs->ep_type == rhs->ep_type) |
232 | are_equal = true; |
233 | |
234 | return are_equal; |
235 | } |
236 | |
237 | static struct link_encoder *get_link_enc_used_by_link( |
238 | struct dc_state *state, |
239 | const struct dc_link *link) |
240 | { |
241 | struct link_encoder *link_enc = NULL; |
242 | struct display_endpoint_id ep_id; |
243 | int i; |
244 | |
245 | ep_id = (struct display_endpoint_id) { |
246 | .link_id = link->link_id, |
247 | .ep_type = link->ep_type}; |
248 | |
249 | for (i = 0; i < MAX_PIPES; i++) { |
250 | struct link_enc_assignment assignment = state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
251 | |
252 | if (assignment.valid == true && are_ep_ids_equal(lhs: &assignment.ep_id, rhs: &ep_id)) |
253 | link_enc = link->dc->res_pool->link_encoders[assignment.eng_id - ENGINE_ID_DIGA]; |
254 | } |
255 | |
256 | return link_enc; |
257 | } |
258 | /* Clear all link encoder assignments. */ |
259 | static void clear_enc_assignments(const struct dc *dc, struct dc_state *state) |
260 | { |
261 | int i; |
262 | |
263 | for (i = 0; i < MAX_PIPES; i++) { |
264 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].valid = false; |
265 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].eng_id = ENGINE_ID_UNKNOWN; |
266 | if (state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].stream != NULL) { |
267 | dc_stream_release(dc_stream: state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].stream); |
268 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].stream = NULL; |
269 | } |
270 | } |
271 | |
272 | for (i = 0; i < dc->res_pool->res_cap->num_dig_link_enc; i++) { |
273 | if (dc->res_pool->link_encoders[i]) |
274 | state->res_ctx.link_enc_cfg_ctx.link_enc_avail[i] = (enum engine_id) i; |
275 | else |
276 | state->res_ctx.link_enc_cfg_ctx.link_enc_avail[i] = ENGINE_ID_UNKNOWN; |
277 | } |
278 | } |
279 | |
280 | void link_enc_cfg_init( |
281 | const struct dc *dc, |
282 | struct dc_state *state) |
283 | { |
284 | clear_enc_assignments(dc, state); |
285 | |
286 | state->res_ctx.link_enc_cfg_ctx.mode = LINK_ENC_CFG_STEADY; |
287 | } |
288 | |
289 | void link_enc_cfg_copy(const struct dc_state *src_ctx, struct dc_state *dst_ctx) |
290 | { |
291 | memcpy(&dst_ctx->res_ctx.link_enc_cfg_ctx, |
292 | &src_ctx->res_ctx.link_enc_cfg_ctx, |
293 | sizeof(dst_ctx->res_ctx.link_enc_cfg_ctx)); |
294 | } |
295 | |
296 | void link_enc_cfg_link_encs_assign( |
297 | struct dc *dc, |
298 | struct dc_state *state, |
299 | struct dc_stream_state *streams[], |
300 | uint8_t stream_count) |
301 | { |
302 | enum engine_id eng_id = ENGINE_ID_UNKNOWN, eng_id_req = ENGINE_ID_UNKNOWN; |
303 | int i; |
304 | int j; |
305 | |
306 | ASSERT(state->stream_count == stream_count); |
307 | ASSERT(dc->current_state->res_ctx.link_enc_cfg_ctx.mode == LINK_ENC_CFG_STEADY); |
308 | |
309 | /* Release DIG link encoder resources before running assignment algorithm. */ |
310 | for (i = 0; i < dc->current_state->stream_count; i++) |
311 | dc->res_pool->funcs->link_enc_unassign(state, dc->current_state->streams[i]); |
312 | |
313 | for (i = 0; i < MAX_PIPES; i++) |
314 | ASSERT(state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i].valid == false); |
315 | |
316 | /* (a) Assign DIG link encoders to physical (unmappable) endpoints first. */ |
317 | for (i = 0; i < stream_count; i++) { |
318 | struct dc_stream_state *stream = streams[i]; |
319 | |
320 | /* skip it if the link is mappable endpoint. */ |
321 | if (stream->link->is_dig_mapping_flexible) |
322 | continue; |
323 | |
324 | /* Skip stream if not supported by DIG link encoder. */ |
325 | if (!is_dig_link_enc_stream(stream)) |
326 | continue; |
327 | |
328 | /* Physical endpoints have a fixed mapping to DIG link encoders. */ |
329 | eng_id = stream->link->eng_id; |
330 | add_link_enc_assignment(state, stream, eng_id); |
331 | } |
332 | |
333 | /* (b) Retain previous assignments for mappable endpoints if encoders still available. */ |
334 | eng_id = ENGINE_ID_UNKNOWN; |
335 | |
336 | if (state != dc->current_state) { |
337 | struct dc_state *prev_state = dc->current_state; |
338 | |
339 | for (i = 0; i < stream_count; i++) { |
340 | struct dc_stream_state *stream = state->streams[i]; |
341 | |
342 | /* Skip it if the link is NOT mappable endpoint. */ |
343 | if (!stream->link->is_dig_mapping_flexible) |
344 | continue; |
345 | |
346 | /* Skip stream if not supported by DIG link encoder. */ |
347 | if (!is_dig_link_enc_stream(stream)) |
348 | continue; |
349 | |
350 | for (j = 0; j < prev_state->stream_count; j++) { |
351 | struct dc_stream_state *prev_stream = prev_state->streams[j]; |
352 | |
353 | if (stream == prev_stream && stream->link == prev_stream->link && |
354 | prev_state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[j].valid) { |
355 | eng_id = prev_state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[j].eng_id; |
356 | |
357 | if (is_avail_link_enc(state, eng_id, stream)) |
358 | add_link_enc_assignment(state, stream, eng_id); |
359 | } |
360 | } |
361 | } |
362 | } |
363 | |
364 | /* (c) Then assign encoders to remaining mappable endpoints. */ |
365 | eng_id = ENGINE_ID_UNKNOWN; |
366 | |
367 | for (i = 0; i < stream_count; i++) { |
368 | struct dc_stream_state *stream = streams[i]; |
369 | struct link_encoder *link_enc = NULL; |
370 | |
371 | /* Skip it if the link is NOT mappable endpoint. */ |
372 | if (!stream->link->is_dig_mapping_flexible) |
373 | continue; |
374 | |
375 | /* Skip if encoder assignment retained in step (b) above. */ |
376 | if (stream->link_enc) |
377 | continue; |
378 | |
379 | /* Skip stream if not supported by DIG link encoder. */ |
380 | if (!is_dig_link_enc_stream(stream)) { |
381 | ASSERT(stream->link->is_dig_mapping_flexible != true); |
382 | continue; |
383 | } |
384 | |
385 | /* Mappable endpoints have a flexible mapping to DIG link encoders. */ |
386 | |
387 | /* For MST, multiple streams will share the same link / display |
388 | * endpoint. These streams should use the same link encoder |
389 | * assigned to that endpoint. |
390 | */ |
391 | link_enc = get_link_enc_used_by_link(state, link: stream->link); |
392 | if (link_enc == NULL) { |
393 | |
394 | if (stream->link->ep_type == DISPLAY_ENDPOINT_USB4_DPIA && |
395 | stream->link->dpia_preferred_eng_id != ENGINE_ID_UNKNOWN) |
396 | eng_id_req = stream->link->dpia_preferred_eng_id; |
397 | |
398 | eng_id = find_first_avail_link_enc(ctx: stream->ctx, state, eng_id_requested: eng_id_req); |
399 | } |
400 | else |
401 | eng_id = link_enc->preferred_engine; |
402 | |
403 | add_link_enc_assignment(state, stream, eng_id); |
404 | } |
405 | |
406 | link_enc_cfg_validate(dc, state); |
407 | |
408 | /* Update transient assignments. */ |
409 | for (i = 0; i < MAX_PIPES; i++) { |
410 | dc->current_state->res_ctx.link_enc_cfg_ctx.transient_assignments[i] = |
411 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
412 | } |
413 | |
414 | /* Log encoder assignments. */ |
415 | for (i = 0; i < MAX_PIPES; i++) { |
416 | struct link_enc_assignment assignment = |
417 | dc->current_state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
418 | |
419 | if (assignment.valid) |
420 | DC_LOG_DEBUG("%s: CUR %s(%d) - enc_id(%d)\n" , |
421 | __func__, |
422 | assignment.ep_id.ep_type == DISPLAY_ENDPOINT_PHY ? "PHY" : "DPIA" , |
423 | assignment.ep_id.ep_type == DISPLAY_ENDPOINT_PHY ? |
424 | assignment.ep_id.link_id.enum_id : |
425 | assignment.ep_id.link_id.enum_id - 1, |
426 | assignment.eng_id); |
427 | } |
428 | for (i = 0; i < MAX_PIPES; i++) { |
429 | struct link_enc_assignment assignment = |
430 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
431 | |
432 | if (assignment.valid) |
433 | DC_LOG_DEBUG("%s: NEW %s(%d) - enc_id(%d)\n" , |
434 | __func__, |
435 | assignment.ep_id.ep_type == DISPLAY_ENDPOINT_PHY ? "PHY" : "DPIA" , |
436 | assignment.ep_id.ep_type == DISPLAY_ENDPOINT_PHY ? |
437 | assignment.ep_id.link_id.enum_id : |
438 | assignment.ep_id.link_id.enum_id - 1, |
439 | assignment.eng_id); |
440 | } |
441 | |
442 | /* Current state mode will be set to steady once this state committed. */ |
443 | state->res_ctx.link_enc_cfg_ctx.mode = LINK_ENC_CFG_STEADY; |
444 | } |
445 | |
446 | void link_enc_cfg_link_enc_unassign( |
447 | struct dc_state *state, |
448 | struct dc_stream_state *stream) |
449 | { |
450 | enum engine_id eng_id = ENGINE_ID_UNKNOWN; |
451 | |
452 | if (stream->link_enc) |
453 | eng_id = stream->link_enc->preferred_engine; |
454 | |
455 | remove_link_enc_assignment(state, stream, eng_id); |
456 | } |
457 | |
458 | bool link_enc_cfg_is_transmitter_mappable( |
459 | struct dc *dc, |
460 | struct link_encoder *link_enc) |
461 | { |
462 | bool is_mappable = false; |
463 | enum engine_id eng_id = link_enc->preferred_engine; |
464 | struct dc_stream_state *stream = link_enc_cfg_get_stream_using_link_enc(dc, eng_id); |
465 | |
466 | if (stream) |
467 | is_mappable = stream->link->is_dig_mapping_flexible; |
468 | |
469 | return is_mappable; |
470 | } |
471 | |
472 | struct dc_stream_state *link_enc_cfg_get_stream_using_link_enc( |
473 | struct dc *dc, |
474 | enum engine_id eng_id) |
475 | { |
476 | struct dc_stream_state *stream = NULL; |
477 | int i; |
478 | |
479 | for (i = 0; i < MAX_PIPES; i++) { |
480 | struct link_enc_assignment assignment = get_assignment(dc, i); |
481 | |
482 | if ((assignment.valid == true) && (assignment.eng_id == eng_id)) { |
483 | stream = assignment.stream; |
484 | break; |
485 | } |
486 | } |
487 | |
488 | return stream; |
489 | } |
490 | |
491 | struct dc_link *link_enc_cfg_get_link_using_link_enc( |
492 | struct dc *dc, |
493 | enum engine_id eng_id) |
494 | { |
495 | struct dc_link *link = NULL; |
496 | struct dc_stream_state *stream = NULL; |
497 | |
498 | stream = link_enc_cfg_get_stream_using_link_enc(dc, eng_id); |
499 | |
500 | if (stream) |
501 | link = stream->link; |
502 | |
503 | return link; |
504 | } |
505 | |
506 | struct link_encoder *link_enc_cfg_get_link_enc_used_by_link( |
507 | struct dc *dc, |
508 | const struct dc_link *link) |
509 | { |
510 | struct link_encoder *link_enc = NULL; |
511 | struct display_endpoint_id ep_id; |
512 | int i; |
513 | |
514 | ep_id = (struct display_endpoint_id) { |
515 | .link_id = link->link_id, |
516 | .ep_type = link->ep_type}; |
517 | |
518 | for (i = 0; i < MAX_PIPES; i++) { |
519 | struct link_enc_assignment assignment = get_assignment(dc, i); |
520 | |
521 | if (assignment.valid == true && are_ep_ids_equal(lhs: &assignment.ep_id, rhs: &ep_id)) { |
522 | link_enc = link->dc->res_pool->link_encoders[assignment.eng_id - ENGINE_ID_DIGA]; |
523 | break; |
524 | } |
525 | } |
526 | |
527 | return link_enc; |
528 | } |
529 | |
530 | struct link_encoder *link_enc_cfg_get_next_avail_link_enc(struct dc *dc) |
531 | { |
532 | struct link_encoder *link_enc = NULL; |
533 | enum engine_id encs_assigned[MAX_DIG_LINK_ENCODERS]; |
534 | int i; |
535 | |
536 | for (i = 0; i < MAX_DIG_LINK_ENCODERS; i++) |
537 | encs_assigned[i] = ENGINE_ID_UNKNOWN; |
538 | |
539 | /* Add assigned encoders to list. */ |
540 | for (i = 0; i < MAX_PIPES; i++) { |
541 | struct link_enc_assignment assignment = get_assignment(dc, i); |
542 | |
543 | if (assignment.valid) |
544 | encs_assigned[assignment.eng_id - ENGINE_ID_DIGA] = assignment.eng_id; |
545 | } |
546 | |
547 | for (i = 0; i < dc->res_pool->res_cap->num_dig_link_enc; i++) { |
548 | if (encs_assigned[i] == ENGINE_ID_UNKNOWN && |
549 | dc->res_pool->link_encoders[i] != NULL) { |
550 | link_enc = dc->res_pool->link_encoders[i]; |
551 | break; |
552 | } |
553 | } |
554 | |
555 | return link_enc; |
556 | } |
557 | |
558 | struct link_encoder *link_enc_cfg_get_link_enc_used_by_stream( |
559 | struct dc *dc, |
560 | const struct dc_stream_state *stream) |
561 | { |
562 | struct link_encoder *link_enc; |
563 | |
564 | link_enc = link_enc_cfg_get_link_enc_used_by_link(dc, link: stream->link); |
565 | |
566 | return link_enc; |
567 | } |
568 | |
569 | struct link_encoder *link_enc_cfg_get_link_enc( |
570 | const struct dc_link *link) |
571 | { |
572 | struct link_encoder *link_enc = NULL; |
573 | |
574 | /* Links supporting dynamically assigned link encoder will be assigned next |
575 | * available encoder if one not already assigned. |
576 | */ |
577 | if (link->is_dig_mapping_flexible && |
578 | link->dc->res_pool->funcs->link_encs_assign) { |
579 | link_enc = link_enc_cfg_get_link_enc_used_by_link(dc: link->ctx->dc, link); |
580 | if (link_enc == NULL) |
581 | link_enc = link_enc_cfg_get_next_avail_link_enc( |
582 | dc: link->ctx->dc); |
583 | } else |
584 | link_enc = link->link_enc; |
585 | |
586 | return link_enc; |
587 | } |
588 | |
589 | struct link_encoder *link_enc_cfg_get_link_enc_used_by_stream_current( |
590 | struct dc *dc, |
591 | const struct dc_stream_state *stream) |
592 | { |
593 | struct link_encoder *link_enc = NULL; |
594 | struct display_endpoint_id ep_id; |
595 | int i; |
596 | |
597 | ep_id = (struct display_endpoint_id) { |
598 | .link_id = stream->link->link_id, |
599 | .ep_type = stream->link->ep_type}; |
600 | |
601 | for (i = 0; i < MAX_PIPES; i++) { |
602 | struct link_enc_assignment assignment = |
603 | dc->current_state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
604 | |
605 | if (assignment.valid == true && are_ep_ids_equal(lhs: &assignment.ep_id, rhs: &ep_id)) { |
606 | link_enc = stream->link->dc->res_pool->link_encoders[assignment.eng_id - ENGINE_ID_DIGA]; |
607 | break; |
608 | } |
609 | } |
610 | |
611 | return link_enc; |
612 | } |
613 | |
614 | bool link_enc_cfg_is_link_enc_avail(struct dc *dc, enum engine_id eng_id, struct dc_link *link) |
615 | { |
616 | bool is_avail = true; |
617 | int i; |
618 | |
619 | /* An encoder is not available if it has already been assigned to a different endpoint. */ |
620 | for (i = 0; i < MAX_PIPES; i++) { |
621 | struct link_enc_assignment assignment = get_assignment(dc, i); |
622 | struct display_endpoint_id ep_id = (struct display_endpoint_id) { |
623 | .link_id = link->link_id, |
624 | .ep_type = link->ep_type}; |
625 | |
626 | if (assignment.valid && assignment.eng_id == eng_id && !are_ep_ids_equal(lhs: &ep_id, rhs: &assignment.ep_id)) { |
627 | is_avail = false; |
628 | break; |
629 | } |
630 | } |
631 | |
632 | return is_avail; |
633 | } |
634 | |
635 | bool link_enc_cfg_validate(struct dc *dc, struct dc_state *state) |
636 | { |
637 | bool is_valid = false; |
638 | bool valid_entries = true; |
639 | bool valid_stream_ptrs = true; |
640 | bool valid_uniqueness = true; |
641 | bool valid_avail = true; |
642 | bool valid_streams = true; |
643 | int i, j; |
644 | uint8_t valid_count = 0; |
645 | uint8_t dig_stream_count = 0; |
646 | int eng_ids_per_ep_id[MAX_PIPES] = {0}; |
647 | int ep_ids_per_eng_id[MAX_PIPES] = {0}; |
648 | int valid_bitmap = 0; |
649 | |
650 | /* (1) No. valid entries same as stream count. */ |
651 | for (i = 0; i < MAX_PIPES; i++) { |
652 | struct link_enc_assignment assignment = state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
653 | |
654 | if (assignment.valid) |
655 | valid_count++; |
656 | |
657 | if (is_dig_link_enc_stream(stream: state->streams[i])) |
658 | dig_stream_count++; |
659 | } |
660 | if (valid_count != dig_stream_count) |
661 | valid_entries = false; |
662 | |
663 | /* (2) Matching stream ptrs. */ |
664 | for (i = 0; i < MAX_PIPES; i++) { |
665 | struct link_enc_assignment assignment = state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
666 | |
667 | if (assignment.valid) { |
668 | if (assignment.stream != state->streams[i]) |
669 | valid_stream_ptrs = false; |
670 | } |
671 | } |
672 | |
673 | /* (3) Each endpoint assigned unique encoder. */ |
674 | for (i = 0; i < MAX_PIPES; i++) { |
675 | struct link_enc_assignment assignment_i = state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
676 | |
677 | if (assignment_i.valid) { |
678 | struct display_endpoint_id ep_id_i = assignment_i.ep_id; |
679 | |
680 | eng_ids_per_ep_id[i]++; |
681 | ep_ids_per_eng_id[i]++; |
682 | for (j = 0; j < MAX_PIPES; j++) { |
683 | struct link_enc_assignment assignment_j = |
684 | state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[j]; |
685 | |
686 | if (j == i) |
687 | continue; |
688 | |
689 | if (assignment_j.valid) { |
690 | struct display_endpoint_id ep_id_j = assignment_j.ep_id; |
691 | |
692 | if (are_ep_ids_equal(lhs: &ep_id_i, rhs: &ep_id_j) && |
693 | assignment_i.eng_id != assignment_j.eng_id) { |
694 | valid_uniqueness = false; |
695 | eng_ids_per_ep_id[i]++; |
696 | } else if (!are_ep_ids_equal(lhs: &ep_id_i, rhs: &ep_id_j) && |
697 | assignment_i.eng_id == assignment_j.eng_id) { |
698 | valid_uniqueness = false; |
699 | ep_ids_per_eng_id[i]++; |
700 | } |
701 | } |
702 | } |
703 | } |
704 | } |
705 | |
706 | /* (4) Assigned encoders not in available pool. */ |
707 | for (i = 0; i < MAX_PIPES; i++) { |
708 | struct link_enc_assignment assignment = state->res_ctx.link_enc_cfg_ctx.link_enc_assignments[i]; |
709 | |
710 | if (assignment.valid) { |
711 | for (j = 0; j < dc->res_pool->res_cap->num_dig_link_enc; j++) { |
712 | if (state->res_ctx.link_enc_cfg_ctx.link_enc_avail[j] == assignment.eng_id) { |
713 | valid_avail = false; |
714 | break; |
715 | } |
716 | } |
717 | } |
718 | } |
719 | |
720 | /* (5) All streams have valid link encoders. */ |
721 | for (i = 0; i < state->stream_count; i++) { |
722 | struct dc_stream_state *stream = state->streams[i]; |
723 | |
724 | if (is_dig_link_enc_stream(stream) && stream->link_enc == NULL) { |
725 | valid_streams = false; |
726 | break; |
727 | } |
728 | } |
729 | |
730 | is_valid = valid_entries && valid_stream_ptrs && valid_uniqueness && valid_avail && valid_streams; |
731 | ASSERT(is_valid); |
732 | |
733 | if (is_valid == false) { |
734 | valid_bitmap = |
735 | (valid_entries & 0x1) | |
736 | ((valid_stream_ptrs & 0x1) << 1) | |
737 | ((valid_uniqueness & 0x1) << 2) | |
738 | ((valid_avail & 0x1) << 3) | |
739 | ((valid_streams & 0x1) << 4); |
740 | DC_LOG_ERROR("%s: Invalid link encoder assignments - 0x%x\n" , __func__, valid_bitmap); |
741 | } |
742 | |
743 | return is_valid; |
744 | } |
745 | |
746 | void link_enc_cfg_set_transient_mode(struct dc *dc, struct dc_state *current_state, struct dc_state *new_state) |
747 | { |
748 | int i = 0; |
749 | int num_transient_assignments = 0; |
750 | |
751 | for (i = 0; i < MAX_PIPES; i++) { |
752 | if (current_state->res_ctx.link_enc_cfg_ctx.transient_assignments[i].valid) |
753 | num_transient_assignments++; |
754 | } |
755 | |
756 | /* Only enter transient mode if the new encoder assignments are valid. */ |
757 | if (new_state->stream_count == num_transient_assignments) { |
758 | current_state->res_ctx.link_enc_cfg_ctx.mode = LINK_ENC_CFG_TRANSIENT; |
759 | DC_LOG_DEBUG("%s: current_state(%p) mode(%d)\n" , __func__, current_state, LINK_ENC_CFG_TRANSIENT); |
760 | } |
761 | } |
762 | |