1 /*
2  * Copyright 2018 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 #include "mod_info_packet.h"
27 #include "core_types.h"
28 #include "dc_types.h"
29 #include "mod_shared.h"
30 #include "mod_freesync.h"
31 #include "dc.h"
32 
33 enum vsc_packet_revision {
34 	vsc_packet_undefined = 0,
35 	//01h = VSC SDP supports only 3D stereo.
36 	vsc_packet_rev1 = 1,
37 	//02h = 3D stereo + PSR.
38 	vsc_packet_rev2 = 2,
39 	//03h = 3D stereo + PSR2.
40 	vsc_packet_rev3 = 3,
41 	//04h = 3D stereo + PSR/PSR2 + Y-coordinate.
42 	vsc_packet_rev4 = 4,
43 	//05h = 3D stereo + PSR/PSR2 + Y-coordinate + Pixel Encoding/Colorimetry Format
44 	vsc_packet_rev5 = 5,
45 };
46 
47 #define HDMI_INFOFRAME_TYPE_VENDOR 0x81
48 #define HF_VSIF_VERSION 1
49 
50 // VTEM Byte Offset
51 #define VTEM_PB0		0
52 #define VTEM_PB1		1
53 #define VTEM_PB2		2
54 #define VTEM_PB3		3
55 #define VTEM_PB4		4
56 #define VTEM_PB5		5
57 #define VTEM_PB6		6
58 
59 #define VTEM_MD0		7
60 #define VTEM_MD1		8
61 #define VTEM_MD2		9
62 #define VTEM_MD3		10
63 
64 
65 // VTEM Byte Masks
66 //PB0
67 #define MASK_VTEM_PB0__RESERVED0  0x01
68 #define MASK_VTEM_PB0__SYNC       0x02
69 #define MASK_VTEM_PB0__VFR        0x04
70 #define MASK_VTEM_PB0__AFR        0x08
71 #define MASK_VTEM_PB0__DS_TYPE    0x30
72 	//0: Periodic pseudo-static EM Data Set
73 	//1: Periodic dynamic EM Data Set
74 	//2: Unique EM Data Set
75 	//3: Reserved
76 #define MASK_VTEM_PB0__END        0x40
77 #define MASK_VTEM_PB0__NEW        0x80
78 
79 //PB1
80 #define MASK_VTEM_PB1__RESERVED1 0xFF
81 
82 //PB2
83 #define MASK_VTEM_PB2__ORGANIZATION_ID 0xFF
84 	//0: This is a Vendor Specific EM Data Set
85 	//1: This EM Data Set is defined by This Specification (HDMI 2.1 r102.clean)
86 	//2: This EM Data Set is defined by CTA-861-G
87 	//3: This EM Data Set is defined by VESA
88 //PB3
89 #define MASK_VTEM_PB3__DATA_SET_TAG_MSB    0xFF
90 //PB4
91 #define MASK_VTEM_PB4__DATA_SET_TAG_LSB    0xFF
92 //PB5
93 #define MASK_VTEM_PB5__DATA_SET_LENGTH_MSB 0xFF
94 //PB6
95 #define MASK_VTEM_PB6__DATA_SET_LENGTH_LSB 0xFF
96 
97 
98 
99 //PB7-27 (20 bytes):
100 //PB7 = MD0
101 #define MASK_VTEM_MD0__VRR_EN         0x01
102 #define MASK_VTEM_MD0__M_CONST        0x02
103 #define MASK_VTEM_MD0__QMS_EN         0x04
104 #define MASK_VTEM_MD0__RESERVED2      0x08
105 #define MASK_VTEM_MD0__FVA_FACTOR_M1  0xF0
106 
107 //MD1
108 #define MASK_VTEM_MD1__BASE_VFRONT    0xFF
109 
110 //MD2
111 #define MASK_VTEM_MD2__BASE_REFRESH_RATE_98  0x03
112 #define MASK_VTEM_MD2__RB                    0x04
113 #define MASK_VTEM_MD2__NEXT_TFR              0xF8
114 
115 //MD3
116 #define MASK_VTEM_MD3__BASE_REFRESH_RATE_07  0xFF
117 
118 enum ColorimetryRGBDP {
119 	ColorimetryRGB_DP_sRGB               = 0,
120 	ColorimetryRGB_DP_AdobeRGB           = 3,
121 	ColorimetryRGB_DP_P3                 = 4,
122 	ColorimetryRGB_DP_CustomColorProfile = 5,
123 	ColorimetryRGB_DP_ITU_R_BT2020RGB    = 6,
124 };
125 enum ColorimetryYCCDP {
126 	ColorimetryYCC_DP_ITU601        = 0,
127 	ColorimetryYCC_DP_ITU709        = 1,
128 	ColorimetryYCC_DP_AdobeYCC      = 5,
129 	ColorimetryYCC_DP_ITU2020YCC    = 6,
130 	ColorimetryYCC_DP_ITU2020YCbCr  = 7,
131 };
132 
mod_build_vsc_infopacket(const struct dc_stream_state * stream,struct dc_info_packet * info_packet,enum dc_color_space cs,enum color_transfer_func tf)133 void mod_build_vsc_infopacket(const struct dc_stream_state *stream,
134 		struct dc_info_packet *info_packet,
135 		enum dc_color_space cs,
136 		enum color_transfer_func tf)
137 {
138 	unsigned int vsc_packet_revision = vsc_packet_undefined;
139 	unsigned int i;
140 	unsigned int pixelEncoding = 0;
141 	unsigned int colorimetryFormat = 0;
142 	bool stereo3dSupport = false;
143 
144 	if (stream->timing.timing_3d_format != TIMING_3D_FORMAT_NONE && stream->view_format != VIEW_3D_FORMAT_NONE) {
145 		vsc_packet_revision = vsc_packet_rev1;
146 		stereo3dSupport = true;
147 	}
148 
149 	/* VSC packet set to 4 for PSR-SU, or 2 for PSR1 */
150 	if (stream->link->psr_settings.psr_feature_enabled) {
151 		if (stream->link->psr_settings.psr_version == DC_PSR_VERSION_SU_1)
152 			vsc_packet_revision = vsc_packet_rev4;
153 		else if (stream->link->psr_settings.psr_version == DC_PSR_VERSION_1)
154 			vsc_packet_revision = vsc_packet_rev2;
155 	}
156 
157 	if (stream->link->replay_settings.config.replay_supported)
158 		vsc_packet_revision = vsc_packet_rev4;
159 
160 	/* Update to revision 5 for extended colorimetry support */
161 	if (stream->use_vsc_sdp_for_colorimetry)
162 		vsc_packet_revision = vsc_packet_rev5;
163 
164 	/* VSC packet not needed based on the features
165 	 * supported by this DP display
166 	 */
167 	if (vsc_packet_revision == vsc_packet_undefined)
168 		return;
169 
170 	if (vsc_packet_revision == vsc_packet_rev4) {
171 		/* Secondary-data Packet ID = 0*/
172 		info_packet->hb0 = 0x00;
173 		/* 07h - Packet Type Value indicating Video
174 		 * Stream Configuration packet
175 		 */
176 		info_packet->hb1 = 0x07;
177 		/* 04h = VSC SDP supporting 3D stereo + PSR/PSR2 + Y-coordinate
178 		 * (applies to eDP v1.4 or higher).
179 		 */
180 		info_packet->hb2 = 0x04;
181 		/* 0Eh = VSC SDP supporting 3D stereo + PSR2
182 		 * (HB2 = 04h), with Y-coordinate of first scan
183 		 * line of the SU region
184 		 */
185 		info_packet->hb3 = 0x0E;
186 
187 		for (i = 0; i < 28; i++)
188 			info_packet->sb[i] = 0;
189 
190 		info_packet->valid = true;
191 	}
192 
193 	if (vsc_packet_revision == vsc_packet_rev2) {
194 		/* Secondary-data Packet ID = 0*/
195 		info_packet->hb0 = 0x00;
196 		/* 07h - Packet Type Value indicating Video
197 		 * Stream Configuration packet
198 		 */
199 		info_packet->hb1 = 0x07;
200 		/* 02h = VSC SDP supporting 3D stereo and PSR
201 		 * (applies to eDP v1.3 or higher).
202 		 */
203 		info_packet->hb2 = 0x02;
204 		/* 08h = VSC packet supporting 3D stereo + PSR
205 		 * (HB2 = 02h).
206 		 */
207 		info_packet->hb3 = 0x08;
208 
209 		for (i = 0; i < 28; i++)
210 			info_packet->sb[i] = 0;
211 
212 		info_packet->valid = true;
213 	}
214 
215 	if (vsc_packet_revision == vsc_packet_rev1) {
216 
217 		info_packet->hb0 = 0x00;	// Secondary-data Packet ID = 0
218 		info_packet->hb1 = 0x07;	// 07h = Packet Type Value indicating Video Stream Configuration packet
219 		info_packet->hb2 = 0x01;	// 01h = Revision number. VSC SDP supporting 3D stereo only
220 		info_packet->hb3 = 0x01;	// 01h = VSC SDP supporting 3D stereo only (HB2 = 01h).
221 
222 		info_packet->valid = true;
223 	}
224 
225 	if (stereo3dSupport) {
226 		/* ==============================================================================================================|
227 		 * A. STEREO 3D
228 		 * ==============================================================================================================|
229 		 * VSC Payload (1 byte) From DP1.2 spec
230 		 *
231 		 * Bits 3:0 (Stereo Interface Method Code)  |  Bits 7:4 (Stereo Interface Method Specific Parameter)
232 		 * -----------------------------------------------------------------------------------------------------
233 		 * 0 = Non Stereo Video                     |  Must be set to 0x0
234 		 * -----------------------------------------------------------------------------------------------------
235 		 * 1 = Frame/Field Sequential               |  0x0: L + R view indication based on MISC1 bit 2:1
236 		 *                                          |  0x1: Right when Stereo Signal = 1
237 		 *                                          |  0x2: Left when Stereo Signal = 1
238 		 *                                          |  (others reserved)
239 		 * -----------------------------------------------------------------------------------------------------
240 		 * 2 = Stacked Frame                        |  0x0: Left view is on top and right view on bottom
241 		 *                                          |  (others reserved)
242 		 * -----------------------------------------------------------------------------------------------------
243 		 * 3 = Pixel Interleaved                    |  0x0: horiz interleaved, right view pixels on even lines
244 		 *                                          |  0x1: horiz interleaved, right view pixels on odd lines
245 		 *                                          |  0x2: checker board, start with left view pixel
246 		 *                                          |  0x3: vertical interleaved, start with left view pixels
247 		 *                                          |  0x4: vertical interleaved, start with right view pixels
248 		 *                                          |  (others reserved)
249 		 * -----------------------------------------------------------------------------------------------------
250 		 * 4 = Side-by-side                         |  0x0: left half represents left eye view
251 		 *                                          |  0x1: left half represents right eye view
252 		 */
253 		switch (stream->timing.timing_3d_format) {
254 		case TIMING_3D_FORMAT_HW_FRAME_PACKING:
255 		case TIMING_3D_FORMAT_SW_FRAME_PACKING:
256 		case TIMING_3D_FORMAT_TOP_AND_BOTTOM:
257 		case TIMING_3D_FORMAT_TB_SW_PACKED:
258 			info_packet->sb[0] = 0x02; // Stacked Frame, Left view is on top and right view on bottom.
259 			break;
260 		case TIMING_3D_FORMAT_DP_HDMI_INBAND_FA:
261 		case TIMING_3D_FORMAT_INBAND_FA:
262 			info_packet->sb[0] = 0x01; // Frame/Field Sequential, L + R view indication based on MISC1 bit 2:1
263 			break;
264 		case TIMING_3D_FORMAT_SIDE_BY_SIDE:
265 		case TIMING_3D_FORMAT_SBS_SW_PACKED:
266 			info_packet->sb[0] = 0x04; // Side-by-side
267 			break;
268 		default:
269 			info_packet->sb[0] = 0x00; // No Stereo Video, Shall be cleared to 0x0.
270 			break;
271 		}
272 
273 	}
274 
275 	/* 05h = VSC SDP supporting 3D stereo, PSR2, and Pixel Encoding/Colorimetry Format indication.
276 	 *   Added in DP1.3, a DP Source device is allowed to indicate the pixel encoding/colorimetry
277 	 *   format to the DP Sink device with VSC SDP only when the DP Sink device supports it
278 	 *   (i.e., VSC_SDP_EXTENSION_FOR_COLORIMETRY_SUPPORTED bit in the DPRX_FEATURE_ENUMERATION_LIST
279 	 *   register (DPCD Address 02210h, bit 3) is set to 1).
280 	 *   (Requires VSC_SDP_EXTENSION_FOR_COLORIMETRY_SUPPORTED bit set to 1 in DPCD 02210h. This
281 	 *   DPCD register is exposed in the new Extended Receiver Capability field for DPCD Rev. 1.4
282 	 *   (and higher). When MISC1. bit 6. is Set to 1, a Source device uses a VSC SDP to indicate
283 	 *   the Pixel Encoding/Colorimetry Format and that a Sink device must ignore MISC1, bit 7, and
284 	 *   MISC0, bits 7:1 (MISC1, bit 7. and MISC0, bits 7:1 become "don't care").)
285 	 */
286 	if (vsc_packet_revision == vsc_packet_rev5) {
287 		/* Secondary-data Packet ID = 0 */
288 		info_packet->hb0 = 0x00;
289 		/* 07h - Packet Type Value indicating Video Stream Configuration packet */
290 		info_packet->hb1 = 0x07;
291 		/* 05h = VSC SDP supporting 3D stereo, PSR2, and Pixel Encoding/Colorimetry Format indication. */
292 		info_packet->hb2 = 0x05;
293 		/* 13h = VSC SDP supporting 3D stereo, + PSR2, + Pixel Encoding/Colorimetry Format indication (HB2 = 05h). */
294 		info_packet->hb3 = 0x13;
295 
296 		info_packet->valid = true;
297 
298 		/* Set VSC SDP fields for pixel encoding and colorimetry format from DP 1.3 specs
299 		 * Data Bytes DB 18~16
300 		 * Bits 3:0 (Colorimetry Format)        |  Bits 7:4 (Pixel Encoding)
301 		 * ----------------------------------------------------------------------------------------------------
302 		 * 0x0 = sRGB                           |  0 = RGB
303 		 * 0x1 = RGB Wide Gamut Fixed Point
304 		 * 0x2 = RGB Wide Gamut Floating Point
305 		 * 0x3 = AdobeRGB
306 		 * 0x4 = DCI-P3
307 		 * 0x5 = CustomColorProfile
308 		 * (others reserved)
309 		 * ----------------------------------------------------------------------------------------------------
310 		 * 0x0 = ITU-R BT.601                   |  1 = YCbCr444
311 		 * 0x1 = ITU-R BT.709
312 		 * 0x2 = xvYCC601
313 		 * 0x3 = xvYCC709
314 		 * 0x4 = sYCC601
315 		 * 0x5 = AdobeYCC601
316 		 * 0x6 = ITU-R BT.2020 Y'cC'bcC'rc
317 		 * 0x7 = ITU-R BT.2020 Y'C'bC'r
318 		 * (others reserved)
319 		 * ----------------------------------------------------------------------------------------------------
320 		 * 0x0 = ITU-R BT.601                   |  2 = YCbCr422
321 		 * 0x1 = ITU-R BT.709
322 		 * 0x2 = xvYCC601
323 		 * 0x3 = xvYCC709
324 		 * 0x4 = sYCC601
325 		 * 0x5 = AdobeYCC601
326 		 * 0x6 = ITU-R BT.2020 Y'cC'bcC'rc
327 		 * 0x7 = ITU-R BT.2020 Y'C'bC'r
328 		 * (others reserved)
329 		 * ----------------------------------------------------------------------------------------------------
330 		 * 0x0 = ITU-R BT.601                   |  3 = YCbCr420
331 		 * 0x1 = ITU-R BT.709
332 		 * 0x2 = xvYCC601
333 		 * 0x3 = xvYCC709
334 		 * 0x4 = sYCC601
335 		 * 0x5 = AdobeYCC601
336 		 * 0x6 = ITU-R BT.2020 Y'cC'bcC'rc
337 		 * 0x7 = ITU-R BT.2020 Y'C'bC'r
338 		 * (others reserved)
339 		 * ----------------------------------------------------------------------------------------------------
340 		 * 0x0 =DICOM Part14 Grayscale          |  4 = Yonly
341 		 * Display Function
342 		 * (others reserved)
343 		 */
344 
345 		/* Set Pixel Encoding */
346 		switch (stream->timing.pixel_encoding) {
347 		case PIXEL_ENCODING_RGB:
348 			pixelEncoding = 0x0;  /* RGB = 0h */
349 			break;
350 		case PIXEL_ENCODING_YCBCR444:
351 			pixelEncoding = 0x1;  /* YCbCr444 = 1h */
352 			break;
353 		case PIXEL_ENCODING_YCBCR422:
354 			pixelEncoding = 0x2;  /* YCbCr422 = 2h */
355 			break;
356 		case PIXEL_ENCODING_YCBCR420:
357 			pixelEncoding = 0x3;  /* YCbCr420 = 3h */
358 			break;
359 		default:
360 			pixelEncoding = 0x0;  /* default RGB = 0h */
361 			break;
362 		}
363 
364 		/* Set Colorimetry format based on pixel encoding */
365 		switch (stream->timing.pixel_encoding) {
366 		case PIXEL_ENCODING_RGB:
367 			if ((cs == COLOR_SPACE_SRGB) ||
368 					(cs == COLOR_SPACE_SRGB_LIMITED))
369 				colorimetryFormat = ColorimetryRGB_DP_sRGB;
370 			else if (cs == COLOR_SPACE_ADOBERGB)
371 				colorimetryFormat = ColorimetryRGB_DP_AdobeRGB;
372 			else if ((cs == COLOR_SPACE_2020_RGB_FULLRANGE) ||
373 					(cs == COLOR_SPACE_2020_RGB_LIMITEDRANGE))
374 				colorimetryFormat = ColorimetryRGB_DP_ITU_R_BT2020RGB;
375 			break;
376 
377 		case PIXEL_ENCODING_YCBCR444:
378 		case PIXEL_ENCODING_YCBCR422:
379 		case PIXEL_ENCODING_YCBCR420:
380 			/* Note: xvYCC probably not supported correctly here on DP since colorspace translation
381 			 * loses distinction between BT601 vs xvYCC601 in translation
382 			 */
383 			if (cs == COLOR_SPACE_YCBCR601)
384 				colorimetryFormat = ColorimetryYCC_DP_ITU601;
385 			else if (cs == COLOR_SPACE_YCBCR709)
386 				colorimetryFormat = ColorimetryYCC_DP_ITU709;
387 			else if (cs == COLOR_SPACE_ADOBERGB)
388 				colorimetryFormat = ColorimetryYCC_DP_AdobeYCC;
389 			else if (cs == COLOR_SPACE_2020_YCBCR)
390 				colorimetryFormat = ColorimetryYCC_DP_ITU2020YCbCr;
391 
392 			if (cs == COLOR_SPACE_2020_YCBCR && tf == TRANSFER_FUNC_GAMMA_22)
393 				colorimetryFormat = ColorimetryYCC_DP_ITU709;
394 			break;
395 
396 		default:
397 			colorimetryFormat = ColorimetryRGB_DP_sRGB;
398 			break;
399 		}
400 
401 		info_packet->sb[16] = (pixelEncoding << 4) | colorimetryFormat;
402 
403 		/* Set color depth */
404 		switch (stream->timing.display_color_depth) {
405 		case COLOR_DEPTH_666:
406 			/* NOTE: This is actually not valid for YCbCr pixel encoding to have 6 bpc
407 			 *       as of DP1.4 spec, but value of 0 probably reserved here for potential future use.
408 			 */
409 			info_packet->sb[17] = 0;
410 			break;
411 		case COLOR_DEPTH_888:
412 			info_packet->sb[17] = 1;
413 			break;
414 		case COLOR_DEPTH_101010:
415 			info_packet->sb[17] = 2;
416 			break;
417 		case COLOR_DEPTH_121212:
418 			info_packet->sb[17] = 3;
419 			break;
420 		/*case COLOR_DEPTH_141414: -- NO SUCH FORMAT IN DP SPEC */
421 		case COLOR_DEPTH_161616:
422 			info_packet->sb[17] = 4;
423 			break;
424 		default:
425 			info_packet->sb[17] = 0;
426 			break;
427 		}
428 
429 		/* all YCbCr are always limited range */
430 		if ((cs == COLOR_SPACE_SRGB_LIMITED) ||
431 				(cs == COLOR_SPACE_2020_RGB_LIMITEDRANGE) ||
432 				(pixelEncoding != 0x0)) {
433 			info_packet->sb[17] |= 0x80; /* DB17 bit 7 set to 1 for CEA timing. */
434 		}
435 
436 		/* Content Type (Bits 2:0)
437 		 *  0 = Not defined.
438 		 *  1 = Graphics.
439 		 *  2 = Photo.
440 		 *  3 = Video.
441 		 *  4 = Game.
442 		 */
443 		info_packet->sb[18] = 0;
444 	}
445 }
446 
447 /**
448  *  mod_build_hf_vsif_infopacket - Prepare HDMI Vendor Specific info frame.
449  *                                 Follows HDMI Spec to build up Vendor Specific info frame
450  *
451  *  @stream:      contains data we may need to construct VSIF (i.e. timing_3d_format, etc.)
452  *  @info_packet: output structure where to store VSIF
453  */
mod_build_hf_vsif_infopacket(const struct dc_stream_state * stream,struct dc_info_packet * info_packet)454 void mod_build_hf_vsif_infopacket(const struct dc_stream_state *stream,
455 		struct dc_info_packet *info_packet)
456 {
457 		unsigned int length = 5;
458 		bool hdmi_vic_mode = false;
459 		uint8_t checksum = 0;
460 		uint32_t i = 0;
461 		enum dc_timing_3d_format format;
462 
463 		info_packet->valid = false;
464 		format = stream->timing.timing_3d_format;
465 		if (stream->view_format == VIEW_3D_FORMAT_NONE)
466 			format = TIMING_3D_FORMAT_NONE;
467 
468 		if (stream->timing.hdmi_vic != 0
469 				&& stream->timing.h_total >= 3840
470 				&& stream->timing.v_total >= 2160
471 				&& format == TIMING_3D_FORMAT_NONE)
472 			hdmi_vic_mode = true;
473 
474 		if ((format == TIMING_3D_FORMAT_NONE) && !hdmi_vic_mode)
475 			return;
476 
477 		info_packet->sb[1] = 0x03;
478 		info_packet->sb[2] = 0x0C;
479 		info_packet->sb[3] = 0x00;
480 
481 		if (format != TIMING_3D_FORMAT_NONE)
482 			info_packet->sb[4] = (2 << 5);
483 
484 		else if (hdmi_vic_mode)
485 			info_packet->sb[4] = (1 << 5);
486 
487 		switch (format) {
488 		case TIMING_3D_FORMAT_HW_FRAME_PACKING:
489 		case TIMING_3D_FORMAT_SW_FRAME_PACKING:
490 			info_packet->sb[5] = (0x0 << 4);
491 			break;
492 
493 		case TIMING_3D_FORMAT_SIDE_BY_SIDE:
494 		case TIMING_3D_FORMAT_SBS_SW_PACKED:
495 			info_packet->sb[5] = (0x8 << 4);
496 			length = 6;
497 			break;
498 
499 		case TIMING_3D_FORMAT_TOP_AND_BOTTOM:
500 		case TIMING_3D_FORMAT_TB_SW_PACKED:
501 			info_packet->sb[5] = (0x6 << 4);
502 			break;
503 
504 		default:
505 			break;
506 		}
507 
508 		if (hdmi_vic_mode)
509 			info_packet->sb[5] = stream->timing.hdmi_vic;
510 
511 		info_packet->hb0 = HDMI_INFOFRAME_TYPE_VENDOR;
512 		info_packet->hb1 = 0x01;
513 		info_packet->hb2 = (uint8_t) (length);
514 
515 		checksum += info_packet->hb0;
516 		checksum += info_packet->hb1;
517 		checksum += info_packet->hb2;
518 
519 		for (i = 1; i <= length; i++)
520 			checksum += info_packet->sb[i];
521 
522 		info_packet->sb[0] = (uint8_t) (0x100 - checksum);
523 
524 		info_packet->valid = true;
525 }
526 
mod_build_adaptive_sync_infopacket(const struct dc_stream_state * stream,enum adaptive_sync_type asType,const struct AS_Df_params * param,struct dc_info_packet * info_packet)527 void mod_build_adaptive_sync_infopacket(const struct dc_stream_state *stream,
528 		enum adaptive_sync_type asType,
529 		const struct AS_Df_params *param,
530 		struct dc_info_packet *info_packet)
531 {
532 	info_packet->valid = false;
533 
534 	memset(info_packet, 0, sizeof(struct dc_info_packet));
535 
536 	switch (asType) {
537 	case ADAPTIVE_SYNC_TYPE_DP:
538 		if (stream != NULL)
539 			mod_build_adaptive_sync_infopacket_v2(stream, param, info_packet);
540 		break;
541 	case FREESYNC_TYPE_PCON_IN_WHITELIST:
542 		mod_build_adaptive_sync_infopacket_v1(info_packet);
543 		break;
544 	case ADAPTIVE_SYNC_TYPE_EDP:
545 		mod_build_adaptive_sync_infopacket_v1(info_packet);
546 		break;
547 	case ADAPTIVE_SYNC_TYPE_NONE:
548 	case FREESYNC_TYPE_PCON_NOT_IN_WHITELIST:
549 	default:
550 		break;
551 	}
552 }
553 
mod_build_adaptive_sync_infopacket_v1(struct dc_info_packet * info_packet)554 void mod_build_adaptive_sync_infopacket_v1(struct dc_info_packet *info_packet)
555 {
556 	info_packet->valid = true;
557 	// HEADER {HB0, HB1, HB2, HB3} = {00, Type, Version, Length}
558 	info_packet->hb0 = 0x00;
559 	info_packet->hb1 = 0x22;
560 	info_packet->hb2 = AS_SDP_VER_1;
561 	info_packet->hb3 = 0x00;
562 }
563 
mod_build_adaptive_sync_infopacket_v2(const struct dc_stream_state * stream,const struct AS_Df_params * param,struct dc_info_packet * info_packet)564 void mod_build_adaptive_sync_infopacket_v2(const struct dc_stream_state *stream,
565 		const struct AS_Df_params *param,
566 		struct dc_info_packet *info_packet)
567 {
568 	info_packet->valid = true;
569 	// HEADER {HB0, HB1, HB2, HB3} = {00, Type, Version, Length}
570 	info_packet->hb0 = 0x00;
571 	info_packet->hb1 = 0x22;
572 	info_packet->hb2 = AS_SDP_VER_2;
573 	info_packet->hb3 = AS_DP_SDP_LENGTH;
574 
575 	//Payload
576 	info_packet->sb[0] = param->supportMode; //1: AVT; 0: FAVT
577 	info_packet->sb[1] = (stream->timing.v_total & 0x00FF);
578 	info_packet->sb[2] = (stream->timing.v_total & 0xFF00) >> 8;
579 	//info_packet->sb[3] = 0x00; Target RR, not use fot AVT
580 	info_packet->sb[4] = (param->increase.support << 6 | param->decrease.support << 7);
581 	info_packet->sb[5] = param->increase.frame_duration_hex;
582 	info_packet->sb[6] = param->decrease.frame_duration_hex;
583 }
584 
585