Loading...
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
33enum 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
118enum 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};
125enum 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
133void 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 */
454void 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
527void 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
554void 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
564void 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
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
33enum 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
118enum 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};
125enum 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
133void 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_version == DC_PSR_VERSION_SU_1)
151 vsc_packet_revision = vsc_packet_rev4;
152 else if (stream->link->psr_settings.psr_version == DC_PSR_VERSION_1)
153 vsc_packet_revision = vsc_packet_rev2;
154
155 /* Update to revision 5 for extended colorimetry support */
156 if (stream->use_vsc_sdp_for_colorimetry)
157 vsc_packet_revision = vsc_packet_rev5;
158
159 /* VSC packet not needed based on the features
160 * supported by this DP display
161 */
162 if (vsc_packet_revision == vsc_packet_undefined)
163 return;
164
165 if (vsc_packet_revision == vsc_packet_rev4) {
166 /* Secondary-data Packet ID = 0*/
167 info_packet->hb0 = 0x00;
168 /* 07h - Packet Type Value indicating Video
169 * Stream Configuration packet
170 */
171 info_packet->hb1 = 0x07;
172 /* 04h = VSC SDP supporting 3D stereo + PSR/PSR2 + Y-coordinate
173 * (applies to eDP v1.4 or higher).
174 */
175 info_packet->hb2 = 0x04;
176 /* 0Eh = VSC SDP supporting 3D stereo + PSR2
177 * (HB2 = 04h), with Y-coordinate of first scan
178 * line of the SU region
179 */
180 info_packet->hb3 = 0x0E;
181
182 for (i = 0; i < 28; i++)
183 info_packet->sb[i] = 0;
184
185 info_packet->valid = true;
186 }
187
188 if (vsc_packet_revision == vsc_packet_rev2) {
189 /* Secondary-data Packet ID = 0*/
190 info_packet->hb0 = 0x00;
191 /* 07h - Packet Type Value indicating Video
192 * Stream Configuration packet
193 */
194 info_packet->hb1 = 0x07;
195 /* 02h = VSC SDP supporting 3D stereo and PSR
196 * (applies to eDP v1.3 or higher).
197 */
198 info_packet->hb2 = 0x02;
199 /* 08h = VSC packet supporting 3D stereo + PSR
200 * (HB2 = 02h).
201 */
202 info_packet->hb3 = 0x08;
203
204 for (i = 0; i < 28; i++)
205 info_packet->sb[i] = 0;
206
207 info_packet->valid = true;
208 }
209
210 if (vsc_packet_revision == vsc_packet_rev1) {
211
212 info_packet->hb0 = 0x00; // Secondary-data Packet ID = 0
213 info_packet->hb1 = 0x07; // 07h = Packet Type Value indicating Video Stream Configuration packet
214 info_packet->hb2 = 0x01; // 01h = Revision number. VSC SDP supporting 3D stereo only
215 info_packet->hb3 = 0x01; // 01h = VSC SDP supporting 3D stereo only (HB2 = 01h).
216
217 info_packet->valid = true;
218 }
219
220 if (stereo3dSupport) {
221 /* ==============================================================================================================|
222 * A. STEREO 3D
223 * ==============================================================================================================|
224 * VSC Payload (1 byte) From DP1.2 spec
225 *
226 * Bits 3:0 (Stereo Interface Method Code) | Bits 7:4 (Stereo Interface Method Specific Parameter)
227 * -----------------------------------------------------------------------------------------------------
228 * 0 = Non Stereo Video | Must be set to 0x0
229 * -----------------------------------------------------------------------------------------------------
230 * 1 = Frame/Field Sequential | 0x0: L + R view indication based on MISC1 bit 2:1
231 * | 0x1: Right when Stereo Signal = 1
232 * | 0x2: Left when Stereo Signal = 1
233 * | (others reserved)
234 * -----------------------------------------------------------------------------------------------------
235 * 2 = Stacked Frame | 0x0: Left view is on top and right view on bottom
236 * | (others reserved)
237 * -----------------------------------------------------------------------------------------------------
238 * 3 = Pixel Interleaved | 0x0: horiz interleaved, right view pixels on even lines
239 * | 0x1: horiz interleaved, right view pixels on odd lines
240 * | 0x2: checker board, start with left view pixel
241 * | 0x3: vertical interleaved, start with left view pixels
242 * | 0x4: vertical interleaved, start with right view pixels
243 * | (others reserved)
244 * -----------------------------------------------------------------------------------------------------
245 * 4 = Side-by-side | 0x0: left half represents left eye view
246 * | 0x1: left half represents right eye view
247 */
248 switch (stream->timing.timing_3d_format) {
249 case TIMING_3D_FORMAT_HW_FRAME_PACKING:
250 case TIMING_3D_FORMAT_SW_FRAME_PACKING:
251 case TIMING_3D_FORMAT_TOP_AND_BOTTOM:
252 case TIMING_3D_FORMAT_TB_SW_PACKED:
253 info_packet->sb[0] = 0x02; // Stacked Frame, Left view is on top and right view on bottom.
254 break;
255 case TIMING_3D_FORMAT_DP_HDMI_INBAND_FA:
256 case TIMING_3D_FORMAT_INBAND_FA:
257 info_packet->sb[0] = 0x01; // Frame/Field Sequential, L + R view indication based on MISC1 bit 2:1
258 break;
259 case TIMING_3D_FORMAT_SIDE_BY_SIDE:
260 case TIMING_3D_FORMAT_SBS_SW_PACKED:
261 info_packet->sb[0] = 0x04; // Side-by-side
262 break;
263 default:
264 info_packet->sb[0] = 0x00; // No Stereo Video, Shall be cleared to 0x0.
265 break;
266 }
267
268 }
269
270 /* 05h = VSC SDP supporting 3D stereo, PSR2, and Pixel Encoding/Colorimetry Format indication.
271 * Added in DP1.3, a DP Source device is allowed to indicate the pixel encoding/colorimetry
272 * format to the DP Sink device with VSC SDP only when the DP Sink device supports it
273 * (i.e., VSC_SDP_EXTENSION_FOR_COLORIMETRY_SUPPORTED bit in the DPRX_FEATURE_ENUMERATION_LIST
274 * register (DPCD Address 02210h, bit 3) is set to 1).
275 * (Requires VSC_SDP_EXTENSION_FOR_COLORIMETRY_SUPPORTED bit set to 1 in DPCD 02210h. This
276 * DPCD register is exposed in the new Extended Receiver Capability field for DPCD Rev. 1.4
277 * (and higher). When MISC1. bit 6. is Set to 1, a Source device uses a VSC SDP to indicate
278 * the Pixel Encoding/Colorimetry Format and that a Sink device must ignore MISC1, bit 7, and
279 * MISC0, bits 7:1 (MISC1, bit 7. and MISC0, bits 7:1 become "don't care").)
280 */
281 if (vsc_packet_revision == vsc_packet_rev5) {
282 /* Secondary-data Packet ID = 0 */
283 info_packet->hb0 = 0x00;
284 /* 07h - Packet Type Value indicating Video Stream Configuration packet */
285 info_packet->hb1 = 0x07;
286 /* 05h = VSC SDP supporting 3D stereo, PSR2, and Pixel Encoding/Colorimetry Format indication. */
287 info_packet->hb2 = 0x05;
288 /* 13h = VSC SDP supporting 3D stereo, + PSR2, + Pixel Encoding/Colorimetry Format indication (HB2 = 05h). */
289 info_packet->hb3 = 0x13;
290
291 info_packet->valid = true;
292
293 /* Set VSC SDP fields for pixel encoding and colorimetry format from DP 1.3 specs
294 * Data Bytes DB 18~16
295 * Bits 3:0 (Colorimetry Format) | Bits 7:4 (Pixel Encoding)
296 * ----------------------------------------------------------------------------------------------------
297 * 0x0 = sRGB | 0 = RGB
298 * 0x1 = RGB Wide Gamut Fixed Point
299 * 0x2 = RGB Wide Gamut Floating Point
300 * 0x3 = AdobeRGB
301 * 0x4 = DCI-P3
302 * 0x5 = CustomColorProfile
303 * (others reserved)
304 * ----------------------------------------------------------------------------------------------------
305 * 0x0 = ITU-R BT.601 | 1 = YCbCr444
306 * 0x1 = ITU-R BT.709
307 * 0x2 = xvYCC601
308 * 0x3 = xvYCC709
309 * 0x4 = sYCC601
310 * 0x5 = AdobeYCC601
311 * 0x6 = ITU-R BT.2020 Y'cC'bcC'rc
312 * 0x7 = ITU-R BT.2020 Y'C'bC'r
313 * (others reserved)
314 * ----------------------------------------------------------------------------------------------------
315 * 0x0 = ITU-R BT.601 | 2 = YCbCr422
316 * 0x1 = ITU-R BT.709
317 * 0x2 = xvYCC601
318 * 0x3 = xvYCC709
319 * 0x4 = sYCC601
320 * 0x5 = AdobeYCC601
321 * 0x6 = ITU-R BT.2020 Y'cC'bcC'rc
322 * 0x7 = ITU-R BT.2020 Y'C'bC'r
323 * (others reserved)
324 * ----------------------------------------------------------------------------------------------------
325 * 0x0 = ITU-R BT.601 | 3 = YCbCr420
326 * 0x1 = ITU-R BT.709
327 * 0x2 = xvYCC601
328 * 0x3 = xvYCC709
329 * 0x4 = sYCC601
330 * 0x5 = AdobeYCC601
331 * 0x6 = ITU-R BT.2020 Y'cC'bcC'rc
332 * 0x7 = ITU-R BT.2020 Y'C'bC'r
333 * (others reserved)
334 * ----------------------------------------------------------------------------------------------------
335 * 0x0 =DICOM Part14 Grayscale | 4 = Yonly
336 * Display Function
337 * (others reserved)
338 */
339
340 /* Set Pixel Encoding */
341 switch (stream->timing.pixel_encoding) {
342 case PIXEL_ENCODING_RGB:
343 pixelEncoding = 0x0; /* RGB = 0h */
344 break;
345 case PIXEL_ENCODING_YCBCR444:
346 pixelEncoding = 0x1; /* YCbCr444 = 1h */
347 break;
348 case PIXEL_ENCODING_YCBCR422:
349 pixelEncoding = 0x2; /* YCbCr422 = 2h */
350 break;
351 case PIXEL_ENCODING_YCBCR420:
352 pixelEncoding = 0x3; /* YCbCr420 = 3h */
353 break;
354 default:
355 pixelEncoding = 0x0; /* default RGB = 0h */
356 break;
357 }
358
359 /* Set Colorimetry format based on pixel encoding */
360 switch (stream->timing.pixel_encoding) {
361 case PIXEL_ENCODING_RGB:
362 if ((cs == COLOR_SPACE_SRGB) ||
363 (cs == COLOR_SPACE_SRGB_LIMITED))
364 colorimetryFormat = ColorimetryRGB_DP_sRGB;
365 else if (cs == COLOR_SPACE_ADOBERGB)
366 colorimetryFormat = ColorimetryRGB_DP_AdobeRGB;
367 else if ((cs == COLOR_SPACE_2020_RGB_FULLRANGE) ||
368 (cs == COLOR_SPACE_2020_RGB_LIMITEDRANGE))
369 colorimetryFormat = ColorimetryRGB_DP_ITU_R_BT2020RGB;
370 break;
371
372 case PIXEL_ENCODING_YCBCR444:
373 case PIXEL_ENCODING_YCBCR422:
374 case PIXEL_ENCODING_YCBCR420:
375 /* Note: xvYCC probably not supported correctly here on DP since colorspace translation
376 * loses distinction between BT601 vs xvYCC601 in translation
377 */
378 if (cs == COLOR_SPACE_YCBCR601)
379 colorimetryFormat = ColorimetryYCC_DP_ITU601;
380 else if (cs == COLOR_SPACE_YCBCR709)
381 colorimetryFormat = ColorimetryYCC_DP_ITU709;
382 else if (cs == COLOR_SPACE_ADOBERGB)
383 colorimetryFormat = ColorimetryYCC_DP_AdobeYCC;
384 else if (cs == COLOR_SPACE_2020_YCBCR)
385 colorimetryFormat = ColorimetryYCC_DP_ITU2020YCbCr;
386
387 if (cs == COLOR_SPACE_2020_YCBCR && tf == TRANSFER_FUNC_GAMMA_22)
388 colorimetryFormat = ColorimetryYCC_DP_ITU709;
389 break;
390
391 default:
392 colorimetryFormat = ColorimetryRGB_DP_sRGB;
393 break;
394 }
395
396 info_packet->sb[16] = (pixelEncoding << 4) | colorimetryFormat;
397
398 /* Set color depth */
399 switch (stream->timing.display_color_depth) {
400 case COLOR_DEPTH_666:
401 /* NOTE: This is actually not valid for YCbCr pixel encoding to have 6 bpc
402 * as of DP1.4 spec, but value of 0 probably reserved here for potential future use.
403 */
404 info_packet->sb[17] = 0;
405 break;
406 case COLOR_DEPTH_888:
407 info_packet->sb[17] = 1;
408 break;
409 case COLOR_DEPTH_101010:
410 info_packet->sb[17] = 2;
411 break;
412 case COLOR_DEPTH_121212:
413 info_packet->sb[17] = 3;
414 break;
415 /*case COLOR_DEPTH_141414: -- NO SUCH FORMAT IN DP SPEC */
416 case COLOR_DEPTH_161616:
417 info_packet->sb[17] = 4;
418 break;
419 default:
420 info_packet->sb[17] = 0;
421 break;
422 }
423
424 /* all YCbCr are always limited range */
425 if ((cs == COLOR_SPACE_SRGB_LIMITED) ||
426 (cs == COLOR_SPACE_2020_RGB_LIMITEDRANGE) ||
427 (pixelEncoding != 0x0)) {
428 info_packet->sb[17] |= 0x80; /* DB17 bit 7 set to 1 for CEA timing. */
429 }
430
431 /* Content Type (Bits 2:0)
432 * 0 = Not defined.
433 * 1 = Graphics.
434 * 2 = Photo.
435 * 3 = Video.
436 * 4 = Game.
437 */
438 info_packet->sb[18] = 0;
439 }
440}
441
442/**
443 * mod_build_hf_vsif_infopacket - Prepare HDMI Vendor Specific info frame.
444 * Follows HDMI Spec to build up Vendor Specific info frame
445 *
446 * @stream: contains data we may need to construct VSIF (i.e. timing_3d_format, etc.)
447 * @info_packet: output structure where to store VSIF
448 */
449void mod_build_hf_vsif_infopacket(const struct dc_stream_state *stream,
450 struct dc_info_packet *info_packet)
451{
452 unsigned int length = 5;
453 bool hdmi_vic_mode = false;
454 uint8_t checksum = 0;
455 uint32_t i = 0;
456 enum dc_timing_3d_format format;
457
458 info_packet->valid = false;
459 format = stream->timing.timing_3d_format;
460 if (stream->view_format == VIEW_3D_FORMAT_NONE)
461 format = TIMING_3D_FORMAT_NONE;
462
463 if (stream->timing.hdmi_vic != 0
464 && stream->timing.h_total >= 3840
465 && stream->timing.v_total >= 2160
466 && format == TIMING_3D_FORMAT_NONE)
467 hdmi_vic_mode = true;
468
469 if ((format == TIMING_3D_FORMAT_NONE) && !hdmi_vic_mode)
470 return;
471
472 info_packet->sb[1] = 0x03;
473 info_packet->sb[2] = 0x0C;
474 info_packet->sb[3] = 0x00;
475
476 if (format != TIMING_3D_FORMAT_NONE)
477 info_packet->sb[4] = (2 << 5);
478
479 else if (hdmi_vic_mode)
480 info_packet->sb[4] = (1 << 5);
481
482 switch (format) {
483 case TIMING_3D_FORMAT_HW_FRAME_PACKING:
484 case TIMING_3D_FORMAT_SW_FRAME_PACKING:
485 info_packet->sb[5] = (0x0 << 4);
486 break;
487
488 case TIMING_3D_FORMAT_SIDE_BY_SIDE:
489 case TIMING_3D_FORMAT_SBS_SW_PACKED:
490 info_packet->sb[5] = (0x8 << 4);
491 length = 6;
492 break;
493
494 case TIMING_3D_FORMAT_TOP_AND_BOTTOM:
495 case TIMING_3D_FORMAT_TB_SW_PACKED:
496 info_packet->sb[5] = (0x6 << 4);
497 break;
498
499 default:
500 break;
501 }
502
503 if (hdmi_vic_mode)
504 info_packet->sb[5] = stream->timing.hdmi_vic;
505
506 info_packet->hb0 = HDMI_INFOFRAME_TYPE_VENDOR;
507 info_packet->hb1 = 0x01;
508 info_packet->hb2 = (uint8_t) (length);
509
510 checksum += info_packet->hb0;
511 checksum += info_packet->hb1;
512 checksum += info_packet->hb2;
513
514 for (i = 1; i <= length; i++)
515 checksum += info_packet->sb[i];
516
517 info_packet->sb[0] = (uint8_t) (0x100 - checksum);
518
519 info_packet->valid = true;
520}
521