582 static void radeon_dp_update_vs_emph(struct radeon_dp_link_train_info *dp_info)  in radeon_dp_update_vs_emph()  argument
585 	atombios_dig_transmitter_setup(dp_info->encoder,  in radeon_dp_update_vs_emph()
587 				       0, dp_info->train_set[0]); /* sets all lanes at once */  in radeon_dp_update_vs_emph()
590 	drm_dp_dpcd_write(dp_info->aux, DP_TRAINING_LANE0_SET,  in radeon_dp_update_vs_emph()
591 			  dp_info->train_set, dp_info->dp_lane_count);  in radeon_dp_update_vs_emph()
594 static void radeon_dp_set_tp(struct radeon_dp_link_train_info *dp_info, int tp)  in radeon_dp_set_tp()  argument
599 	if (ASIC_IS_DCE4(dp_info->rdev) || !dp_info->use_dpencoder) {  in radeon_dp_set_tp()
611 		atombios_dig_encoder_setup(dp_info->encoder, rtp, 0);  in radeon_dp_set_tp()
621 		radeon_dp_encoder_service(dp_info->rdev, ATOM_DP_ACTION_TRAINING_PATTERN_SEL,  in radeon_dp_set_tp()
622 					  dp_info->dp_clock, dp_info->enc_id, rtp);  in radeon_dp_set_tp()
626 	drm_dp_dpcd_writeb(dp_info->aux, DP_TRAINING_PATTERN_SET, tp);  in radeon_dp_set_tp()
629 static int radeon_dp_link_train_init(struct radeon_dp_link_train_info *dp_info)  in radeon_dp_link_train_init()  argument
631 	struct radeon_encoder *radeon_encoder = to_radeon_encoder(dp_info->encoder);  in radeon_dp_link_train_init()
636 	radeon_dp_set_rx_power_state(dp_info->connector, DP_SET_POWER_D0);  in radeon_dp_link_train_init()
639 	if (dp_info->dpcd[3] & 0x1)  in radeon_dp_link_train_init()
640 		drm_dp_dpcd_writeb(dp_info->aux,  in radeon_dp_link_train_init()
643 		drm_dp_dpcd_writeb(dp_info->aux,  in radeon_dp_link_train_init()
647 		drm_dp_dpcd_writeb(dp_info->aux, DP_EDP_CONFIGURATION_SET, 1);  in radeon_dp_link_train_init()
650 	tmp = dp_info->dp_lane_count;  in radeon_dp_link_train_init()
651 	if (drm_dp_enhanced_frame_cap(dp_info->dpcd))  in radeon_dp_link_train_init()
653 	drm_dp_dpcd_writeb(dp_info->aux, DP_LANE_COUNT_SET, tmp);  in radeon_dp_link_train_init()
656 	tmp = drm_dp_link_rate_to_bw_code(dp_info->dp_clock);  in radeon_dp_link_train_init()
657 	drm_dp_dpcd_writeb(dp_info->aux, DP_LINK_BW_SET, tmp);  in radeon_dp_link_train_init()
660 	if (ASIC_IS_DCE4(dp_info->rdev) || !dp_info->use_dpencoder)  in radeon_dp_link_train_init()
661 		atombios_dig_encoder_setup(dp_info->encoder,  in radeon_dp_link_train_init()
664 		radeon_dp_encoder_service(dp_info->rdev, ATOM_DP_ACTION_TRAINING_START,  in radeon_dp_link_train_init()
665 					  dp_info->dp_clock, dp_info->enc_id, 0);  in radeon_dp_link_train_init()
668 	drm_dp_dpcd_writeb(dp_info->aux,  in radeon_dp_link_train_init()
675 static int radeon_dp_link_train_finish(struct radeon_dp_link_train_info *dp_info)  in radeon_dp_link_train_finish()  argument
680 	drm_dp_dpcd_writeb(dp_info->aux,  in radeon_dp_link_train_finish()
685 	if (ASIC_IS_DCE4(dp_info->rdev) || !dp_info->use_dpencoder)  in radeon_dp_link_train_finish()
686 		atombios_dig_encoder_setup(dp_info->encoder,  in radeon_dp_link_train_finish()
689 		radeon_dp_encoder_service(dp_info->rdev, ATOM_DP_ACTION_TRAINING_COMPLETE,  in radeon_dp_link_train_finish()
690 					  dp_info->dp_clock, dp_info->enc_id, 0);  in radeon_dp_link_train_finish()
695 static int radeon_dp_link_train_cr(struct radeon_dp_link_train_info *dp_info)  in radeon_dp_link_train_cr()  argument
701 	radeon_dp_set_tp(dp_info, DP_TRAINING_PATTERN_1);  in radeon_dp_link_train_cr()
702 	memset(dp_info->train_set, 0, 4);  in radeon_dp_link_train_cr()
703 	radeon_dp_update_vs_emph(dp_info);  in radeon_dp_link_train_cr()
709 	dp_info->tries = 0;  in radeon_dp_link_train_cr()
712 		drm_dp_link_train_clock_recovery_delay(dp_info->dpcd);  in radeon_dp_link_train_cr()
714 		if (drm_dp_dpcd_read_link_status(dp_info->aux,  in radeon_dp_link_train_cr()
715 						 dp_info->link_status) <= 0) {  in radeon_dp_link_train_cr()
720 		if (drm_dp_clock_recovery_ok(dp_info->link_status, dp_info->dp_lane_count)) {  in radeon_dp_link_train_cr()
725 		for (i = 0; i < dp_info->dp_lane_count; i++) {  in radeon_dp_link_train_cr()
726 			if ((dp_info->train_set[i] & DP_TRAIN_MAX_SWING_REACHED) == 0)  in radeon_dp_link_train_cr()
729 		if (i == dp_info->dp_lane_count) {  in radeon_dp_link_train_cr()
734 		if ((dp_info->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK) == voltage) {  in radeon_dp_link_train_cr()
735 			++dp_info->tries;  in radeon_dp_link_train_cr()
736 			if (dp_info->tries == 5) {  in radeon_dp_link_train_cr()
741 			dp_info->tries = 0;  in radeon_dp_link_train_cr()
743 		voltage = dp_info->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK;  in radeon_dp_link_train_cr()
746 		dp_get_adjust_train(dp_info->link_status, dp_info->dp_lane_count, dp_info->train_set);  in radeon_dp_link_train_cr()
748 		radeon_dp_update_vs_emph(dp_info);  in radeon_dp_link_train_cr()
755 			  dp_info->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK,  in radeon_dp_link_train_cr()
756 			  (dp_info->train_set[0] & DP_TRAIN_PRE_EMPHASIS_MASK) >>  in radeon_dp_link_train_cr()
762 static int radeon_dp_link_train_ce(struct radeon_dp_link_train_info *dp_info)  in radeon_dp_link_train_ce()  argument
766 	if (dp_info->tp3_supported)  in radeon_dp_link_train_ce()
767 		radeon_dp_set_tp(dp_info, DP_TRAINING_PATTERN_3);  in radeon_dp_link_train_ce()
769 		radeon_dp_set_tp(dp_info, DP_TRAINING_PATTERN_2);  in radeon_dp_link_train_ce()
772 	dp_info->tries = 0;  in radeon_dp_link_train_ce()
775 		drm_dp_link_train_channel_eq_delay(dp_info->dpcd);  in radeon_dp_link_train_ce()
777 		if (drm_dp_dpcd_read_link_status(dp_info->aux,  in radeon_dp_link_train_ce()
778 						 dp_info->link_status) <= 0) {  in radeon_dp_link_train_ce()
783 		if (drm_dp_channel_eq_ok(dp_info->link_status, dp_info->dp_lane_count)) {  in radeon_dp_link_train_ce()
789 		if (dp_info->tries > 5) {  in radeon_dp_link_train_ce()
795 		dp_get_adjust_train(dp_info->link_status, dp_info->dp_lane_count, dp_info->train_set);  in radeon_dp_link_train_ce()
797 		radeon_dp_update_vs_emph(dp_info);  in radeon_dp_link_train_ce()
798 		dp_info->tries++;  in radeon_dp_link_train_ce()
806 			  dp_info->train_set[0] & DP_TRAIN_VOLTAGE_SWING_MASK,  in radeon_dp_link_train_ce()
807 			  (dp_info->train_set[0] & DP_TRAIN_PRE_EMPHASIS_MASK)  in radeon_dp_link_train_ce()
822 	struct radeon_dp_link_train_info dp_info;  in radeon_dp_link_train()  local
843 	dp_info.use_dpencoder = true;  in radeon_dp_link_train()
847 			dp_info.use_dpencoder = false;  in radeon_dp_link_train()
851 	dp_info.enc_id = 0;  in radeon_dp_link_train()
853 		dp_info.enc_id |= ATOM_DP_CONFIG_DIG2_ENCODER;  in radeon_dp_link_train()
855 		dp_info.enc_id |= ATOM_DP_CONFIG_DIG1_ENCODER;  in radeon_dp_link_train()
857 		dp_info.enc_id |= ATOM_DP_CONFIG_LINK_B;  in radeon_dp_link_train()
859 		dp_info.enc_id |= ATOM_DP_CONFIG_LINK_A;  in radeon_dp_link_train()
864 			dp_info.tp3_supported = true;  in radeon_dp_link_train()
866 			dp_info.tp3_supported = false;  in radeon_dp_link_train()
868 		dp_info.tp3_supported = false;  in radeon_dp_link_train()
871 	memcpy(dp_info.dpcd, dig_connector->dpcd, DP_RECEIVER_CAP_SIZE);  in radeon_dp_link_train()
872 	dp_info.rdev = rdev;  in radeon_dp_link_train()
873 	dp_info.encoder = encoder;  in radeon_dp_link_train()
874 	dp_info.connector = connector;  in radeon_dp_link_train()
875 	dp_info.dp_lane_count = dig_connector->dp_lane_count;  in radeon_dp_link_train()
876 	dp_info.dp_clock = dig_connector->dp_clock;  in radeon_dp_link_train()
877 	dp_info.aux = &radeon_connector->ddc_bus->aux;  in radeon_dp_link_train()
879 	if (radeon_dp_link_train_init(&dp_info))  in radeon_dp_link_train()
881 	if (radeon_dp_link_train_cr(&dp_info))  in radeon_dp_link_train()
883 	if (radeon_dp_link_train_ce(&dp_info))  in radeon_dp_link_train()
886 	if (radeon_dp_link_train_finish(&dp_info))  in radeon_dp_link_train()