xref: /linux/drivers/gpu/drm/amd/display/dc/link/link_factory.c (revision 220994d61cebfc04f071d69049127657c7e8191b)
1 /*
2  * Copyright 2023 Advanced Micro Devices, Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  * Authors: AMD
23  *
24  */
25 
26 /* FILE POLICY AND INTENDED USAGE:
27  * This file owns the creation/destruction of link structure.
28  */
29 #include "link_factory.h"
30 #include "link_detection.h"
31 #include "link_resource.h"
32 #include "link_validation.h"
33 #include "link_dpms.h"
34 #include "accessories/link_dp_cts.h"
35 #include "accessories/link_dp_trace.h"
36 #include "protocols/link_ddc.h"
37 #include "protocols/link_dp_capability.h"
38 #include "protocols/link_dp_dpia_bw.h"
39 #include "protocols/link_dp_dpia.h"
40 #include "protocols/link_dp_irq_handler.h"
41 #include "protocols/link_dp_phy.h"
42 #include "protocols/link_dp_training.h"
43 #include "protocols/link_edp_panel_control.h"
44 #include "protocols/link_hpd.h"
45 #include "gpio_service_interface.h"
46 #include "atomfirmware.h"
47 
48 #define DC_LOGGER \
49 	dc_ctx->logger
50 #define DC_LOGGER_INIT(logger)
51 
52 #define LINK_INFO(...) \
53 	DC_LOG_HW_HOTPLUG(  \
54 		__VA_ARGS__)
55 
56 /* link factory owns the creation/destruction of link structures. */
construct_link_service_factory(struct link_service * link_srv)57 static void construct_link_service_factory(struct link_service *link_srv)
58 {
59 
60 	link_srv->create_link = link_create;
61 	link_srv->destroy_link = link_destroy;
62 }
63 
64 /* link_detection manages link detection states and receiver states by using
65  * various link protocols. It also provides helper functions to interpret
66  * certain capabilities or status based on the states it manages or retrieve
67  * them directly from connected receivers.
68  */
construct_link_service_detection(struct link_service * link_srv)69 static void construct_link_service_detection(struct link_service *link_srv)
70 {
71 	link_srv->detect_link = link_detect;
72 	link_srv->detect_connection_type = link_detect_connection_type;
73 	link_srv->add_remote_sink = link_add_remote_sink;
74 	link_srv->remove_remote_sink = link_remove_remote_sink;
75 	link_srv->get_hpd_state = link_get_hpd_state;
76 	link_srv->get_hpd_gpio = link_get_hpd_gpio;
77 	link_srv->enable_hpd = link_enable_hpd;
78 	link_srv->disable_hpd = link_disable_hpd;
79 	link_srv->enable_hpd_filter = link_enable_hpd_filter;
80 	link_srv->reset_cur_dp_mst_topology = link_reset_cur_dp_mst_topology;
81 	link_srv->get_status = link_get_status;
82 	link_srv->is_hdcp1x_supported = link_is_hdcp14;
83 	link_srv->is_hdcp2x_supported = link_is_hdcp22;
84 	link_srv->clear_dprx_states = link_clear_dprx_states;
85 }
86 
87 /* link resource implements accessors to link resource. */
construct_link_service_resource(struct link_service * link_srv)88 static void construct_link_service_resource(struct link_service *link_srv)
89 {
90 	link_srv->get_cur_res_map = link_get_cur_res_map;
91 	link_srv->restore_res_map = link_restore_res_map;
92 	link_srv->get_cur_link_res = link_get_cur_link_res;
93 }
94 
95 /* link validation owns timing validation against various link limitations. (ex.
96  * link bandwidth, receiver capability or our hardware capability) It also
97  * provides helper functions exposing bandwidth formulas used in validation.
98  */
construct_link_service_validation(struct link_service * link_srv)99 static void construct_link_service_validation(struct link_service *link_srv)
100 {
101 	link_srv->validate_mode_timing = link_validate_mode_timing;
102 	link_srv->dp_link_bandwidth_kbps = dp_link_bandwidth_kbps;
103 	link_srv->validate_dp_tunnel_bandwidth = link_validate_dp_tunnel_bandwidth;
104 	link_srv->dp_required_hblank_size_bytes = dp_required_hblank_size_bytes;
105 }
106 
107 /* link dpms owns the programming sequence of stream's dpms state associated
108  * with the link and link's enable/disable sequences as result of the stream's
109  * dpms state change.
110  */
construct_link_service_dpms(struct link_service * link_srv)111 static void construct_link_service_dpms(struct link_service *link_srv)
112 {
113 	link_srv->set_dpms_on = link_set_dpms_on;
114 	link_srv->set_dpms_off = link_set_dpms_off;
115 	link_srv->resume = link_resume;
116 	link_srv->blank_all_dp_displays = link_blank_all_dp_displays;
117 	link_srv->blank_all_edp_displays = link_blank_all_edp_displays;
118 	link_srv->blank_dp_stream = link_blank_dp_stream;
119 	link_srv->increase_mst_payload = link_increase_mst_payload;
120 	link_srv->reduce_mst_payload = link_reduce_mst_payload;
121 	link_srv->set_dsc_on_stream = link_set_dsc_on_stream;
122 	link_srv->set_dsc_enable = link_set_dsc_enable;
123 	link_srv->update_dsc_config = link_update_dsc_config;
124 }
125 
126 /* link ddc implements generic display communication protocols such as i2c, aux
127  * and scdc. It should not contain any specific applications of these
128  * protocols such as display capability query, detection, or handshaking such as
129  * link training.
130  */
construct_link_service_ddc(struct link_service * link_srv)131 static void construct_link_service_ddc(struct link_service *link_srv)
132 {
133 	link_srv->create_ddc_service = link_create_ddc_service;
134 	link_srv->destroy_ddc_service = link_destroy_ddc_service;
135 	link_srv->query_ddc_data = link_query_ddc_data;
136 	link_srv->aux_transfer_raw = link_aux_transfer_raw;
137 	link_srv->configure_fixed_vs_pe_retimer = link_configure_fixed_vs_pe_retimer;
138 	link_srv->aux_transfer_with_retries_no_mutex =
139 			link_aux_transfer_with_retries_no_mutex;
140 	link_srv->is_in_aux_transaction_mode = link_is_in_aux_transaction_mode;
141 	link_srv->get_aux_defer_delay = link_get_aux_defer_delay;
142 }
143 
144 /* link dp capability implements dp specific link capability retrieval sequence.
145  * It is responsible for retrieving, parsing, overriding, deciding capability
146  * obtained from dp link. Link capability consists of encoders, DPRXs, cables,
147  * retimers, usb and all other possible backend capabilities.
148  */
construct_link_service_dp_capability(struct link_service * link_srv)149 static void construct_link_service_dp_capability(struct link_service *link_srv)
150 {
151 	link_srv->dp_is_sink_present = dp_is_sink_present;
152 	link_srv->dp_is_fec_supported = dp_is_fec_supported;
153 	link_srv->dp_is_128b_132b_signal = dp_is_128b_132b_signal;
154 	link_srv->dp_get_max_link_enc_cap = dp_get_max_link_enc_cap;
155 	link_srv->dp_get_verified_link_cap = dp_get_verified_link_cap;
156 	link_srv->dp_get_encoding_format = link_dp_get_encoding_format;
157 	link_srv->dp_should_enable_fec = dp_should_enable_fec;
158 	link_srv->dp_decide_link_settings = link_decide_link_settings;
159 	link_srv->dp_decide_tunnel_settings = link_decide_dp_tunnel_settings;
160 	link_srv->mst_decide_link_encoding_format =
161 			mst_decide_link_encoding_format;
162 	link_srv->edp_decide_link_settings = edp_decide_link_settings;
163 	link_srv->bw_kbps_from_raw_frl_link_rate_data =
164 			link_bw_kbps_from_raw_frl_link_rate_data;
165 	link_srv->dp_overwrite_extended_receiver_cap =
166 			dp_overwrite_extended_receiver_cap;
167 	link_srv->dp_decide_lttpr_mode = dp_decide_lttpr_mode;
168 }
169 
170 /* link dp phy/dpia implements basic dp phy/dpia functionality such as
171  * enable/disable output and set lane/drive settings. It is responsible for
172  * maintaining and update software state representing current phy/dpia status
173  * such as current link settings.
174  */
construct_link_service_dp_phy_or_dpia(struct link_service * link_srv)175 static void construct_link_service_dp_phy_or_dpia(struct link_service *link_srv)
176 {
177 	link_srv->dpia_handle_usb4_bandwidth_allocation_for_link =
178 			dpia_handle_usb4_bandwidth_allocation_for_link;
179 	link_srv->dp_set_drive_settings = dp_set_drive_settings;
180 	link_srv->dpcd_write_rx_power_ctrl = dpcd_write_rx_power_ctrl;
181 }
182 
183 /* link dp irq handler implements DP HPD short pulse handling sequence according
184  * to DP specifications
185  */
construct_link_service_dp_irq_handler(struct link_service * link_srv)186 static void construct_link_service_dp_irq_handler(struct link_service *link_srv)
187 {
188 	link_srv->dp_parse_link_loss_status = dp_parse_link_loss_status;
189 	link_srv->dp_should_allow_hpd_rx_irq = dp_should_allow_hpd_rx_irq;
190 	link_srv->dp_handle_link_loss = dp_handle_link_loss;
191 	link_srv->dp_read_hpd_rx_irq_data = dp_read_hpd_rx_irq_data;
192 	link_srv->dp_handle_hpd_rx_irq = dp_handle_hpd_rx_irq;
193 }
194 
195 /* link edp panel control implements retrieval and configuration of eDP panel
196  * features such as PSR and ABM and it also manages specs defined eDP panel
197  * power sequences.
198  */
construct_link_service_edp_panel_control(struct link_service * link_srv)199 static void construct_link_service_edp_panel_control(struct link_service *link_srv)
200 {
201 	link_srv->edp_panel_backlight_power_on = edp_panel_backlight_power_on;
202 	link_srv->edp_get_backlight_level = edp_get_backlight_level;
203 	link_srv->edp_get_backlight_level_nits = edp_get_backlight_level_nits;
204 	link_srv->edp_set_backlight_level = edp_set_backlight_level;
205 	link_srv->edp_set_backlight_level_nits = edp_set_backlight_level_nits;
206 	link_srv->edp_get_target_backlight_pwm = edp_get_target_backlight_pwm;
207 	link_srv->edp_get_psr_state = edp_get_psr_state;
208 	link_srv->edp_set_psr_allow_active = edp_set_psr_allow_active;
209 	link_srv->edp_setup_psr = edp_setup_psr;
210 	link_srv->edp_set_sink_vtotal_in_psr_active =
211 			edp_set_sink_vtotal_in_psr_active;
212 	link_srv->edp_get_psr_residency = edp_get_psr_residency;
213 
214 	link_srv->edp_get_replay_state = edp_get_replay_state;
215 	link_srv->edp_set_replay_allow_active = edp_set_replay_allow_active;
216 	link_srv->edp_setup_replay = edp_setup_replay;
217 	link_srv->edp_send_replay_cmd = edp_send_replay_cmd;
218 	link_srv->edp_set_coasting_vtotal = edp_set_coasting_vtotal;
219 	link_srv->edp_replay_residency = edp_replay_residency;
220 	link_srv->edp_set_replay_power_opt_and_coasting_vtotal = edp_set_replay_power_opt_and_coasting_vtotal;
221 
222 	link_srv->edp_wait_for_t12 = edp_wait_for_t12;
223 	link_srv->edp_is_ilr_optimization_required =
224 			edp_is_ilr_optimization_required;
225 	link_srv->edp_backlight_enable_aux = edp_backlight_enable_aux;
226 	link_srv->edp_add_delay_for_T9 = edp_add_delay_for_T9;
227 	link_srv->edp_receiver_ready_T9 = edp_receiver_ready_T9;
228 	link_srv->edp_receiver_ready_T7 = edp_receiver_ready_T7;
229 	link_srv->edp_power_alpm_dpcd_enable = edp_power_alpm_dpcd_enable;
230 	link_srv->edp_set_panel_power = edp_set_panel_power;
231 }
232 
233 /* link dp cts implements dp compliance test automation protocols and manual
234  * testing interfaces for debugging and certification purpose.
235  */
construct_link_service_dp_cts(struct link_service * link_srv)236 static void construct_link_service_dp_cts(struct link_service *link_srv)
237 {
238 	link_srv->dp_handle_automated_test = dp_handle_automated_test;
239 	link_srv->dp_set_test_pattern = dp_set_test_pattern;
240 	link_srv->dp_set_preferred_link_settings =
241 			dp_set_preferred_link_settings;
242 	link_srv->dp_set_preferred_training_settings =
243 			dp_set_preferred_training_settings;
244 }
245 
246 /* link dp trace implements tracing interfaces for tracking major dp sequences
247  * including execution status and timestamps
248  */
construct_link_service_dp_trace(struct link_service * link_srv)249 static void construct_link_service_dp_trace(struct link_service *link_srv)
250 {
251 	link_srv->dp_trace_is_initialized = dp_trace_is_initialized;
252 	link_srv->dp_trace_set_is_logged_flag = dp_trace_set_is_logged_flag;
253 	link_srv->dp_trace_is_logged = dp_trace_is_logged;
254 	link_srv->dp_trace_get_lt_end_timestamp = dp_trace_get_lt_end_timestamp;
255 	link_srv->dp_trace_get_lt_counts = dp_trace_get_lt_counts;
256 	link_srv->dp_trace_get_link_loss_count = dp_trace_get_link_loss_count;
257 	link_srv->dp_trace_set_edp_power_timestamp =
258 			dp_trace_set_edp_power_timestamp;
259 	link_srv->dp_trace_get_edp_poweron_timestamp =
260 			dp_trace_get_edp_poweron_timestamp;
261 	link_srv->dp_trace_get_edp_poweroff_timestamp =
262 			dp_trace_get_edp_poweroff_timestamp;
263 	link_srv->dp_trace_source_sequence = dp_trace_source_sequence;
264 }
265 
construct_link_service(struct link_service * link_srv)266 static void construct_link_service(struct link_service *link_srv)
267 {
268 	/* All link service functions should fall under some sub categories.
269 	 * If a new function doesn't perfectly fall under an existing sub
270 	 * category, it must be that you are either adding a whole new aspect of
271 	 * responsibility to link service or something doesn't belong to link
272 	 * service. In that case please contact the arch owner to arrange a
273 	 * design review meeting.
274 	 */
275 	construct_link_service_factory(link_srv);
276 	construct_link_service_detection(link_srv);
277 	construct_link_service_resource(link_srv);
278 	construct_link_service_validation(link_srv);
279 	construct_link_service_dpms(link_srv);
280 	construct_link_service_ddc(link_srv);
281 	construct_link_service_dp_capability(link_srv);
282 	construct_link_service_dp_phy_or_dpia(link_srv);
283 	construct_link_service_dp_irq_handler(link_srv);
284 	construct_link_service_edp_panel_control(link_srv);
285 	construct_link_service_dp_cts(link_srv);
286 	construct_link_service_dp_trace(link_srv);
287 }
288 
link_create_link_service(void)289 struct link_service *link_create_link_service(void)
290 {
291 	struct link_service *link_srv = kzalloc(sizeof(*link_srv), GFP_KERNEL);
292 
293 	if (link_srv == NULL)
294 		goto fail;
295 
296 	construct_link_service(link_srv);
297 
298 	return link_srv;
299 fail:
300 	return NULL;
301 }
302 
link_destroy_link_service(struct link_service ** link_srv)303 void link_destroy_link_service(struct link_service **link_srv)
304 {
305 	kfree(*link_srv);
306 	*link_srv = NULL;
307 }
308 
translate_encoder_to_transmitter(struct graphics_object_id encoder)309 static enum transmitter translate_encoder_to_transmitter(
310 		struct graphics_object_id encoder)
311 {
312 	switch (encoder.id) {
313 	case ENCODER_ID_INTERNAL_UNIPHY:
314 		switch (encoder.enum_id) {
315 		case ENUM_ID_1:
316 			return TRANSMITTER_UNIPHY_A;
317 		case ENUM_ID_2:
318 			return TRANSMITTER_UNIPHY_B;
319 		default:
320 			return TRANSMITTER_UNKNOWN;
321 		}
322 	break;
323 	case ENCODER_ID_INTERNAL_UNIPHY1:
324 		switch (encoder.enum_id) {
325 		case ENUM_ID_1:
326 			return TRANSMITTER_UNIPHY_C;
327 		case ENUM_ID_2:
328 			return TRANSMITTER_UNIPHY_D;
329 		default:
330 			return TRANSMITTER_UNKNOWN;
331 		}
332 	break;
333 	case ENCODER_ID_INTERNAL_UNIPHY2:
334 		switch (encoder.enum_id) {
335 		case ENUM_ID_1:
336 			return TRANSMITTER_UNIPHY_E;
337 		case ENUM_ID_2:
338 			return TRANSMITTER_UNIPHY_F;
339 		default:
340 			return TRANSMITTER_UNKNOWN;
341 		}
342 	break;
343 	case ENCODER_ID_INTERNAL_UNIPHY3:
344 		switch (encoder.enum_id) {
345 		case ENUM_ID_1:
346 			return TRANSMITTER_UNIPHY_G;
347 		default:
348 			return TRANSMITTER_UNKNOWN;
349 		}
350 	break;
351 	case ENCODER_ID_EXTERNAL_NUTMEG:
352 		switch (encoder.enum_id) {
353 		case ENUM_ID_1:
354 			return TRANSMITTER_NUTMEG_CRT;
355 		default:
356 			return TRANSMITTER_UNKNOWN;
357 		}
358 	break;
359 	case ENCODER_ID_EXTERNAL_TRAVIS:
360 		switch (encoder.enum_id) {
361 		case ENUM_ID_1:
362 			return TRANSMITTER_TRAVIS_CRT;
363 		case ENUM_ID_2:
364 			return TRANSMITTER_TRAVIS_LCD;
365 		default:
366 			return TRANSMITTER_UNKNOWN;
367 		}
368 	break;
369 	default:
370 		return TRANSMITTER_UNKNOWN;
371 	}
372 }
373 
link_destruct(struct dc_link * link)374 static void link_destruct(struct dc_link *link)
375 {
376 	int i;
377 
378 	if (link->hpd_gpio) {
379 		dal_gpio_destroy_irq(&link->hpd_gpio);
380 		link->hpd_gpio = NULL;
381 	}
382 
383 	if (link->ddc)
384 		link_destroy_ddc_service(&link->ddc);
385 
386 	if (link->panel_cntl)
387 		link->panel_cntl->funcs->destroy(&link->panel_cntl);
388 
389 	if (link->link_enc && !link->is_dig_mapping_flexible) {
390 		/* Update link encoder resource tracking variables. These are used for
391 		 * the dynamic assignment of link encoders to streams. Virtual links
392 		 * are not assigned encoder resources on creation.
393 		 */
394 		if (link->link_id.id != CONNECTOR_ID_VIRTUAL && link->eng_id != ENGINE_ID_UNKNOWN) {
395 			link->dc->res_pool->link_encoders[link->eng_id - ENGINE_ID_DIGA] = NULL;
396 			link->dc->res_pool->dig_link_enc_count--;
397 		}
398 		link->link_enc->funcs->destroy(&link->link_enc);
399 	}
400 
401 	if (link->local_sink)
402 		dc_sink_release(link->local_sink);
403 
404 	for (i = 0; i < link->sink_count; ++i)
405 		dc_sink_release(link->remote_sinks[i]);
406 }
407 
get_ddc_line(struct dc_link * link)408 static enum channel_id get_ddc_line(struct dc_link *link)
409 {
410 	struct ddc *ddc;
411 	enum channel_id channel;
412 
413 	channel = CHANNEL_ID_UNKNOWN;
414 
415 	ddc = get_ddc_pin(link->ddc);
416 
417 	if (ddc) {
418 		switch (dal_ddc_get_line(ddc)) {
419 		case GPIO_DDC_LINE_DDC1:
420 			channel = CHANNEL_ID_DDC1;
421 			break;
422 		case GPIO_DDC_LINE_DDC2:
423 			channel = CHANNEL_ID_DDC2;
424 			break;
425 		case GPIO_DDC_LINE_DDC3:
426 			channel = CHANNEL_ID_DDC3;
427 			break;
428 		case GPIO_DDC_LINE_DDC4:
429 			channel = CHANNEL_ID_DDC4;
430 			break;
431 		case GPIO_DDC_LINE_DDC5:
432 			channel = CHANNEL_ID_DDC5;
433 			break;
434 		case GPIO_DDC_LINE_DDC6:
435 			channel = CHANNEL_ID_DDC6;
436 			break;
437 		case GPIO_DDC_LINE_DDC_VGA:
438 			channel = CHANNEL_ID_DDC_VGA;
439 			break;
440 		case GPIO_DDC_LINE_I2C_PAD:
441 			channel = CHANNEL_ID_I2C_PAD;
442 			break;
443 		default:
444 			BREAK_TO_DEBUGGER();
445 			break;
446 		}
447 	}
448 
449 	return channel;
450 }
451 
construct_phy(struct dc_link * link,const struct link_init_data * init_params)452 static bool construct_phy(struct dc_link *link,
453 			      const struct link_init_data *init_params)
454 {
455 	uint8_t i;
456 	struct ddc_service_init_data ddc_service_init_data = { 0 };
457 	struct dc_context *dc_ctx = init_params->ctx;
458 	struct encoder_init_data enc_init_data = { 0 };
459 	struct panel_cntl_init_data panel_cntl_init_data = { 0 };
460 	struct dc_bios *bios = init_params->dc->ctx->dc_bios;
461 	const struct dc_vbios_funcs *bp_funcs = bios->funcs;
462 	struct bp_disp_connector_caps_info disp_connect_caps_info = { 0 };
463 
464 	DC_LOGGER_INIT(dc_ctx->logger);
465 
466 	link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
467 	link->irq_source_hpd_rx = DC_IRQ_SOURCE_INVALID;
468 	link->irq_source_read_request = DC_IRQ_SOURCE_INVALID;
469 	link->link_status.dpcd_caps = &link->dpcd_caps;
470 
471 	link->dc = init_params->dc;
472 	link->ctx = dc_ctx;
473 	link->link_index = init_params->link_index;
474 
475 	memset(&link->preferred_training_settings, 0,
476 	       sizeof(struct dc_link_training_overrides));
477 	memset(&link->preferred_link_setting, 0,
478 	       sizeof(struct dc_link_settings));
479 
480 	link->link_id =
481 		bios->funcs->get_connector_id(bios, init_params->connector_index);
482 
483 	link->ep_type = DISPLAY_ENDPOINT_PHY;
484 
485 	DC_LOG_DC("BIOS object table - link_id: %d", link->link_id.id);
486 
487 	if (bios->funcs->get_disp_connector_caps_info) {
488 		bios->funcs->get_disp_connector_caps_info(bios, link->link_id, &disp_connect_caps_info);
489 		link->is_internal_display = disp_connect_caps_info.INTERNAL_DISPLAY;
490 		DC_LOG_DC("BIOS object table - is_internal_display: %d", link->is_internal_display);
491 	}
492 
493 	if (link->link_id.type != OBJECT_TYPE_CONNECTOR) {
494 		dm_output_to_console("%s: Invalid Connector ObjectID from Adapter Service for connector index:%d! type %d expected %d\n",
495 				     __func__, init_params->connector_index,
496 				     link->link_id.type, OBJECT_TYPE_CONNECTOR);
497 		goto create_fail;
498 	}
499 
500 	if (link->dc->res_pool->funcs->link_init)
501 		link->dc->res_pool->funcs->link_init(link);
502 
503 	link->hpd_gpio = link_get_hpd_gpio(link->ctx->dc_bios, link->link_id,
504 				      link->ctx->gpio_service);
505 
506 	if (link->hpd_gpio) {
507 		dal_gpio_open(link->hpd_gpio, GPIO_MODE_INTERRUPT);
508 		dal_gpio_unlock_pin(link->hpd_gpio);
509 		link->irq_source_hpd = dal_irq_get_source(link->hpd_gpio);
510 
511 		DC_LOG_DC("BIOS object table - hpd_gpio id: %d", link->hpd_gpio->id);
512 		DC_LOG_DC("BIOS object table - hpd_gpio en: %d", link->hpd_gpio->en);
513 	}
514 
515 	switch (link->link_id.id) {
516 	case CONNECTOR_ID_HDMI_TYPE_A:
517 		link->connector_signal = SIGNAL_TYPE_HDMI_TYPE_A;
518 
519 		if (link->hpd_gpio)
520 			link->irq_source_read_request =
521 					dal_irq_get_read_request(link->hpd_gpio);
522 		break;
523 	case CONNECTOR_ID_SINGLE_LINK_DVID:
524 	case CONNECTOR_ID_SINGLE_LINK_DVII:
525 		link->connector_signal = SIGNAL_TYPE_DVI_SINGLE_LINK;
526 		break;
527 	case CONNECTOR_ID_DUAL_LINK_DVID:
528 	case CONNECTOR_ID_DUAL_LINK_DVII:
529 		link->connector_signal = SIGNAL_TYPE_DVI_DUAL_LINK;
530 		break;
531 	case CONNECTOR_ID_DISPLAY_PORT:
532 	case CONNECTOR_ID_MXM:
533 	case CONNECTOR_ID_USBC:
534 		link->connector_signal = SIGNAL_TYPE_DISPLAY_PORT;
535 
536 		if (link->hpd_gpio)
537 			link->irq_source_hpd_rx =
538 					dal_irq_get_rx_source(link->hpd_gpio);
539 
540 		break;
541 	case CONNECTOR_ID_EDP:
542 		// If smartmux is supported, only create the link on the primary eDP.
543 		// Dual eDP is not supported with smartmux.
544 		if (!(!link->dc->config.smart_mux_version || dc_ctx->dc_edp_id_count == 0))
545 			goto create_fail;
546 
547 		link->connector_signal = SIGNAL_TYPE_EDP;
548 
549 		if (link->hpd_gpio) {
550 			if (!link->dc->config.allow_edp_hotplug_detection
551 				&& !is_smartmux_suported(link))
552 				link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
553 
554 			switch (link->dc->config.allow_edp_hotplug_detection) {
555 			case HPD_EN_FOR_ALL_EDP:
556 				link->irq_source_hpd_rx =
557 						dal_irq_get_rx_source(link->hpd_gpio);
558 				break;
559 			case HPD_EN_FOR_PRIMARY_EDP_ONLY:
560 				if (link->link_index == 0)
561 					link->irq_source_hpd_rx =
562 						dal_irq_get_rx_source(link->hpd_gpio);
563 				else
564 					link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
565 				break;
566 			case HPD_EN_FOR_SECONDARY_EDP_ONLY:
567 				if (link->link_index == 1)
568 					link->irq_source_hpd_rx =
569 						dal_irq_get_rx_source(link->hpd_gpio);
570 				else
571 					link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
572 				break;
573 			default:
574 				link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
575 				break;
576 			}
577 		}
578 
579 		break;
580 	case CONNECTOR_ID_LVDS:
581 		link->connector_signal = SIGNAL_TYPE_LVDS;
582 		break;
583 	default:
584 		DC_LOG_WARNING("Unsupported Connector type:%d!\n",
585 			       link->link_id.id);
586 		goto create_fail;
587 	}
588 
589 	LINK_INFO("Connector[%d] description: signal: %s\n",
590 		  init_params->connector_index,
591 		  signal_type_to_string(link->connector_signal));
592 
593 	ddc_service_init_data.ctx = link->ctx;
594 	ddc_service_init_data.id = link->link_id;
595 	ddc_service_init_data.link = link;
596 	link->ddc = link_create_ddc_service(&ddc_service_init_data);
597 
598 	if (!link->ddc) {
599 		DC_ERROR("Failed to create ddc_service!\n");
600 		goto ddc_create_fail;
601 	}
602 
603 	if (!link->ddc->ddc_pin) {
604 		DC_ERROR("Failed to get I2C info for connector!\n");
605 		goto ddc_create_fail;
606 	}
607 
608 	link->ddc_hw_inst =
609 		dal_ddc_get_line(get_ddc_pin(link->ddc));
610 
611 	enc_init_data.ctx = dc_ctx;
612 	bp_funcs->get_src_obj(dc_ctx->dc_bios, link->link_id, 0,
613 			      &enc_init_data.encoder);
614 	enc_init_data.connector = link->link_id;
615 	enc_init_data.channel = get_ddc_line(link);
616 	enc_init_data.hpd_source = get_hpd_line(link);
617 
618 	link->hpd_src = enc_init_data.hpd_source;
619 
620 	enc_init_data.transmitter =
621 		translate_encoder_to_transmitter(enc_init_data.encoder);
622 	link->link_enc =
623 		link->dc->res_pool->funcs->link_enc_create(dc_ctx, &enc_init_data);
624 
625 	if (!link->link_enc) {
626 		DC_ERROR("Failed to create link encoder!\n");
627 		goto link_enc_create_fail;
628 	}
629 
630 	DC_LOG_DC("BIOS object table - DP_IS_USB_C: %d", link->link_enc->features.flags.bits.DP_IS_USB_C);
631 	DC_LOG_DC("BIOS object table - IS_DP2_CAPABLE: %d", link->link_enc->features.flags.bits.IS_DP2_CAPABLE);
632 
633 	/* Update link encoder tracking variables. These are used for the dynamic
634 	 * assignment of link encoders to streams.
635 	 */
636 	link->eng_id = link->link_enc->preferred_engine;
637 	link->dc->res_pool->link_encoders[link->eng_id - ENGINE_ID_DIGA] = link->link_enc;
638 	link->dc->res_pool->dig_link_enc_count++;
639 
640 	link->link_enc_hw_inst = link->link_enc->transmitter;
641 
642 	if (link->dc->res_pool->funcs->panel_cntl_create &&
643 		(link->link_id.id == CONNECTOR_ID_EDP ||
644 			link->link_id.id == CONNECTOR_ID_LVDS)) {
645 		panel_cntl_init_data.ctx = dc_ctx;
646 		panel_cntl_init_data.inst = panel_cntl_init_data.ctx->dc_edp_id_count;
647 		panel_cntl_init_data.eng_id = link->eng_id;
648 		link->panel_cntl =
649 			link->dc->res_pool->funcs->panel_cntl_create(
650 								&panel_cntl_init_data);
651 		panel_cntl_init_data.ctx->dc_edp_id_count++;
652 
653 		if (link->panel_cntl == NULL) {
654 			DC_ERROR("Failed to create link panel_cntl!\n");
655 			goto panel_cntl_create_fail;
656 		}
657 	}
658 	for (i = 0; i < 4; i++) {
659 		if (bp_funcs->get_device_tag(dc_ctx->dc_bios,
660 					     link->link_id, i,
661 					     &link->device_tag) != BP_RESULT_OK) {
662 			DC_ERROR("Failed to find device tag!\n");
663 			goto device_tag_fail;
664 		}
665 
666 		/* Look for device tag that matches connector signal,
667 		 * CRT for rgb, LCD for other supported signal types
668 		 */
669 		if (!bp_funcs->is_device_id_supported(dc_ctx->dc_bios,
670 						      link->device_tag.dev_id))
671 			continue;
672 		if (link->device_tag.dev_id.device_type == DEVICE_TYPE_CRT &&
673 		    link->connector_signal != SIGNAL_TYPE_RGB)
674 			continue;
675 		if (link->device_tag.dev_id.device_type == DEVICE_TYPE_LCD &&
676 		    link->connector_signal == SIGNAL_TYPE_RGB)
677 			continue;
678 
679 		DC_LOG_DC("BIOS object table - device_tag.acpi_device: %d", link->device_tag.acpi_device);
680 		DC_LOG_DC("BIOS object table - device_tag.dev_id.device_type: %d", link->device_tag.dev_id.device_type);
681 		DC_LOG_DC("BIOS object table - device_tag.dev_id.enum_id: %d", link->device_tag.dev_id.enum_id);
682 		break;
683 	}
684 
685 	if (bios->integrated_info) {
686 		/* Look for channel mapping corresponding to connector and device tag */
687 		for (i = 0; i < MAX_NUMBER_OF_EXT_DISPLAY_PATH; i++) {
688 			struct external_display_path *path =
689 				&bios->integrated_info->ext_disp_conn_info.path[i];
690 
691 			if (path->device_connector_id.enum_id == link->link_id.enum_id &&
692 			    path->device_connector_id.id == link->link_id.id &&
693 			    path->device_connector_id.type == link->link_id.type) {
694 				if (link->device_tag.acpi_device != 0 &&
695 				    path->device_acpi_enum == link->device_tag.acpi_device) {
696 					link->ddi_channel_mapping = path->channel_mapping;
697 					link->chip_caps = path->caps;
698 					DC_LOG_DC("BIOS object table - ddi_channel_mapping: 0x%04X",
699 						  link->ddi_channel_mapping.raw);
700 					DC_LOG_DC("BIOS object table - chip_caps: %d",
701 						  link->chip_caps);
702 				} else if (path->device_tag ==
703 					   link->device_tag.dev_id.raw_device_tag) {
704 					link->ddi_channel_mapping = path->channel_mapping;
705 					link->chip_caps = path->caps;
706 					DC_LOG_DC("BIOS object table - ddi_channel_mapping: 0x%04X",
707 						  link->ddi_channel_mapping.raw);
708 					DC_LOG_DC("BIOS object table - chip_caps: %d",
709 						  link->chip_caps);
710 				}
711 
712 				if ((link->chip_caps & AMD_EXT_DISPLAY_PATH_CAPS__EXT_CHIP_MASK) == AMD_EXT_DISPLAY_PATH_CAPS__DP_FIXED_VS_EN) {
713 					link->bios_forced_drive_settings.VOLTAGE_SWING =
714 						(bios->integrated_info->ext_disp_conn_info.fixdpvoltageswing & 0x3);
715 					link->bios_forced_drive_settings.PRE_EMPHASIS =
716 						((bios->integrated_info->ext_disp_conn_info.fixdpvoltageswing >> 2) & 0x3);
717 				}
718 
719 				break;
720 			}
721 		}
722 	}
723 	if (bios->funcs->get_atom_dc_golden_table)
724 		bios->funcs->get_atom_dc_golden_table(bios);
725 
726 	/*
727 	 * TODO check if GPIO programmed correctly
728 	 *
729 	 * If GPIO isn't programmed correctly HPD might not rise or drain
730 	 * fast enough, leading to bounces.
731 	 */
732 	program_hpd_filter(link);
733 
734 	link->psr_settings.psr_vtotal_control_support = false;
735 	link->psr_settings.psr_version = DC_PSR_VERSION_UNSUPPORTED;
736 
737 	DC_LOG_DC("BIOS object table - %s finished successfully.\n", __func__);
738 	return true;
739 device_tag_fail:
740 	link->link_enc->funcs->destroy(&link->link_enc);
741 link_enc_create_fail:
742 	if (link->panel_cntl != NULL)
743 		link->panel_cntl->funcs->destroy(&link->panel_cntl);
744 panel_cntl_create_fail:
745 	link_destroy_ddc_service(&link->ddc);
746 ddc_create_fail:
747 create_fail:
748 
749 	if (link->hpd_gpio) {
750 		dal_gpio_destroy_irq(&link->hpd_gpio);
751 		link->hpd_gpio = NULL;
752 	}
753 
754 	DC_LOG_DC("BIOS object table - %s failed.\n", __func__);
755 	return false;
756 }
757 
construct_dpia(struct dc_link * link,const struct link_init_data * init_params)758 static bool construct_dpia(struct dc_link *link,
759 			      const struct link_init_data *init_params)
760 {
761 	struct ddc_service_init_data ddc_service_init_data = { 0 };
762 	struct dc_context *dc_ctx = init_params->ctx;
763 
764 	DC_LOGGER_INIT(dc_ctx->logger);
765 
766 	/* Initialized irq source for hpd and hpd rx */
767 	link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
768 	link->irq_source_hpd_rx = DC_IRQ_SOURCE_INVALID;
769 	link->link_status.dpcd_caps = &link->dpcd_caps;
770 
771 	link->dc = init_params->dc;
772 	link->ctx = dc_ctx;
773 	link->link_index = init_params->link_index;
774 
775 	memset(&link->preferred_training_settings, 0,
776 	       sizeof(struct dc_link_training_overrides));
777 	memset(&link->preferred_link_setting, 0,
778 	       sizeof(struct dc_link_settings));
779 
780 	/* Dummy Init for linkid */
781 	link->link_id.type = OBJECT_TYPE_CONNECTOR;
782 	link->link_id.id = CONNECTOR_ID_DISPLAY_PORT;
783 	link->link_id.enum_id = ENUM_ID_1 + init_params->connector_index;
784 	link->is_internal_display = false;
785 	link->connector_signal = SIGNAL_TYPE_DISPLAY_PORT;
786 	LINK_INFO("Connector[%d] description:signal %d\n",
787 		  init_params->connector_index,
788 		  link->connector_signal);
789 
790 	link->ep_type = DISPLAY_ENDPOINT_USB4_DPIA;
791 	link->is_dig_mapping_flexible = true;
792 
793 	/* TODO: Initialize link : funcs->link_init */
794 
795 	ddc_service_init_data.ctx = link->ctx;
796 	ddc_service_init_data.id = link->link_id;
797 	ddc_service_init_data.link = link;
798 	/* Set indicator for dpia link so that ddc wont be created */
799 	ddc_service_init_data.is_dpia_link = true;
800 
801 	link->ddc = link_create_ddc_service(&ddc_service_init_data);
802 	if (!link->ddc) {
803 		DC_ERROR("Failed to create ddc_service!\n");
804 		goto ddc_create_fail;
805 	}
806 
807 	/* Set dpia port index : 0 to number of dpia ports */
808 	link->ddc_hw_inst = init_params->connector_index;
809 
810 	// Assign Dpia preferred eng_id
811 	if (link->dc->res_pool->funcs->get_preferred_eng_id_dpia)
812 		link->dpia_preferred_eng_id = link->dc->res_pool->funcs->get_preferred_eng_id_dpia(link->ddc_hw_inst);
813 
814 	/* TODO: Create link encoder */
815 
816 	link->psr_settings.psr_version = DC_PSR_VERSION_UNSUPPORTED;
817 
818 	/* Some docks seem to NAK I2C writes to segment pointer with mot=0. */
819 	link->wa_flags.dp_mot_reset_segment = true;
820 
821 	return true;
822 
823 ddc_create_fail:
824 	return false;
825 }
826 
link_construct(struct dc_link * link,const struct link_init_data * init_params)827 static bool link_construct(struct dc_link *link,
828 			      const struct link_init_data *init_params)
829 {
830 	/* Handle dpia case */
831 	if (init_params->is_dpia_link == true)
832 		return construct_dpia(link, init_params);
833 	else
834 		return construct_phy(link, init_params);
835 }
836 
link_create(const struct link_init_data * init_params)837 struct dc_link *link_create(const struct link_init_data *init_params)
838 {
839 	struct dc_link *link =
840 			kzalloc(sizeof(*link), GFP_KERNEL);
841 
842 	if (NULL == link)
843 		goto alloc_fail;
844 
845 	if (false == link_construct(link, init_params))
846 		goto construct_fail;
847 
848 	return link;
849 
850 construct_fail:
851 	kfree(link);
852 
853 alloc_fail:
854 	return NULL;
855 }
856 
link_destroy(struct dc_link ** link)857 void link_destroy(struct dc_link **link)
858 {
859 	link_destruct(*link);
860 	kfree(*link);
861 	*link = NULL;
862 }
863