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 | #include "link_hwss_hpo_dp.h" |
26 | #include "link_hwss_hpo_fixed_vs_pe_retimer_dp.h" |
27 | #include "link_hwss_dio_fixed_vs_pe_retimer.h" |
28 | |
29 | static void dp_hpo_fixed_vs_pe_retimer_set_tx_ffe(struct dc_link *link, |
30 | const struct dc_lane_settings *hw_lane_settings) |
31 | { |
32 | const uint8_t vendor_ffe_preset_table[16] = { |
33 | 0x01, 0x41, 0x61, 0x81, |
34 | 0xB1, 0x05, 0x35, 0x65, |
35 | 0x85, 0xA5, 0x09, 0x39, |
36 | 0x59, 0x89, 0x0F, 0x24}; |
37 | |
38 | const uint8_t ffe_mask[4] = { |
39 | (hw_lane_settings[0].FFE_PRESET.settings.no_deemphasis != 0 ? 0x0F : 0xFF) |
40 | & (hw_lane_settings[0].FFE_PRESET.settings.no_preshoot != 0 ? 0xF1 : 0xFF), |
41 | (hw_lane_settings[1].FFE_PRESET.settings.no_deemphasis != 0 ? 0x0F : 0xFF) |
42 | & (hw_lane_settings[1].FFE_PRESET.settings.no_preshoot != 0 ? 0xF1 : 0xFF), |
43 | (hw_lane_settings[2].FFE_PRESET.settings.no_deemphasis != 0 ? 0x0F : 0xFF) |
44 | & (hw_lane_settings[2].FFE_PRESET.settings.no_preshoot != 0 ? 0xF1 : 0xFF), |
45 | (hw_lane_settings[3].FFE_PRESET.settings.no_deemphasis != 0 ? 0x0F : 0xFF) |
46 | & (hw_lane_settings[3].FFE_PRESET.settings.no_preshoot != 0 ? 0xF1 : 0xFF)}; |
47 | |
48 | const uint8_t ffe_cfg[4] = { |
49 | vendor_ffe_preset_table[hw_lane_settings[0].FFE_PRESET.settings.level] & ffe_mask[0], |
50 | vendor_ffe_preset_table[hw_lane_settings[1].FFE_PRESET.settings.level] & ffe_mask[1], |
51 | vendor_ffe_preset_table[hw_lane_settings[2].FFE_PRESET.settings.level] & ffe_mask[2], |
52 | vendor_ffe_preset_table[hw_lane_settings[3].FFE_PRESET.settings.level] & ffe_mask[3]}; |
53 | |
54 | const uint8_t dp_type = dp_dio_fixed_vs_pe_retimer_lane_cfg_to_hw_cfg(link); |
55 | |
56 | const uint8_t vendor_lttpr_write_data_ffe1[4] = {0x01, 0x50, dp_type, 0x0F}; |
57 | const uint8_t vendor_lttpr_write_data_ffe2[4] = {0x01, 0x55, dp_type, ffe_cfg[0]}; |
58 | const uint8_t vendor_lttpr_write_data_ffe3[4] = {0x01, 0x56, dp_type, ffe_cfg[1]}; |
59 | const uint8_t vendor_lttpr_write_data_ffe4[4] = {0x01, 0x57, dp_type, ffe_cfg[2]}; |
60 | const uint8_t vendor_lttpr_write_data_ffe5[4] = {0x01, 0x58, dp_type, ffe_cfg[3]}; |
61 | |
62 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
63 | &vendor_lttpr_write_data_ffe1[0], sizeof(vendor_lttpr_write_data_ffe1)); |
64 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
65 | &vendor_lttpr_write_data_ffe2[0], sizeof(vendor_lttpr_write_data_ffe2)); |
66 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
67 | &vendor_lttpr_write_data_ffe3[0], sizeof(vendor_lttpr_write_data_ffe3)); |
68 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
69 | &vendor_lttpr_write_data_ffe4[0], sizeof(vendor_lttpr_write_data_ffe4)); |
70 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
71 | &vendor_lttpr_write_data_ffe5[0], sizeof(vendor_lttpr_write_data_ffe5)); |
72 | } |
73 | |
74 | static void dp_hpo_fixed_vs_pe_retimer_program_override_test_pattern(struct dc_link *link, |
75 | struct encoder_set_dp_phy_pattern_param *tp_params) |
76 | { |
77 | uint8_t clk_src = 0x4C; |
78 | uint8_t pattern = 0x4F; /* SQ128 */ |
79 | |
80 | const uint8_t vendor_lttpr_write_data_pg0[4] = {0x1, 0x11, 0x0, 0x0}; |
81 | const uint8_t vendor_lttpr_write_data_pg1[4] = {0x1, 0x50, 0x50, clk_src}; |
82 | const uint8_t vendor_lttpr_write_data_pg2[4] = {0x1, 0x51, 0x50, clk_src}; |
83 | const uint8_t vendor_lttpr_write_data_pg3[4] = {0x1, 0x10, 0x58, 0x21}; |
84 | const uint8_t vendor_lttpr_write_data_pg4[4] = {0x1, 0x10, 0x59, 0x21}; |
85 | const uint8_t vendor_lttpr_write_data_pg5[4] = {0x1, 0x1C, 0x58, pattern}; |
86 | const uint8_t vendor_lttpr_write_data_pg6[4] = {0x1, 0x1C, 0x59, pattern}; |
87 | const uint8_t vendor_lttpr_write_data_pg7[4] = {0x1, 0x30, 0x51, 0x20}; |
88 | const uint8_t vendor_lttpr_write_data_pg8[4] = {0x1, 0x30, 0x52, 0x20}; |
89 | const uint8_t vendor_lttpr_write_data_pg9[4] = {0x1, 0x30, 0x54, 0x20}; |
90 | const uint8_t vendor_lttpr_write_data_pg10[4] = {0x1, 0x30, 0x55, 0x20}; |
91 | |
92 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
93 | &vendor_lttpr_write_data_pg0[0], sizeof(vendor_lttpr_write_data_pg0)); |
94 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
95 | &vendor_lttpr_write_data_pg1[0], sizeof(vendor_lttpr_write_data_pg1)); |
96 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
97 | &vendor_lttpr_write_data_pg2[0], sizeof(vendor_lttpr_write_data_pg2)); |
98 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
99 | &vendor_lttpr_write_data_pg3[0], sizeof(vendor_lttpr_write_data_pg3)); |
100 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
101 | &vendor_lttpr_write_data_pg4[0], sizeof(vendor_lttpr_write_data_pg4)); |
102 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
103 | &vendor_lttpr_write_data_pg5[0], sizeof(vendor_lttpr_write_data_pg5)); |
104 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
105 | &vendor_lttpr_write_data_pg6[0], sizeof(vendor_lttpr_write_data_pg6)); |
106 | |
107 | if (link->cur_link_settings.lane_count == LANE_COUNT_FOUR) |
108 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
109 | &vendor_lttpr_write_data_pg7[0], sizeof(vendor_lttpr_write_data_pg7)); |
110 | |
111 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
112 | &vendor_lttpr_write_data_pg8[0], sizeof(vendor_lttpr_write_data_pg8)); |
113 | |
114 | if (link->cur_link_settings.lane_count == LANE_COUNT_FOUR) |
115 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
116 | &vendor_lttpr_write_data_pg9[0], sizeof(vendor_lttpr_write_data_pg9)); |
117 | |
118 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
119 | &vendor_lttpr_write_data_pg10[0], sizeof(vendor_lttpr_write_data_pg10)); |
120 | } |
121 | |
122 | static bool dp_hpo_fixed_vs_pe_retimer_set_override_test_pattern(struct dc_link *link, |
123 | const struct link_resource *link_res, struct encoder_set_dp_phy_pattern_param *tp_params, |
124 | const struct link_hwss *link_hwss) |
125 | { |
126 | struct encoder_set_dp_phy_pattern_param hw_tp_params = { 0 }; |
127 | const uint8_t vendor_lttpr_exit_manual_automation_0[4] = {0x1, 0x11, 0x0, 0x06}; |
128 | |
129 | if (!link->dpcd_caps.lttpr_caps.main_link_channel_coding.bits.DP_128b_132b_SUPPORTED) |
130 | return false; |
131 | |
132 | if (tp_params == NULL) |
133 | return false; |
134 | |
135 | if (!IS_DP_PHY_SQUARE_PATTERN(tp_params->dp_phy_pattern)) { |
136 | // Deprogram overrides from previously set square wave override |
137 | if (link->current_test_pattern == DP_TEST_PATTERN_80BIT_CUSTOM || |
138 | link->current_test_pattern == DP_TEST_PATTERN_D102) |
139 | link->dc->link_srv->configure_fixed_vs_pe_retimer(link->ddc, |
140 | &vendor_lttpr_exit_manual_automation_0[0], |
141 | sizeof(vendor_lttpr_exit_manual_automation_0)); |
142 | else if (IS_DP_PHY_SQUARE_PATTERN(link->current_test_pattern)) |
143 | dp_dio_fixed_vs_pe_retimer_exit_manual_automation(link); |
144 | |
145 | return false; |
146 | } |
147 | |
148 | hw_tp_params.dp_phy_pattern = DP_TEST_PATTERN_PRBS31; |
149 | hw_tp_params.dp_panel_mode = tp_params->dp_panel_mode; |
150 | |
151 | if (link_hwss->ext.set_dp_link_test_pattern) |
152 | link_hwss->ext.set_dp_link_test_pattern(link, link_res, &hw_tp_params); |
153 | |
154 | dp_hpo_fixed_vs_pe_retimer_program_override_test_pattern(link, tp_params); |
155 | |
156 | return true; |
157 | } |
158 | |
159 | static void set_hpo_fixed_vs_pe_retimer_dp_link_test_pattern(struct dc_link *link, |
160 | const struct link_resource *link_res, |
161 | struct encoder_set_dp_phy_pattern_param *tp_params) |
162 | { |
163 | if (!dp_hpo_fixed_vs_pe_retimer_set_override_test_pattern( |
164 | link, link_res, tp_params, link_hwss: get_hpo_dp_link_hwss())) { |
165 | link_res->hpo_dp_link_enc->funcs->set_link_test_pattern( |
166 | link_res->hpo_dp_link_enc, tp_params); |
167 | } |
168 | link->dc->link_srv->dp_trace_source_sequence(link, DPCD_SOURCE_SEQ_AFTER_SET_SOURCE_PATTERN); |
169 | } |
170 | |
171 | static void set_hpo_fixed_vs_pe_retimer_dp_lane_settings(struct dc_link *link, |
172 | const struct link_resource *link_res, |
173 | const struct dc_link_settings *link_settings, |
174 | const struct dc_lane_settings lane_settings[LANE_COUNT_DP_MAX]) |
175 | { |
176 | // Don't update our HW FFE when outputting phy test patterns |
177 | if (IS_DP_PHY_PATTERN(link->pending_test_pattern)) { |
178 | // Directly program FIXED_VS retimer FFE for SQ128 override |
179 | if (IS_DP_PHY_SQUARE_PATTERN(link->pending_test_pattern)) { |
180 | dp_hpo_fixed_vs_pe_retimer_set_tx_ffe(link, hw_lane_settings: &lane_settings[0]); |
181 | } |
182 | } else { |
183 | link_res->hpo_dp_link_enc->funcs->set_ffe( |
184 | link_res->hpo_dp_link_enc, |
185 | link_settings, |
186 | lane_settings[0].FFE_PRESET.raw); |
187 | } |
188 | } |
189 | |
190 | static void enable_hpo_fixed_vs_pe_retimer_dp_link_output(struct dc_link *link, |
191 | const struct link_resource *link_res, |
192 | enum signal_type signal, |
193 | enum clock_source_id clock_source, |
194 | const struct dc_link_settings *link_settings) |
195 | { |
196 | if (link_settings->lane_count == LANE_COUNT_FOUR) |
197 | enable_dio_fixed_vs_pe_retimer_program_4lane_output(link); |
198 | |
199 | enable_hpo_dp_link_output(link, link_res, signal, clock_source, link_settings); |
200 | } |
201 | |
202 | static const struct link_hwss hpo_fixed_vs_pe_retimer_dp_link_hwss = { |
203 | .setup_stream_encoder = setup_hpo_dp_stream_encoder, |
204 | .reset_stream_encoder = reset_hpo_dp_stream_encoder, |
205 | .setup_stream_attribute = setup_hpo_dp_stream_attribute, |
206 | .disable_link_output = disable_hpo_dp_link_output, |
207 | .setup_audio_output = setup_hpo_dp_audio_output, |
208 | .enable_audio_packet = enable_hpo_dp_audio_packet, |
209 | .disable_audio_packet = disable_hpo_dp_audio_packet, |
210 | .ext = { |
211 | .set_throttled_vcp_size = set_hpo_dp_throttled_vcp_size, |
212 | .set_hblank_min_symbol_width = set_hpo_dp_hblank_min_symbol_width, |
213 | .enable_dp_link_output = enable_hpo_fixed_vs_pe_retimer_dp_link_output, |
214 | .set_dp_link_test_pattern = set_hpo_fixed_vs_pe_retimer_dp_link_test_pattern, |
215 | .set_dp_lane_settings = set_hpo_fixed_vs_pe_retimer_dp_lane_settings, |
216 | .update_stream_allocation_table = update_hpo_dp_stream_allocation_table, |
217 | }, |
218 | }; |
219 | |
220 | bool requires_fixed_vs_pe_retimer_hpo_link_hwss(const struct dc_link *link) |
221 | { |
222 | return requires_fixed_vs_pe_retimer_dio_link_hwss(link); |
223 | } |
224 | |
225 | const struct link_hwss *get_hpo_fixed_vs_pe_retimer_dp_link_hwss(void) |
226 | { |
227 | return &hpo_fixed_vs_pe_retimer_dp_link_hwss; |
228 | } |
229 | |