FreeRDP
Loading...
Searching...
No Matches
planar.c
1
22#include <freerdp/config.h>
23
24#include <winpr/crt.h>
25#include <winpr/wtypes.h>
26#include <winpr/assert.h>
27#include <winpr/cast.h>
28#include <winpr/print.h>
29
30#include <freerdp/primitives.h>
31#include <freerdp/log.h>
32#include <freerdp/codec/bitmap.h>
33#include <freerdp/codec/planar.h>
34
35#define TAG FREERDP_TAG("codec")
36
37#define PLANAR_ALIGN(val, align) \
38 ((val) % (align) == 0) ? (val) : ((val) + (align) - (val) % (align))
39
40typedef struct
41{
47 BYTE controlByte;
48 BYTE* rawValues;
49} RDP6_RLE_SEGMENT;
50
51typedef struct
52{
53 UINT32 cSegments;
54 RDP6_RLE_SEGMENT* segments;
55} RDP6_RLE_SEGMENTS;
56
57typedef struct
58{
67 BYTE formatHeader;
68} RDP6_BITMAP_STREAM;
69
70struct S_BITMAP_PLANAR_CONTEXT
71{
72 UINT32 maxWidth;
73 UINT32 maxHeight;
74 UINT32 maxPlaneSize;
75
76 BOOL AllowSkipAlpha;
77 BOOL AllowRunLengthEncoding;
78 BOOL AllowColorSubsampling;
79 BOOL AllowDynamicColorFidelity;
80
81 UINT32 ColorLossLevel;
82
83 BYTE* planes[4];
84 BYTE* planesBuffer;
85
86 BYTE* deltaPlanes[4];
87 BYTE* deltaPlanesBuffer;
88
89 BYTE* rlePlanes[4];
90 BYTE* rlePlanesBuffer;
91
92 BYTE* pTempData;
93 UINT32 nTempStep;
94
95 BOOL bgr;
96 BOOL topdown;
97};
98
99static inline BYTE PLANAR_CONTROL_BYTE(UINT32 nRunLength, UINT32 cRawBytes)
100{
101 return WINPR_ASSERTING_INT_CAST(UINT8, ((nRunLength & 0x0F) | ((cRawBytes & 0x0F) << 4)));
102}
103
104static inline BYTE PLANAR_CONTROL_BYTE_RUN_LENGTH(UINT32 controlByte)
105{
106 return (controlByte & 0x0F);
107}
108static inline BYTE PLANAR_CONTROL_BYTE_RAW_BYTES(UINT32 controlByte)
109{
110 return ((controlByte >> 4) & 0x0F);
111}
112
113static inline UINT32 planar_invert_format(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar, BOOL alpha,
114 UINT32 DstFormat)
115{
116 WINPR_ASSERT(planar);
117 if (planar->bgr && alpha)
118 {
119 switch (DstFormat)
120 {
121 case PIXEL_FORMAT_ARGB32:
122 DstFormat = PIXEL_FORMAT_ABGR32;
123 break;
124 case PIXEL_FORMAT_XRGB32:
125 DstFormat = PIXEL_FORMAT_XBGR32;
126 break;
127 case PIXEL_FORMAT_ABGR32:
128 DstFormat = PIXEL_FORMAT_ARGB32;
129 break;
130 case PIXEL_FORMAT_XBGR32:
131 DstFormat = PIXEL_FORMAT_XRGB32;
132 break;
133 case PIXEL_FORMAT_BGRA32:
134 DstFormat = PIXEL_FORMAT_RGBA32;
135 break;
136 case PIXEL_FORMAT_BGRX32:
137 DstFormat = PIXEL_FORMAT_RGBX32;
138 break;
139 case PIXEL_FORMAT_RGBA32:
140 DstFormat = PIXEL_FORMAT_BGRA32;
141 break;
142 case PIXEL_FORMAT_RGBX32:
143 DstFormat = PIXEL_FORMAT_BGRX32;
144 break;
145 case PIXEL_FORMAT_RGB24:
146 DstFormat = PIXEL_FORMAT_BGR24;
147 break;
148 case PIXEL_FORMAT_BGR24:
149 DstFormat = PIXEL_FORMAT_RGB24;
150 break;
151 case PIXEL_FORMAT_RGB16:
152 DstFormat = PIXEL_FORMAT_BGR16;
153 break;
154 case PIXEL_FORMAT_BGR16:
155 DstFormat = PIXEL_FORMAT_RGB16;
156 break;
157 case PIXEL_FORMAT_ARGB15:
158 DstFormat = PIXEL_FORMAT_ABGR15;
159 break;
160 case PIXEL_FORMAT_RGB15:
161 DstFormat = PIXEL_FORMAT_BGR15;
162 break;
163 case PIXEL_FORMAT_ABGR15:
164 DstFormat = PIXEL_FORMAT_ARGB15;
165 break;
166 case PIXEL_FORMAT_BGR15:
167 DstFormat = PIXEL_FORMAT_RGB15;
168 break;
169 default:
170 break;
171 }
172 }
173 return DstFormat;
174}
175
176static inline BOOL freerdp_bitmap_planar_compress_plane_rle(const BYTE* WINPR_RESTRICT inPlane,
177 UINT32 width, UINT32 height,
178 BYTE* WINPR_RESTRICT outPlane,
179 UINT32* WINPR_RESTRICT dstSize);
180static inline BYTE* freerdp_bitmap_planar_delta_encode_plane(const BYTE* WINPR_RESTRICT inPlane,
181 UINT32 width, UINT32 height,
182 BYTE* WINPR_RESTRICT outPlane);
183
184static inline INT32 planar_skip_plane_rle(const BYTE* WINPR_RESTRICT pSrcData, UINT32 SrcSize,
185 UINT32 nWidth, UINT32 nHeight)
186{
187 UINT32 used = 0;
188
189 WINPR_ASSERT(pSrcData);
190
191 for (UINT32 y = 0; y < nHeight; y++)
192 {
193 for (UINT32 x = 0; x < nWidth;)
194 {
195 if (used >= SrcSize)
196 {
197 WLog_ERR(TAG, "planar plane used %" PRIu32 " exceeds SrcSize %" PRIu32, used,
198 SrcSize);
199 return -1;
200 }
201
202 const uint8_t controlByte = pSrcData[used++];
203 uint32_t nRunLength = PLANAR_CONTROL_BYTE_RUN_LENGTH(controlByte);
204 uint32_t cRawBytes = PLANAR_CONTROL_BYTE_RAW_BYTES(controlByte);
205
206 if (nRunLength == 1)
207 {
208 nRunLength = cRawBytes + 16;
209 cRawBytes = 0;
210 }
211 else if (nRunLength == 2)
212 {
213 nRunLength = cRawBytes + 32;
214 cRawBytes = 0;
215 }
216
217 used += cRawBytes;
218 x += cRawBytes;
219 x += nRunLength;
220
221 if (x > nWidth)
222 {
223 WLog_ERR(TAG, "planar plane x %" PRIu32 " exceeds width %" PRIu32, x, nWidth);
224 return -1;
225 }
226
227 if (used > SrcSize)
228 {
229 WLog_ERR(TAG, "planar plane used %" PRIu32 " exceeds SrcSize %" PRIu32, used,
230 INT32_MAX);
231 return -1;
232 }
233 }
234 }
235
236 if (used > INT32_MAX)
237 {
238 WLog_ERR(TAG, "planar plane used %" PRIu32 " exceeds SrcSize %" PRIu32, used, SrcSize);
239 return -1;
240 }
241 return (INT32)used;
242}
243
244static inline UINT8 clamp(INT16 val)
245{
246 return (UINT8)val;
247}
248
249static inline INT32 planar_decompress_plane_rle_only(const BYTE* WINPR_RESTRICT pSrcData,
250 UINT32 SrcSize, BYTE* WINPR_RESTRICT pDstData,
251 UINT32 nWidth, UINT32 nHeight)
252{
253 BYTE* previousScanline = NULL;
254 const BYTE* srcp = pSrcData;
255
256 WINPR_ASSERT(nHeight <= INT32_MAX);
257 WINPR_ASSERT(nWidth <= INT32_MAX);
258
259 for (UINT32 y = 0; y < nHeight; y++)
260 {
261 BYTE* dstp = &pDstData[1ULL * (y)*nWidth];
262 INT16 pixel = 0;
263 BYTE* currentScanline = dstp;
264
265 for (UINT32 x = 0; x < nWidth;)
266 {
267 BYTE controlByte = *srcp;
268 srcp++;
269
270 if ((srcp - pSrcData) > SrcSize * 1ll)
271 {
272 WLog_ERR(TAG, "error reading input buffer");
273 return -1;
274 }
275
276 UINT32 nRunLength = PLANAR_CONTROL_BYTE_RUN_LENGTH(controlByte);
277 UINT32 cRawBytes = PLANAR_CONTROL_BYTE_RAW_BYTES(controlByte);
278
279 if (nRunLength == 1)
280 {
281 nRunLength = cRawBytes + 16;
282 cRawBytes = 0;
283 }
284 else if (nRunLength == 2)
285 {
286 nRunLength = cRawBytes + 32;
287 cRawBytes = 0;
288 }
289
290 if (((dstp + (cRawBytes + nRunLength)) - currentScanline) > nWidth * 1ll)
291 {
292 WLog_ERR(TAG, "too many pixels in scanline");
293 return -1;
294 }
295
296 if (!previousScanline)
297 {
298 /* first scanline, absolute values */
299 while (cRawBytes > 0)
300 {
301 pixel = *srcp;
302 srcp++;
303 *dstp = clamp(pixel);
304 dstp++;
305 x++;
306 cRawBytes--;
307 }
308
309 while (nRunLength > 0)
310 {
311 *dstp = clamp(pixel);
312 dstp++;
313 x++;
314 nRunLength--;
315 }
316 }
317 else
318 {
319 /* delta values relative to previous scanline */
320 while (cRawBytes > 0)
321 {
322 UINT8 deltaValue = *srcp;
323 srcp++;
324
325 if (deltaValue & 1)
326 {
327 deltaValue = deltaValue >> 1;
328 deltaValue = deltaValue + 1;
329 pixel = WINPR_ASSERTING_INT_CAST(int16_t, -1 * (int16_t)deltaValue);
330 }
331 else
332 {
333 deltaValue = deltaValue >> 1;
334 pixel = WINPR_ASSERTING_INT_CAST(INT16, deltaValue);
335 }
336
337 const INT16 delta =
338 WINPR_ASSERTING_INT_CAST(int16_t, previousScanline[x] + pixel);
339 *dstp = clamp(delta);
340 dstp++;
341 x++;
342 cRawBytes--;
343 }
344
345 while (nRunLength > 0)
346 {
347 const INT16 deltaValue =
348 WINPR_ASSERTING_INT_CAST(int16_t, previousScanline[x] + pixel);
349 *dstp = clamp(deltaValue);
350 dstp++;
351 x++;
352 nRunLength--;
353 }
354 }
355 }
356
357 previousScanline = currentScanline;
358 }
359
360 return (INT32)(srcp - pSrcData);
361}
362
363static inline INT32 planar_decompress_plane_rle(const BYTE* WINPR_RESTRICT pSrcData, UINT32 SrcSize,
364 BYTE* WINPR_RESTRICT pDstData, UINT32 nDstStep,
365 UINT32 nXDst, UINT32 nYDst, UINT32 nWidth,
366 UINT32 nHeight, UINT32 nChannel, BOOL vFlip)
367{
368 INT32 beg = 0;
369 INT32 end = 0;
370 INT32 inc = 0;
371 BYTE* previousScanline = NULL;
372 const BYTE* srcp = pSrcData;
373
374 WINPR_ASSERT(nHeight <= INT32_MAX);
375 WINPR_ASSERT(nWidth <= INT32_MAX);
376 WINPR_ASSERT(nDstStep <= INT32_MAX);
377
378 if (vFlip)
379 {
380 beg = (INT32)nHeight - 1;
381 end = -1;
382 inc = -1;
383 }
384 else
385 {
386 beg = 0;
387 end = (INT32)nHeight;
388 inc = 1;
389 }
390
391 for (INT32 y = beg; y != end; y += inc)
392 {
393 const intptr_t off = ((1LL * nYDst + y) * nDstStep) + (4LL * nXDst) + nChannel * 1LL;
394 BYTE* dstp = &pDstData[off];
395 BYTE* currentScanline = dstp;
396 INT16 pixel = 0;
397
398 for (INT32 x = 0; x < (INT32)nWidth;)
399 {
400 const BYTE controlByte = *srcp;
401 srcp++;
402
403 if ((srcp - pSrcData) > SrcSize * 1ll)
404 {
405 WLog_ERR(TAG, "error reading input buffer");
406 return -1;
407 }
408
409 UINT32 nRunLength = PLANAR_CONTROL_BYTE_RUN_LENGTH(controlByte);
410 UINT32 cRawBytes = PLANAR_CONTROL_BYTE_RAW_BYTES(controlByte);
411
412 if (nRunLength == 1)
413 {
414 nRunLength = cRawBytes + 16;
415 cRawBytes = 0;
416 }
417 else if (nRunLength == 2)
418 {
419 nRunLength = cRawBytes + 32;
420 cRawBytes = 0;
421 }
422
423 if (((dstp + (cRawBytes + nRunLength)) - currentScanline) > nWidth * 4ll)
424 {
425 WLog_ERR(TAG, "too many pixels in scanline");
426 return -1;
427 }
428
429 if (!previousScanline)
430 {
431 /* first scanline, absolute values */
432 while (cRawBytes > 0)
433 {
434 pixel = *srcp;
435 srcp++;
436 *dstp = WINPR_ASSERTING_INT_CAST(BYTE, pixel);
437 dstp += 4;
438 x++;
439 cRawBytes--;
440 }
441
442 while (nRunLength > 0)
443 {
444 *dstp = WINPR_ASSERTING_INT_CAST(BYTE, pixel);
445 dstp += 4;
446 x++;
447 nRunLength--;
448 }
449 }
450 else
451 {
452 /* delta values relative to previous scanline */
453 while (cRawBytes > 0)
454 {
455 BYTE deltaValue = *srcp;
456 srcp++;
457
458 if (deltaValue & 1)
459 {
460 deltaValue = deltaValue >> 1;
461 deltaValue = deltaValue + 1;
462 pixel = WINPR_ASSERTING_INT_CAST(int16_t, -deltaValue);
463 }
464 else
465 {
466 deltaValue = deltaValue >> 1;
467 pixel = deltaValue;
468 }
469
470 const INT16 delta =
471 WINPR_ASSERTING_INT_CAST(int16_t, previousScanline[4LL * x] + pixel);
472 *dstp = clamp(delta);
473 dstp += 4;
474 x++;
475 cRawBytes--;
476 }
477
478 while (nRunLength > 0)
479 {
480 const INT16 deltaValue =
481 WINPR_ASSERTING_INT_CAST(int16_t, pixel + previousScanline[4LL * x]);
482 *dstp = clamp(deltaValue);
483 dstp += 4;
484 x++;
485 nRunLength--;
486 }
487 }
488 }
489
490 previousScanline = currentScanline;
491 }
492
493 return (INT32)(srcp - pSrcData);
494}
495
496static inline INT32 planar_set_plane(BYTE bValue, BYTE* pDstData, UINT32 nDstStep, UINT32 nXDst,
497 UINT32 nYDst, UINT32 nWidth, UINT32 nHeight, UINT32 nChannel,
498 BOOL vFlip)
499{
500 INT32 beg = 0;
501 INT32 end = (INT32)nHeight;
502 INT32 inc = 1;
503
504 WINPR_ASSERT(nHeight <= INT32_MAX);
505 WINPR_ASSERT(nWidth <= INT32_MAX);
506 WINPR_ASSERT(nDstStep <= INT32_MAX);
507
508 if (vFlip)
509 {
510 beg = (INT32)nHeight - 1;
511 end = -1;
512 inc = -1;
513 }
514
515 for (INT32 y = beg; y != end; y += inc)
516 {
517 const intptr_t off = ((1LL * nYDst + y) * nDstStep) + (4LL * nXDst) + nChannel * 1LL;
518 BYTE* dstp = &pDstData[off];
519
520 for (INT32 x = 0; x < (INT32)nWidth; ++x)
521 {
522 *dstp = bValue;
523 dstp += 4;
524 }
525 }
526
527 return 0;
528}
529
530static inline BOOL writeLine(BYTE** WINPR_RESTRICT ppRgba, UINT32 DstFormat, UINT32 width,
531 const BYTE** WINPR_RESTRICT ppR, const BYTE** WINPR_RESTRICT ppG,
532 const BYTE** WINPR_RESTRICT ppB, const BYTE** WINPR_RESTRICT ppA)
533{
534 WINPR_ASSERT(ppRgba);
535 WINPR_ASSERT(ppR);
536 WINPR_ASSERT(ppG);
537 WINPR_ASSERT(ppB);
538
539 switch (DstFormat)
540 {
541 case PIXEL_FORMAT_BGRA32:
542 for (UINT32 x = 0; x < width; x++)
543 {
544 *(*ppRgba)++ = *(*ppB)++;
545 *(*ppRgba)++ = *(*ppG)++;
546 *(*ppRgba)++ = *(*ppR)++;
547 *(*ppRgba)++ = *(*ppA)++;
548 }
549
550 return TRUE;
551
552 case PIXEL_FORMAT_BGRX32:
553 for (UINT32 x = 0; x < width; x++)
554 {
555 *(*ppRgba)++ = *(*ppB)++;
556 *(*ppRgba)++ = *(*ppG)++;
557 *(*ppRgba)++ = *(*ppR)++;
558 *(*ppRgba)++ = 0xFF;
559 }
560
561 return TRUE;
562
563 default:
564 if (ppA)
565 {
566 for (UINT32 x = 0; x < width; x++)
567 {
568 BYTE alpha = *(*ppA)++;
569 UINT32 color =
570 FreeRDPGetColor(DstFormat, *(*ppR)++, *(*ppG)++, *(*ppB)++, alpha);
571 FreeRDPWriteColor(*ppRgba, DstFormat, color);
572 *ppRgba += FreeRDPGetBytesPerPixel(DstFormat);
573 }
574 }
575 else
576 {
577 const BYTE alpha = 0xFF;
578
579 for (UINT32 x = 0; x < width; x++)
580 {
581 UINT32 color =
582 FreeRDPGetColor(DstFormat, *(*ppR)++, *(*ppG)++, *(*ppB)++, alpha);
583 FreeRDPWriteColor(*ppRgba, DstFormat, color);
584 *ppRgba += FreeRDPGetBytesPerPixel(DstFormat);
585 }
586 }
587
588 return TRUE;
589 }
590}
591
592static inline BOOL planar_decompress_planes_raw(const BYTE* WINPR_RESTRICT pSrcData[4],
593 BYTE* WINPR_RESTRICT pDstData, UINT32 DstFormat,
594 UINT32 nDstStep, UINT32 nXDst, UINT32 nYDst,
595 UINT32 nWidth, UINT32 nHeight, BOOL vFlip,
596 UINT32 totalHeight)
597{
598 INT32 beg = 0;
599 INT32 end = 0;
600 INT32 inc = 0;
601 const BYTE* pR = pSrcData[0];
602 const BYTE* pG = pSrcData[1];
603 const BYTE* pB = pSrcData[2];
604 const BYTE* pA = pSrcData[3];
605 const UINT32 bpp = FreeRDPGetBytesPerPixel(DstFormat);
606
607 if (vFlip)
608 {
609 beg = WINPR_ASSERTING_INT_CAST(int32_t, nHeight - 1);
610 end = -1;
611 inc = -1;
612 }
613 else
614 {
615 beg = 0;
616 end = WINPR_ASSERTING_INT_CAST(int32_t, nHeight);
617 inc = 1;
618 }
619
620 if (nYDst + nHeight > totalHeight)
621 {
622 WLog_ERR(TAG,
623 "planar plane destination Y %" PRIu32 " + height %" PRIu32
624 " exceeds totalHeight %" PRIu32,
625 nYDst, nHeight, totalHeight);
626 return FALSE;
627 }
628
629 if ((nXDst + nWidth) * bpp > nDstStep)
630 {
631 WLog_ERR(TAG,
632 "planar plane destination (X %" PRIu32 " + width %" PRIu32 ") * bpp %" PRIu32
633 " exceeds stride %" PRIu32,
634 nXDst, nWidth, bpp, nDstStep);
635 return FALSE;
636 }
637
638 for (INT32 y = beg; y != end; y += inc)
639 {
640 BYTE* pRGB = NULL;
641
642 if (y > WINPR_ASSERTING_INT_CAST(INT64, nHeight))
643 {
644 WLog_ERR(TAG, "planar plane destination Y %" PRId32 " exceeds height %" PRIu32, y,
645 nHeight);
646 return FALSE;
647 }
648
649 const intptr_t off = ((1LL * nYDst + y) * nDstStep) + (1LL * nXDst * bpp);
650 pRGB = &pDstData[off];
651
652 if (!writeLine(&pRGB, DstFormat, nWidth, &pR, &pG, &pB, &pA))
653 return FALSE;
654 }
655
656 return TRUE;
657}
658
659static BOOL planar_subsample_expand(const BYTE* WINPR_RESTRICT plane, size_t planeLength,
660 UINT32 nWidth, UINT32 nHeight, UINT32 nPlaneWidth,
661 UINT32 nPlaneHeight, BYTE* WINPR_RESTRICT deltaPlane)
662{
663 size_t pos = 0;
664 WINPR_UNUSED(planeLength);
665
666 WINPR_ASSERT(plane);
667 WINPR_ASSERT(deltaPlane);
668
669 if (nWidth > nPlaneWidth * 2)
670 {
671 WLog_ERR(TAG, "planar subsample width %" PRIu32 " > PlaneWidth %" PRIu32 " * 2", nWidth,
672 nPlaneWidth);
673 return FALSE;
674 }
675
676 if (nHeight > nPlaneHeight * 2)
677 {
678 WLog_ERR(TAG, "planar subsample height %" PRIu32 " > PlaneHeight %" PRIu32 " * 2", nHeight,
679 nPlaneHeight);
680 return FALSE;
681 }
682
683 for (size_t y = 0; y < nHeight; y++)
684 {
685 const BYTE* src = plane + y / 2 * nPlaneWidth;
686
687 for (UINT32 x = 0; x < nWidth; x++)
688 {
689 deltaPlane[pos++] = src[x / 2];
690 }
691 }
692
693 return TRUE;
694}
695
696#if !defined(WITHOUT_FREERDP_3x_DEPRECATED)
697BOOL planar_decompress(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar,
698 const BYTE* WINPR_RESTRICT pSrcData, UINT32 SrcSize, UINT32 nSrcWidth,
699 UINT32 nSrcHeight, BYTE* WINPR_RESTRICT pDstData, UINT32 DstFormat,
700 UINT32 nDstStep, UINT32 nXDst, UINT32 nYDst, UINT32 nDstWidth,
701 UINT32 nDstHeight, BOOL vFlip)
702{
703 return freerdp_bitmap_decompress_planar(planar, pSrcData, SrcSize, nSrcWidth, nSrcHeight,
704 pDstData, DstFormat, nDstStep, nXDst, nYDst, nDstWidth,
705 nDstHeight, vFlip);
706}
707#endif
708
709BOOL freerdp_bitmap_decompress_planar(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar,
710 const BYTE* WINPR_RESTRICT pSrcData, UINT32 SrcSize,
711 UINT32 nSrcWidth, UINT32 nSrcHeight,
712 BYTE* WINPR_RESTRICT pDstData, UINT32 DstFormat,
713 UINT32 nDstStep, UINT32 nXDst, UINT32 nYDst, UINT32 nDstWidth,
714 UINT32 nDstHeight, BOOL vFlip)
715{
716 BOOL useAlpha = FALSE;
717 INT32 status = 0;
718 INT32 rleSizes[4] = { 0, 0, 0, 0 };
719 UINT32 rawSizes[4] = { 0 };
720 UINT32 rawWidths[4] = { 0 };
721 UINT32 rawHeights[4] = { 0 };
722 const BYTE* planes[4] = { 0 };
723 const UINT32 w = MIN(nSrcWidth, nDstWidth);
724 const UINT32 h = MIN(nSrcHeight, nDstHeight);
725 const primitives_t* prims = primitives_get();
726
727 WINPR_ASSERT(planar);
728 WINPR_ASSERT(prims);
729
730 if (nDstStep <= 0)
731 nDstStep = nDstWidth * FreeRDPGetBytesPerPixel(DstFormat);
732
733 const BYTE* srcp = pSrcData;
734
735 if (!pSrcData)
736 {
737 WLog_ERR(TAG, "Invalid argument pSrcData=NULL");
738 return FALSE;
739 }
740
741 if (!pDstData)
742 {
743 WLog_ERR(TAG, "Invalid argument pDstData=NULL");
744 return FALSE;
745 }
746
747 const BYTE FormatHeader = *srcp++;
748 const BYTE cll = (FormatHeader & PLANAR_FORMAT_HEADER_CLL_MASK);
749 const BYTE cs = (FormatHeader & PLANAR_FORMAT_HEADER_CS) ? TRUE : FALSE;
750 const BYTE rle = (FormatHeader & PLANAR_FORMAT_HEADER_RLE) ? TRUE : FALSE;
751 const BYTE alpha = (FormatHeader & PLANAR_FORMAT_HEADER_NA) ? FALSE : TRUE;
752
753 DstFormat = planar_invert_format(planar, alpha, DstFormat);
754
755 if (alpha)
756 useAlpha = FreeRDPColorHasAlpha(DstFormat);
757
758 // WLog_INFO(TAG, "CLL: %"PRIu32" CS: %"PRIu8" RLE: %"PRIu8" ALPHA: %"PRIu8"", cll, cs, rle,
759 // alpha);
760
761 if (!cll && cs)
762 {
763 WLog_ERR(TAG, "Chroma subsampling requires YCoCg and does not work with RGB data");
764 return FALSE; /* Chroma subsampling requires YCoCg */
765 }
766
767 const UINT32 subWidth = (nSrcWidth / 2) + (nSrcWidth % 2);
768 const UINT32 subHeight = (nSrcHeight / 2) + (nSrcHeight % 2);
769 const UINT32 planeSize = nSrcWidth * nSrcHeight;
770 const UINT32 subSize = subWidth * subHeight;
771
772 if (!cs)
773 {
774 rawSizes[0] = planeSize; /* LumaOrRedPlane */
775 rawWidths[0] = nSrcWidth;
776 rawHeights[0] = nSrcHeight;
777 rawSizes[1] = planeSize; /* OrangeChromaOrGreenPlane */
778 rawWidths[1] = nSrcWidth;
779 rawHeights[1] = nSrcHeight;
780 rawSizes[2] = planeSize; /* GreenChromaOrBluePlane */
781 rawWidths[2] = nSrcWidth;
782 rawHeights[2] = nSrcHeight;
783 rawSizes[3] = planeSize; /* AlphaPlane */
784 rawWidths[3] = nSrcWidth;
785 rawHeights[3] = nSrcHeight;
786 }
787 else /* Chroma Subsampling */
788 {
789 rawSizes[0] = planeSize; /* LumaOrRedPlane */
790 rawWidths[0] = nSrcWidth;
791 rawHeights[0] = nSrcHeight;
792 rawSizes[1] = subSize; /* OrangeChromaOrGreenPlane */
793 rawWidths[1] = subWidth;
794 rawHeights[1] = subHeight;
795 rawSizes[2] = subSize; /* GreenChromaOrBluePlane */
796 rawWidths[2] = subWidth;
797 rawHeights[2] = subHeight;
798 rawSizes[3] = planeSize; /* AlphaPlane */
799 rawWidths[3] = nSrcWidth;
800 rawHeights[3] = nSrcHeight;
801 }
802
803 const size_t diff = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(srcp - pSrcData));
804 if (SrcSize < diff)
805 {
806 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff);
807 return FALSE;
808 }
809
810 if (!rle) /* RAW */
811 {
812
813 UINT32 base = planeSize * 3;
814 if (cs)
815 base = planeSize + planeSize / 2;
816
817 if (alpha)
818 {
819 if ((SrcSize - diff) < (planeSize + base))
820 {
821 WLog_ERR(TAG, "Alpha plane size mismatch %" PRIuz " < %" PRIu32, SrcSize - diff,
822 (planeSize + base));
823 return FALSE;
824 }
825
826 planes[3] = srcp; /* AlphaPlane */
827 planes[0] = planes[3] + rawSizes[3]; /* LumaOrRedPlane */
828 planes[1] = planes[0] + rawSizes[0]; /* OrangeChromaOrGreenPlane */
829 planes[2] = planes[1] + rawSizes[1]; /* GreenChromaOrBluePlane */
830
831 if ((planes[2] + rawSizes[2]) > &pSrcData[SrcSize])
832 {
833 WLog_ERR(TAG, "plane size mismatch %p + %" PRIu32 " > %p", planes[2], rawSizes[2],
834 &pSrcData[SrcSize]);
835 return FALSE;
836 }
837 }
838 else
839 {
840 if ((SrcSize - diff) < base)
841 {
842 WLog_ERR(TAG, "plane size mismatch %" PRIu32 " < %" PRIu32, SrcSize - diff, base);
843 return FALSE;
844 }
845
846 planes[0] = srcp; /* LumaOrRedPlane */
847 planes[1] = planes[0] + rawSizes[0]; /* OrangeChromaOrGreenPlane */
848 planes[2] = planes[1] + rawSizes[1]; /* GreenChromaOrBluePlane */
849
850 if ((planes[2] + rawSizes[2]) > &pSrcData[SrcSize])
851 {
852 WLog_ERR(TAG, "plane size mismatch %p + %" PRIu32 " > %p", planes[2], rawSizes[2],
853 &pSrcData[SrcSize]);
854 return FALSE;
855 }
856 }
857 }
858 else /* RLE */
859 {
860 if (alpha)
861 {
862 planes[3] = srcp;
863 rleSizes[3] = planar_skip_plane_rle(planes[3], (UINT32)(SrcSize - diff), rawWidths[3],
864 rawHeights[3]); /* AlphaPlane */
865
866 if (rleSizes[3] < 0)
867 return FALSE;
868
869 planes[0] = planes[3] + rleSizes[3];
870 }
871 else
872 planes[0] = srcp;
873
874 const size_t diff0 = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(planes[0] - pSrcData));
875 if (SrcSize < diff0)
876 {
877 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff0);
878 return FALSE;
879 }
880 rleSizes[0] = planar_skip_plane_rle(planes[0], (UINT32)(SrcSize - diff0), rawWidths[0],
881 rawHeights[0]); /* RedPlane */
882
883 if (rleSizes[0] < 0)
884 return FALSE;
885
886 planes[1] = planes[0] + rleSizes[0];
887
888 const size_t diff1 = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(planes[1] - pSrcData));
889 if (SrcSize < diff1)
890 {
891 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff1);
892 return FALSE;
893 }
894 rleSizes[1] = planar_skip_plane_rle(planes[1], (UINT32)(SrcSize - diff1), rawWidths[1],
895 rawHeights[1]); /* GreenPlane */
896
897 if (rleSizes[1] < 1)
898 return FALSE;
899
900 planes[2] = planes[1] + rleSizes[1];
901 const size_t diff2 = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(planes[2] - pSrcData));
902 if (SrcSize < diff2)
903 {
904 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff);
905 return FALSE;
906 }
907 rleSizes[2] = planar_skip_plane_rle(planes[2], (UINT32)(SrcSize - diff2), rawWidths[2],
908 rawHeights[2]); /* BluePlane */
909
910 if (rleSizes[2] < 1)
911 return FALSE;
912 }
913
914 if (!cll) /* RGB */
915 {
916 UINT32 TempFormat = 0;
917 BYTE* pTempData = pDstData;
918 UINT32 nTempStep = nDstStep;
919 UINT32 nTotalHeight = nYDst + nDstHeight;
920
921 if (useAlpha)
922 TempFormat = PIXEL_FORMAT_BGRA32;
923 else
924 TempFormat = PIXEL_FORMAT_BGRX32;
925
926 TempFormat = planar_invert_format(planar, alpha, TempFormat);
927
928 if ((TempFormat != DstFormat) || (nSrcWidth != nDstWidth) || (nSrcHeight != nDstHeight))
929 {
930 pTempData = planar->pTempData;
931 nTempStep = planar->nTempStep;
932 nTotalHeight = planar->maxHeight;
933 }
934
935 if (!rle) /* RAW */
936 {
937 if (!planar_decompress_planes_raw(planes, pTempData, TempFormat, nTempStep, nXDst,
938 nYDst, nSrcWidth, nSrcHeight, vFlip, nTotalHeight))
939 return FALSE;
940
941 if (alpha)
942 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2] + rawSizes[3];
943 else /* NoAlpha */
944 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2];
945
946 if ((SrcSize - (srcp - pSrcData)) == 1)
947 srcp++; /* pad */
948 }
949 else /* RLE */
950 {
951 status = planar_decompress_plane_rle(
952 planes[0], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[0]), pTempData, nTempStep,
953 nXDst, nYDst, nSrcWidth, nSrcHeight, 2, vFlip); /* RedPlane */
954
955 if (status < 0)
956 return FALSE;
957
958 status = planar_decompress_plane_rle(
959 planes[1], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[1]), pTempData, nTempStep,
960 nXDst, nYDst, nSrcWidth, nSrcHeight, 1, vFlip); /* GreenPlane */
961
962 if (status < 0)
963 return FALSE;
964
965 status = planar_decompress_plane_rle(
966 planes[2], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[2]), pTempData, nTempStep,
967 nXDst, nYDst, nSrcWidth, nSrcHeight, 0, vFlip); /* BluePlane */
968
969 if (status < 0)
970 return FALSE;
971
972 srcp += rleSizes[0] + rleSizes[1] + rleSizes[2];
973
974 if (useAlpha)
975 {
976 status = planar_decompress_plane_rle(
977 planes[3], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[3]), pTempData,
978 nTempStep, nXDst, nYDst, nSrcWidth, nSrcHeight, 3, vFlip); /* AlphaPlane */
979 }
980 else
981 status = planar_set_plane(0xFF, pTempData, nTempStep, nXDst, nYDst, nSrcWidth,
982 nSrcHeight, 3, vFlip);
983
984 if (status < 0)
985 return FALSE;
986
987 if (alpha)
988 srcp += rleSizes[3];
989 }
990
991 if (pTempData != pDstData)
992 {
993 if (!freerdp_image_copy_no_overlap(pDstData, DstFormat, nDstStep, nXDst, nYDst, w, h,
994 pTempData, TempFormat, nTempStep, nXDst, nYDst, NULL,
995 FREERDP_FLIP_NONE))
996 {
997 WLog_ERR(TAG, "planar image copy failed");
998 return FALSE;
999 }
1000 }
1001 }
1002 else /* YCoCg */
1003 {
1004 UINT32 TempFormat = 0;
1005 BYTE* pTempData = planar->pTempData;
1006 UINT32 nTempStep = planar->nTempStep;
1007 UINT32 nTotalHeight = planar->maxHeight;
1008 BYTE* dst = &pDstData[nXDst * FreeRDPGetBytesPerPixel(DstFormat) + nYDst * nDstStep];
1009
1010 if (useAlpha)
1011 TempFormat = PIXEL_FORMAT_BGRA32;
1012 else
1013 TempFormat = PIXEL_FORMAT_BGRX32;
1014
1015 if (!pTempData)
1016 return FALSE;
1017
1018 if (rle) /* RLE encoded data. Decode and handle it like raw data. */
1019 {
1020 BYTE* rleBuffer[4] = { 0 };
1021
1022 if (!planar->rlePlanesBuffer)
1023 return FALSE;
1024
1025 rleBuffer[3] = planar->rlePlanesBuffer; /* AlphaPlane */
1026 rleBuffer[0] = rleBuffer[3] + planeSize; /* LumaOrRedPlane */
1027 rleBuffer[1] = rleBuffer[0] + planeSize; /* OrangeChromaOrGreenPlane */
1028 rleBuffer[2] = rleBuffer[1] + planeSize; /* GreenChromaOrBluePlane */
1029 if (useAlpha)
1030 {
1031 status = planar_decompress_plane_rle_only(
1032 planes[3], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[3]), rleBuffer[3],
1033 rawWidths[3], rawHeights[3]); /* AlphaPlane */
1034
1035 if (status < 0)
1036 return FALSE;
1037 }
1038
1039 if (alpha)
1040 srcp += rleSizes[3];
1041
1042 status = planar_decompress_plane_rle_only(
1043 planes[0], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[0]), rleBuffer[0],
1044 rawWidths[0], rawHeights[0]); /* LumaPlane */
1045
1046 if (status < 0)
1047 return FALSE;
1048
1049 status = planar_decompress_plane_rle_only(
1050 planes[1], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[1]), rleBuffer[1],
1051 rawWidths[1], rawHeights[1]); /* OrangeChromaPlane */
1052
1053 if (status < 0)
1054 return FALSE;
1055
1056 status = planar_decompress_plane_rle_only(
1057 planes[2], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[2]), rleBuffer[2],
1058 rawWidths[2], rawHeights[2]); /* GreenChromaPlane */
1059
1060 if (status < 0)
1061 return FALSE;
1062
1063 planes[0] = rleBuffer[0];
1064 planes[1] = rleBuffer[1];
1065 planes[2] = rleBuffer[2];
1066 planes[3] = rleBuffer[3];
1067 }
1068
1069 /* RAW */
1070 {
1071 if (cs)
1072 { /* Chroma subsampling for Co and Cg:
1073 * Each pixel contains the value that should be expanded to
1074 * [2x,2y;2x+1,2y;2x+1,2y+1;2x;2y+1] */
1075 if (!planar_subsample_expand(planes[1], rawSizes[1], nSrcWidth, nSrcHeight,
1076 rawWidths[1], rawHeights[1], planar->deltaPlanes[0]))
1077 return FALSE;
1078
1079 planes[1] = planar->deltaPlanes[0];
1080 rawSizes[1] = planeSize; /* OrangeChromaOrGreenPlane */
1081 rawWidths[1] = nSrcWidth;
1082 rawHeights[1] = nSrcHeight;
1083
1084 if (!planar_subsample_expand(planes[2], rawSizes[2], nSrcWidth, nSrcHeight,
1085 rawWidths[2], rawHeights[2], planar->deltaPlanes[1]))
1086 return FALSE;
1087
1088 planes[2] = planar->deltaPlanes[1];
1089 rawSizes[2] = planeSize; /* GreenChromaOrBluePlane */
1090 rawWidths[2] = nSrcWidth;
1091 rawHeights[2] = nSrcHeight;
1092 }
1093
1094 if (!planar_decompress_planes_raw(planes, pTempData, TempFormat, nTempStep, nXDst,
1095 nYDst, nSrcWidth, nSrcHeight, vFlip, nTotalHeight))
1096 return FALSE;
1097
1098 if (alpha)
1099 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2] + rawSizes[3];
1100 else /* NoAlpha */
1101 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2];
1102
1103 if ((SrcSize - (srcp - pSrcData)) == 1)
1104 srcp++; /* pad */
1105 }
1106
1107 WINPR_ASSERT(prims->YCoCgToRGB_8u_AC4R);
1108 int rc = prims->YCoCgToRGB_8u_AC4R(
1109 pTempData, WINPR_ASSERTING_INT_CAST(int32_t, nTempStep), dst, DstFormat,
1110 WINPR_ASSERTING_INT_CAST(int32_t, nDstStep), w, h, cll, useAlpha);
1111 if (rc != PRIMITIVES_SUCCESS)
1112 {
1113 WLog_ERR(TAG, "YCoCgToRGB_8u_AC4R failed with %d", rc);
1114 return FALSE;
1115 }
1116 }
1117
1118 WINPR_UNUSED(srcp);
1119 return TRUE;
1120}
1121
1122static inline BOOL freerdp_split_color_planes(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar,
1123 const BYTE* WINPR_RESTRICT data, UINT32 format,
1124 UINT32 width, UINT32 height, UINT32 scanline,
1125 BYTE* WINPR_RESTRICT planes[4])
1126{
1127 WINPR_ASSERT(planar);
1128
1129 if ((width > INT32_MAX) || (height > INT32_MAX) || (scanline > INT32_MAX))
1130 return FALSE;
1131
1132 if (scanline == 0)
1133 scanline = width * FreeRDPGetBytesPerPixel(format);
1134
1135 if (planar->topdown)
1136 {
1137 UINT32 k = 0;
1138 for (UINT32 i = 0; i < height; i++)
1139 {
1140 const BYTE* pixel = &data[1ULL * scanline * i];
1141
1142 for (UINT32 j = 0; j < width; j++)
1143 {
1144 const UINT32 color = FreeRDPReadColor(pixel, format);
1145 pixel += FreeRDPGetBytesPerPixel(format);
1146 FreeRDPSplitColor(color, format, &planes[1][k], &planes[2][k], &planes[3][k],
1147 &planes[0][k], NULL);
1148 k++;
1149 }
1150 }
1151 }
1152 else
1153 {
1154 UINT32 k = 0;
1155
1156 for (INT64 i = (INT64)height - 1; i >= 0; i--)
1157 {
1158 const BYTE* pixel = &data[1ULL * scanline * (UINT32)i];
1159
1160 for (UINT32 j = 0; j < width; j++)
1161 {
1162 const UINT32 color = FreeRDPReadColor(pixel, format);
1163 pixel += FreeRDPGetBytesPerPixel(format);
1164 FreeRDPSplitColor(color, format, &planes[1][k], &planes[2][k], &planes[3][k],
1165 &planes[0][k], NULL);
1166 k++;
1167 }
1168 }
1169 }
1170 return TRUE;
1171}
1172
1173static inline UINT32 freerdp_bitmap_planar_write_rle_bytes(const BYTE* WINPR_RESTRICT pInBuffer,
1174 UINT32 cRawBytes, UINT32 nRunLength,
1175 BYTE* WINPR_RESTRICT pOutBuffer,
1176 UINT32 outBufferSize)
1177{
1178 const BYTE* pInput = pInBuffer;
1179 BYTE* pOutput = pOutBuffer;
1180 BYTE controlByte = 0;
1181 UINT32 nBytesToWrite = 0;
1182
1183 if (!cRawBytes && !nRunLength)
1184 return 0;
1185
1186 if (nRunLength < 3)
1187 {
1188 cRawBytes += nRunLength;
1189 nRunLength = 0;
1190 }
1191
1192 while (cRawBytes)
1193 {
1194 if (cRawBytes < 16)
1195 {
1196 if (nRunLength > 15)
1197 {
1198 if (nRunLength < 18)
1199 {
1200 controlByte = PLANAR_CONTROL_BYTE(13, cRawBytes);
1201 nRunLength -= 13;
1202 cRawBytes = 0;
1203 }
1204 else
1205 {
1206 controlByte = PLANAR_CONTROL_BYTE(15, cRawBytes);
1207 nRunLength -= 15;
1208 cRawBytes = 0;
1209 }
1210 }
1211 else
1212 {
1213 controlByte = PLANAR_CONTROL_BYTE(nRunLength, cRawBytes);
1214 nRunLength = 0;
1215 cRawBytes = 0;
1216 }
1217 }
1218 else
1219 {
1220 controlByte = PLANAR_CONTROL_BYTE(0, 15);
1221 cRawBytes -= 15;
1222 }
1223
1224 if (outBufferSize < 1)
1225 return 0;
1226
1227 outBufferSize--;
1228 *pOutput = controlByte;
1229 pOutput++;
1230 nBytesToWrite = (controlByte >> 4);
1231
1232 if (nBytesToWrite)
1233 {
1234 if (outBufferSize < nBytesToWrite)
1235 return 0;
1236
1237 outBufferSize -= nBytesToWrite;
1238 CopyMemory(pOutput, pInput, nBytesToWrite);
1239 pOutput += nBytesToWrite;
1240 pInput += nBytesToWrite;
1241 }
1242 }
1243
1244 while (nRunLength)
1245 {
1246 if (nRunLength > 47)
1247 {
1248 if (nRunLength < 50)
1249 {
1250 controlByte = PLANAR_CONTROL_BYTE(2, 13);
1251 nRunLength -= 45;
1252 }
1253 else
1254 {
1255 controlByte = PLANAR_CONTROL_BYTE(2, 15);
1256 nRunLength -= 47;
1257 }
1258 }
1259 else if (nRunLength > 31)
1260 {
1261 controlByte = PLANAR_CONTROL_BYTE(2, (nRunLength - 32));
1262 nRunLength = 0;
1263 }
1264 else if (nRunLength > 15)
1265 {
1266 controlByte = PLANAR_CONTROL_BYTE(1, (nRunLength - 16));
1267 nRunLength = 0;
1268 }
1269 else
1270 {
1271 controlByte = PLANAR_CONTROL_BYTE(nRunLength, 0);
1272 nRunLength = 0;
1273 }
1274
1275 if (outBufferSize < 1)
1276 return 0;
1277
1278 --outBufferSize;
1279 *pOutput = controlByte;
1280 pOutput++;
1281 }
1282
1283 const intptr_t diff = (pOutput - pOutBuffer);
1284 if ((diff < 0) || (diff > UINT32_MAX))
1285 return 0;
1286 return (UINT32)diff;
1287}
1288
1289static inline UINT32 freerdp_bitmap_planar_encode_rle_bytes(const BYTE* WINPR_RESTRICT pInBuffer,
1290 UINT32 inBufferSize,
1291 BYTE* WINPR_RESTRICT pOutBuffer,
1292 UINT32 outBufferSize)
1293{
1294 BYTE symbol = 0;
1295 const BYTE* pInput = pInBuffer;
1296 BYTE* pOutput = pOutBuffer;
1297 const BYTE* pBytes = NULL;
1298 UINT32 cRawBytes = 0;
1299 UINT32 nRunLength = 0;
1300 UINT32 nBytesWritten = 0;
1301 UINT32 nTotalBytesWritten = 0;
1302
1303 if (!outBufferSize)
1304 return 0;
1305
1306 do
1307 {
1308 if (!inBufferSize)
1309 break;
1310
1311 const UINT32 bSymbolMatch = (symbol == *pInput) ? TRUE : FALSE;
1312 symbol = *pInput;
1313 pInput++;
1314 inBufferSize--;
1315
1316 if (nRunLength && !bSymbolMatch)
1317 {
1318 if (nRunLength < 3)
1319 {
1320 cRawBytes += nRunLength;
1321 nRunLength = 0;
1322 }
1323 else
1324 {
1325 pBytes = pInput - (cRawBytes + nRunLength + 1);
1326 nBytesWritten = freerdp_bitmap_planar_write_rle_bytes(pBytes, cRawBytes, nRunLength,
1327 pOutput, outBufferSize);
1328 nRunLength = 0;
1329
1330 if (!nBytesWritten || (nBytesWritten > outBufferSize))
1331 return nRunLength;
1332
1333 nTotalBytesWritten += nBytesWritten;
1334 outBufferSize -= nBytesWritten;
1335 pOutput += nBytesWritten;
1336 cRawBytes = 0;
1337 }
1338 }
1339
1340 nRunLength += bSymbolMatch;
1341 cRawBytes += (!bSymbolMatch) ? TRUE : FALSE;
1342 } while (outBufferSize);
1343
1344 if (cRawBytes || nRunLength)
1345 {
1346 pBytes = pInput - (cRawBytes + nRunLength);
1347 nBytesWritten = freerdp_bitmap_planar_write_rle_bytes(pBytes, cRawBytes, nRunLength,
1348 pOutput, outBufferSize);
1349
1350 if (!nBytesWritten)
1351 return 0;
1352
1353 nTotalBytesWritten += nBytesWritten;
1354 }
1355
1356 if (inBufferSize)
1357 return 0;
1358
1359 return nTotalBytesWritten;
1360}
1361
1362BOOL freerdp_bitmap_planar_compress_plane_rle(const BYTE* WINPR_RESTRICT inPlane, UINT32 width,
1363 UINT32 height, BYTE* WINPR_RESTRICT outPlane,
1364 UINT32* WINPR_RESTRICT dstSize)
1365{
1366 if (!outPlane)
1367 return FALSE;
1368
1369 UINT32 index = 0;
1370 const BYTE* pInput = inPlane;
1371 BYTE* pOutput = outPlane;
1372 UINT32 outBufferSize = *dstSize;
1373 UINT32 nTotalBytesWritten = 0;
1374
1375 while (outBufferSize > 0)
1376 {
1377 const UINT32 nBytesWritten =
1378 freerdp_bitmap_planar_encode_rle_bytes(pInput, width, pOutput, outBufferSize);
1379
1380 if ((!nBytesWritten) || (nBytesWritten > outBufferSize))
1381 return FALSE;
1382
1383 outBufferSize -= nBytesWritten;
1384 nTotalBytesWritten += nBytesWritten;
1385 pOutput += nBytesWritten;
1386 pInput += width;
1387 index++;
1388
1389 if (index >= height)
1390 break;
1391 }
1392
1393 *dstSize = nTotalBytesWritten;
1394 return TRUE;
1395}
1396
1397static inline BOOL freerdp_bitmap_planar_compress_planes_rle(BYTE* WINPR_RESTRICT inPlanes[4],
1398 UINT32 width, UINT32 height,
1399 BYTE* WINPR_RESTRICT outPlanes,
1400 UINT32* WINPR_RESTRICT dstSizes,
1401 BOOL skipAlpha)
1402{
1403 UINT32 outPlanesSize = width * height * 4;
1404
1405 /* AlphaPlane */
1406 if (skipAlpha)
1407 {
1408 dstSizes[0] = 0;
1409 }
1410 else
1411 {
1412 dstSizes[0] = outPlanesSize;
1413
1414 if (!freerdp_bitmap_planar_compress_plane_rle(inPlanes[0], width, height, outPlanes,
1415 &dstSizes[0]))
1416 return FALSE;
1417
1418 outPlanes += dstSizes[0];
1419 outPlanesSize -= dstSizes[0];
1420 }
1421
1422 /* LumaOrRedPlane */
1423 dstSizes[1] = outPlanesSize;
1424
1425 if (!freerdp_bitmap_planar_compress_plane_rle(inPlanes[1], width, height, outPlanes,
1426 &dstSizes[1]))
1427 return FALSE;
1428
1429 outPlanes += dstSizes[1];
1430 outPlanesSize -= dstSizes[1];
1431 /* OrangeChromaOrGreenPlane */
1432 dstSizes[2] = outPlanesSize;
1433
1434 if (!freerdp_bitmap_planar_compress_plane_rle(inPlanes[2], width, height, outPlanes,
1435 &dstSizes[2]))
1436 return FALSE;
1437
1438 outPlanes += dstSizes[2];
1439 outPlanesSize -= dstSizes[2];
1440 /* GreenChromeOrBluePlane */
1441 dstSizes[3] = outPlanesSize;
1442
1443 if (!freerdp_bitmap_planar_compress_plane_rle(inPlanes[3], width, height, outPlanes,
1444 &dstSizes[3]))
1445 return FALSE;
1446
1447 return TRUE;
1448}
1449
1450BYTE* freerdp_bitmap_planar_delta_encode_plane(const BYTE* WINPR_RESTRICT inPlane, UINT32 width,
1451 UINT32 height, BYTE* WINPR_RESTRICT outPlane)
1452{
1453 if (!outPlane)
1454 {
1455 if (width * height == 0)
1456 return NULL;
1457
1458 outPlane = (BYTE*)calloc(height, width);
1459 if (!outPlane)
1460 return NULL;
1461 }
1462
1463 // first line is copied as is
1464 CopyMemory(outPlane, inPlane, width);
1465
1466 for (UINT32 y = 1; y < height; y++)
1467 {
1468 const size_t off = 1ull * width * y;
1469 BYTE* outPtr = &outPlane[off];
1470 const BYTE* srcPtr = &inPlane[off];
1471 const BYTE* prevLinePtr = &inPlane[off - width];
1472 for (UINT32 x = 0; x < width; x++)
1473 {
1474 const int delta = (int)srcPtr[x] - (int)prevLinePtr[x];
1475 const int s2c1i = (delta >= 0) ? delta : (INT_MAX + delta) + 1;
1476 const int8_t s2c1 = WINPR_CXX_COMPAT_CAST(int8_t, s2c1i);
1477 const uint32_t s2c =
1478 (s2c1 >= 0) ? ((UINT32)s2c1 << 1) : (((UINT32)(~(s2c1) + 1) << 1) - 1);
1479 outPtr[x] = (BYTE)s2c;
1480 }
1481 }
1482
1483 return outPlane;
1484}
1485
1486static inline BOOL freerdp_bitmap_planar_delta_encode_planes(BYTE* WINPR_RESTRICT inPlanes[4],
1487 UINT32 width, UINT32 height,
1488 BYTE* WINPR_RESTRICT outPlanes[4])
1489{
1490 for (UINT32 i = 0; i < 4; i++)
1491 {
1492 outPlanes[i] =
1493 freerdp_bitmap_planar_delta_encode_plane(inPlanes[i], width, height, outPlanes[i]);
1494
1495 if (!outPlanes[i])
1496 return FALSE;
1497 }
1498
1499 return TRUE;
1500}
1501
1502BYTE* freerdp_bitmap_compress_planar(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT context,
1503 const BYTE* WINPR_RESTRICT data, UINT32 format, UINT32 width,
1504 UINT32 height, UINT32 scanline, BYTE* WINPR_RESTRICT dstData,
1505 UINT32* WINPR_RESTRICT pDstSize)
1506{
1507 UINT32 size = 0;
1508 BYTE* dstp = NULL;
1509 UINT32 dstSizes[4] = { 0 };
1510 BYTE FormatHeader = 0;
1511
1512 if (!context || !context->rlePlanesBuffer)
1513 return NULL;
1514
1515 if (context->AllowSkipAlpha)
1516 FormatHeader |= PLANAR_FORMAT_HEADER_NA;
1517
1518 const UINT32 planeSize = width * height;
1519
1520 if (!context->AllowSkipAlpha)
1521 format = planar_invert_format(context, TRUE, format);
1522
1523 if (!freerdp_split_color_planes(context, data, format, width, height, scanline,
1524 context->planes))
1525 return NULL;
1526
1527 if (context->AllowRunLengthEncoding)
1528 {
1529 if (!freerdp_bitmap_planar_delta_encode_planes(context->planes, width, height,
1530 context->deltaPlanes))
1531 return NULL;
1532
1533 if (!freerdp_bitmap_planar_compress_planes_rle(context->deltaPlanes, width, height,
1534 context->rlePlanesBuffer, dstSizes,
1535 context->AllowSkipAlpha))
1536 return NULL;
1537
1538 {
1539 uint32_t offset = 0;
1540 FormatHeader |= PLANAR_FORMAT_HEADER_RLE;
1541 context->rlePlanes[0] = &context->rlePlanesBuffer[offset];
1542 offset += dstSizes[0];
1543 context->rlePlanes[1] = &context->rlePlanesBuffer[offset];
1544 offset += dstSizes[1];
1545 context->rlePlanes[2] = &context->rlePlanesBuffer[offset];
1546 offset += dstSizes[2];
1547 context->rlePlanes[3] = &context->rlePlanesBuffer[offset];
1548
1549#if defined(WITH_DEBUG_CODECS)
1550 WLog_DBG(TAG,
1551 "R: [%" PRIu32 "/%" PRIu32 "] G: [%" PRIu32 "/%" PRIu32 "] B: [%" PRIu32
1552 " / %" PRIu32 "] ",
1553 dstSizes[1], planeSize, dstSizes[2], planeSize, dstSizes[3], planeSize);
1554#endif
1555 }
1556 }
1557
1558 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1559 {
1560 if (!context->AllowRunLengthEncoding)
1561 return NULL;
1562
1563 if (context->rlePlanes[0] == NULL)
1564 return NULL;
1565
1566 if (context->rlePlanes[1] == NULL)
1567 return NULL;
1568
1569 if (context->rlePlanes[2] == NULL)
1570 return NULL;
1571
1572 if (context->rlePlanes[3] == NULL)
1573 return NULL;
1574 }
1575
1576 if (!dstData)
1577 {
1578 size = 1;
1579
1580 if (!(FormatHeader & PLANAR_FORMAT_HEADER_NA))
1581 {
1582 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1583 size += dstSizes[0];
1584 else
1585 size += planeSize;
1586 }
1587
1588 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1589 size += (dstSizes[1] + dstSizes[2] + dstSizes[3]);
1590 else
1591 size += (planeSize * 3);
1592
1593 if (!(FormatHeader & PLANAR_FORMAT_HEADER_RLE))
1594 size++;
1595
1596 dstData = malloc(size);
1597
1598 if (!dstData)
1599 return NULL;
1600
1601 *pDstSize = size;
1602 }
1603
1604 dstp = dstData;
1605 *dstp = FormatHeader; /* FormatHeader */
1606 dstp++;
1607
1608 /* AlphaPlane */
1609
1610 if (!(FormatHeader & PLANAR_FORMAT_HEADER_NA))
1611 {
1612 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1613 {
1614 CopyMemory(dstp, context->rlePlanes[0], dstSizes[0]); /* Alpha */
1615 dstp += dstSizes[0];
1616 }
1617 else
1618 {
1619 CopyMemory(dstp, context->planes[0], planeSize); /* Alpha */
1620 dstp += planeSize;
1621 }
1622 }
1623
1624 /* LumaOrRedPlane */
1625
1626 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1627 {
1628 CopyMemory(dstp, context->rlePlanes[1], dstSizes[1]); /* Red */
1629 dstp += dstSizes[1];
1630 }
1631 else
1632 {
1633 CopyMemory(dstp, context->planes[1], planeSize); /* Red */
1634 dstp += planeSize;
1635 }
1636
1637 /* OrangeChromaOrGreenPlane */
1638
1639 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1640 {
1641 CopyMemory(dstp, context->rlePlanes[2], dstSizes[2]); /* Green */
1642 dstp += dstSizes[2];
1643 }
1644 else
1645 {
1646 CopyMemory(dstp, context->planes[2], planeSize); /* Green */
1647 dstp += planeSize;
1648 }
1649
1650 /* GreenChromeOrBluePlane */
1651
1652 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1653 {
1654 CopyMemory(dstp, context->rlePlanes[3], dstSizes[3]); /* Blue */
1655 dstp += dstSizes[3];
1656 }
1657 else
1658 {
1659 CopyMemory(dstp, context->planes[3], planeSize); /* Blue */
1660 dstp += planeSize;
1661 }
1662
1663 /* Pad1 (1 byte) */
1664
1665 if (!(FormatHeader & PLANAR_FORMAT_HEADER_RLE))
1666 {
1667 *dstp = 0;
1668 dstp++;
1669 }
1670
1671 const intptr_t diff = (dstp - dstData);
1672 if ((diff < 0) || (diff > UINT32_MAX))
1673 {
1674 free(dstData);
1675 return NULL;
1676 }
1677 size = (UINT32)diff;
1678 *pDstSize = size;
1679 return dstData;
1680}
1681
1682BOOL freerdp_bitmap_planar_context_reset(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT context,
1683 UINT32 width, UINT32 height)
1684{
1685 if (!context)
1686 return FALSE;
1687
1688 context->bgr = FALSE;
1689 context->maxWidth = PLANAR_ALIGN(width, 4);
1690 context->maxHeight = PLANAR_ALIGN(height, 4);
1691 {
1692 const UINT64 tmp = (UINT64)context->maxWidth * context->maxHeight;
1693 if (tmp > UINT32_MAX)
1694 return FALSE;
1695 context->maxPlaneSize = (UINT32)tmp;
1696 }
1697
1698 if (context->maxWidth > UINT32_MAX / 4)
1699 return FALSE;
1700 context->nTempStep = context->maxWidth * 4;
1701
1702 memset((void*)context->planes, 0, sizeof(context->planes));
1703 memset((void*)context->rlePlanes, 0, sizeof(context->rlePlanes));
1704 memset((void*)context->deltaPlanes, 0, sizeof(context->deltaPlanes));
1705
1706 if (context->maxPlaneSize > 0)
1707 {
1708 void* tmp = winpr_aligned_recalloc(context->planesBuffer, context->maxPlaneSize, 4, 32);
1709 if (!tmp)
1710 return FALSE;
1711 context->planesBuffer = tmp;
1712
1713 tmp = winpr_aligned_recalloc(context->pTempData, context->maxPlaneSize, 6, 32);
1714 if (!tmp)
1715 return FALSE;
1716 context->pTempData = tmp;
1717
1718 tmp = winpr_aligned_recalloc(context->deltaPlanesBuffer, context->maxPlaneSize, 4, 32);
1719 if (!tmp)
1720 return FALSE;
1721 context->deltaPlanesBuffer = tmp;
1722
1723 tmp = winpr_aligned_recalloc(context->rlePlanesBuffer, context->maxPlaneSize, 4, 32);
1724 if (!tmp)
1725 return FALSE;
1726 context->rlePlanesBuffer = tmp;
1727
1728 context->planes[0] = &context->planesBuffer[0ULL * context->maxPlaneSize];
1729 context->planes[1] = &context->planesBuffer[1ULL * context->maxPlaneSize];
1730 context->planes[2] = &context->planesBuffer[2ULL * context->maxPlaneSize];
1731 context->planes[3] = &context->planesBuffer[3ULL * context->maxPlaneSize];
1732 context->deltaPlanes[0] = &context->deltaPlanesBuffer[0ULL * context->maxPlaneSize];
1733 context->deltaPlanes[1] = &context->deltaPlanesBuffer[1ULL * context->maxPlaneSize];
1734 context->deltaPlanes[2] = &context->deltaPlanesBuffer[2ULL * context->maxPlaneSize];
1735 context->deltaPlanes[3] = &context->deltaPlanesBuffer[3ULL * context->maxPlaneSize];
1736 }
1737 return TRUE;
1738}
1739
1740BITMAP_PLANAR_CONTEXT* freerdp_bitmap_planar_context_new(DWORD flags, UINT32 maxWidth,
1741 UINT32 maxHeight)
1742{
1743 BITMAP_PLANAR_CONTEXT* context =
1744 (BITMAP_PLANAR_CONTEXT*)winpr_aligned_calloc(1, sizeof(BITMAP_PLANAR_CONTEXT), 32);
1745
1746 if (!context)
1747 return NULL;
1748
1749 if (flags & PLANAR_FORMAT_HEADER_NA)
1750 context->AllowSkipAlpha = TRUE;
1751
1752 if (flags & PLANAR_FORMAT_HEADER_RLE)
1753 context->AllowRunLengthEncoding = TRUE;
1754
1755 if (flags & PLANAR_FORMAT_HEADER_CS)
1756 context->AllowColorSubsampling = TRUE;
1757
1758 context->ColorLossLevel = flags & PLANAR_FORMAT_HEADER_CLL_MASK;
1759
1760 if (context->ColorLossLevel)
1761 context->AllowDynamicColorFidelity = TRUE;
1762
1763 if (!freerdp_bitmap_planar_context_reset(context, maxWidth, maxHeight))
1764 {
1765 WINPR_PRAGMA_DIAG_PUSH
1766 WINPR_PRAGMA_DIAG_IGNORED_MISMATCHED_DEALLOC
1767 freerdp_bitmap_planar_context_free(context);
1768 WINPR_PRAGMA_DIAG_POP
1769 return NULL;
1770 }
1771
1772 return context;
1773}
1774
1775void freerdp_bitmap_planar_context_free(BITMAP_PLANAR_CONTEXT* context)
1776{
1777 if (!context)
1778 return;
1779
1780 winpr_aligned_free(context->pTempData);
1781 winpr_aligned_free(context->planesBuffer);
1782 winpr_aligned_free(context->deltaPlanesBuffer);
1783 winpr_aligned_free(context->rlePlanesBuffer);
1784 winpr_aligned_free(context);
1785}
1786
1787void freerdp_planar_switch_bgr(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar, BOOL bgr)
1788{
1789 WINPR_ASSERT(planar);
1790 planar->bgr = bgr;
1791}
1792
1793void freerdp_planar_topdown_image(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar, BOOL topdown)
1794{
1795 WINPR_ASSERT(planar);
1796 planar->topdown = topdown;
1797}