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 %" PRId32, 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 = nullptr;
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 = nullptr;
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 = nullptr;
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] = WINPR_C_ARRAY_INIT;
720 UINT32 rawWidths[4] = WINPR_C_ARRAY_INIT;
721 UINT32 rawHeights[4] = WINPR_C_ARRAY_INIT;
722 const BYTE* planes[4] = WINPR_C_ARRAY_INIT;
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 (planar->maxWidth < nSrcWidth)
731 return FALSE;
732 if (planar->maxHeight < nSrcHeight)
733 return FALSE;
734
735 const UINT32 bpp = FreeRDPGetBytesPerPixel(DstFormat);
736 if (nDstStep <= 0)
737 nDstStep = nDstWidth * bpp;
738
739 const BYTE* srcp = pSrcData;
740
741 if (!pSrcData)
742 {
743 WLog_ERR(TAG, "Invalid argument pSrcData=nullptr");
744 return FALSE;
745 }
746
747 if (!pDstData)
748 {
749 WLog_ERR(TAG, "Invalid argument pDstData=nullptr");
750 return FALSE;
751 }
752
753 const BYTE FormatHeader = *srcp++;
754 const BYTE cll = (FormatHeader & PLANAR_FORMAT_HEADER_CLL_MASK);
755 const BYTE cs = (FormatHeader & PLANAR_FORMAT_HEADER_CS) != 0;
756 const BYTE rle = (FormatHeader & PLANAR_FORMAT_HEADER_RLE) != 0;
757 const BYTE alpha = !(FormatHeader & PLANAR_FORMAT_HEADER_NA);
758
759 DstFormat = planar_invert_format(planar, alpha, DstFormat);
760
761 if (alpha)
762 useAlpha = FreeRDPColorHasAlpha(DstFormat);
763
764 // WLog_INFO(TAG, "CLL: %"PRIu32" CS: %"PRIu8" RLE: %"PRIu8" ALPHA: %"PRIu8"", cll, cs, rle,
765 // alpha);
766
767 if (!cll && cs)
768 {
769 WLog_ERR(TAG, "Chroma subsampling requires YCoCg and does not work with RGB data");
770 return FALSE; /* Chroma subsampling requires YCoCg */
771 }
772
773 const UINT32 subWidth = (nSrcWidth / 2) + (nSrcWidth % 2);
774 const UINT32 subHeight = (nSrcHeight / 2) + (nSrcHeight % 2);
775 const UINT32 planeSize = nSrcWidth * nSrcHeight;
776 const UINT32 subSize = subWidth * subHeight;
777
778 if (!cs)
779 {
780 rawSizes[0] = planeSize; /* LumaOrRedPlane */
781 rawWidths[0] = nSrcWidth;
782 rawHeights[0] = nSrcHeight;
783 rawSizes[1] = planeSize; /* OrangeChromaOrGreenPlane */
784 rawWidths[1] = nSrcWidth;
785 rawHeights[1] = nSrcHeight;
786 rawSizes[2] = planeSize; /* GreenChromaOrBluePlane */
787 rawWidths[2] = nSrcWidth;
788 rawHeights[2] = nSrcHeight;
789 rawSizes[3] = planeSize; /* AlphaPlane */
790 rawWidths[3] = nSrcWidth;
791 rawHeights[3] = nSrcHeight;
792 }
793 else /* Chroma Subsampling */
794 {
795 rawSizes[0] = planeSize; /* LumaOrRedPlane */
796 rawWidths[0] = nSrcWidth;
797 rawHeights[0] = nSrcHeight;
798 rawSizes[1] = subSize; /* OrangeChromaOrGreenPlane */
799 rawWidths[1] = subWidth;
800 rawHeights[1] = subHeight;
801 rawSizes[2] = subSize; /* GreenChromaOrBluePlane */
802 rawWidths[2] = subWidth;
803 rawHeights[2] = subHeight;
804 rawSizes[3] = planeSize; /* AlphaPlane */
805 rawWidths[3] = nSrcWidth;
806 rawHeights[3] = nSrcHeight;
807 }
808
809 const size_t diff = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(srcp - pSrcData));
810 if (SrcSize < diff)
811 {
812 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff);
813 return FALSE;
814 }
815
816 if (!rle) /* RAW */
817 {
818
819 UINT32 base = planeSize * 3;
820 if (cs)
821 base = planeSize + planeSize / 2;
822
823 if (alpha)
824 {
825 if ((SrcSize - diff) < (planeSize + base))
826 {
827 WLog_ERR(TAG, "Alpha plane size mismatch %" PRIuz " < %" PRIu32, SrcSize - diff,
828 (planeSize + base));
829 return FALSE;
830 }
831
832 planes[3] = srcp; /* AlphaPlane */
833 planes[0] = planes[3] + rawSizes[3]; /* LumaOrRedPlane */
834 planes[1] = planes[0] + rawSizes[0]; /* OrangeChromaOrGreenPlane */
835 planes[2] = planes[1] + rawSizes[1]; /* GreenChromaOrBluePlane */
836
837 if ((planes[2] + rawSizes[2]) > &pSrcData[SrcSize])
838 {
839 WLog_ERR(TAG, "plane size mismatch %p + %" PRIu32 " > %p",
840 WINPR_CXX_COMPAT_CAST(const void*, planes[2]), rawSizes[2],
841 WINPR_CXX_COMPAT_CAST(const void*, &pSrcData[SrcSize]));
842 return FALSE;
843 }
844 }
845 else
846 {
847 if ((SrcSize - diff) < base)
848 {
849 WLog_ERR(TAG, "plane size mismatch %" PRIuz " < %" PRIu32, SrcSize - diff, base);
850 return FALSE;
851 }
852
853 planes[0] = srcp; /* LumaOrRedPlane */
854 planes[1] = planes[0] + rawSizes[0]; /* OrangeChromaOrGreenPlane */
855 planes[2] = planes[1] + rawSizes[1]; /* GreenChromaOrBluePlane */
856
857 if ((planes[2] + rawSizes[2]) > &pSrcData[SrcSize])
858 {
859 WLog_ERR(TAG, "plane size mismatch %p + %" PRIu32 " > %p",
860 WINPR_CXX_COMPAT_CAST(const void*, planes[2]), rawSizes[2],
861 WINPR_CXX_COMPAT_CAST(const void*, &pSrcData[SrcSize]));
862 return FALSE;
863 }
864 }
865 }
866 else /* RLE */
867 {
868 if (alpha)
869 {
870 planes[3] = srcp;
871 rleSizes[3] = planar_skip_plane_rle(planes[3], (UINT32)(SrcSize - diff), rawWidths[3],
872 rawHeights[3]); /* AlphaPlane */
873
874 if (rleSizes[3] < 0)
875 return FALSE;
876
877 planes[0] = planes[3] + rleSizes[3];
878 }
879 else
880 planes[0] = srcp;
881
882 const size_t diff0 = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(planes[0] - pSrcData));
883 if (SrcSize < diff0)
884 {
885 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff0);
886 return FALSE;
887 }
888 rleSizes[0] = planar_skip_plane_rle(planes[0], (UINT32)(SrcSize - diff0), rawWidths[0],
889 rawHeights[0]); /* RedPlane */
890
891 if (rleSizes[0] < 0)
892 return FALSE;
893
894 planes[1] = planes[0] + rleSizes[0];
895
896 const size_t diff1 = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(planes[1] - pSrcData));
897 if (SrcSize < diff1)
898 {
899 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff1);
900 return FALSE;
901 }
902 rleSizes[1] = planar_skip_plane_rle(planes[1], (UINT32)(SrcSize - diff1), rawWidths[1],
903 rawHeights[1]); /* GreenPlane */
904
905 if (rleSizes[1] < 1)
906 return FALSE;
907
908 planes[2] = planes[1] + rleSizes[1];
909 const size_t diff2 = WINPR_ASSERTING_INT_CAST(size_t, (intptr_t)(planes[2] - pSrcData));
910 if (SrcSize < diff2)
911 {
912 WLog_ERR(TAG, "Size mismatch %" PRIu32 " < %" PRIuz, SrcSize, diff);
913 return FALSE;
914 }
915 rleSizes[2] = planar_skip_plane_rle(planes[2], (UINT32)(SrcSize - diff2), rawWidths[2],
916 rawHeights[2]); /* BluePlane */
917
918 if (rleSizes[2] < 1)
919 return FALSE;
920 }
921
922 if (!cll) /* RGB */
923 {
924 UINT32 TempFormat = 0;
925 BYTE* pTempData = pDstData;
926 UINT32 nTempStep = nDstStep;
927 UINT32 nTotalHeight = nYDst + nDstHeight;
928
929 if (useAlpha)
930 TempFormat = PIXEL_FORMAT_BGRA32;
931 else
932 TempFormat = PIXEL_FORMAT_BGRX32;
933
934 TempFormat = planar_invert_format(planar, alpha, TempFormat);
935
936 if ((TempFormat != DstFormat) || (nSrcWidth != nDstWidth) || (nSrcHeight != nDstHeight))
937 {
938 pTempData = planar->pTempData;
939 nTempStep = planar->nTempStep;
940 nTotalHeight = planar->maxHeight;
941 }
942
943 if (!rle) /* RAW */
944 {
945 if (!planar_decompress_planes_raw(planes, pTempData, TempFormat, nTempStep, nXDst,
946 nYDst, nSrcWidth, nSrcHeight, vFlip, nTotalHeight))
947 return FALSE;
948
949 if (alpha)
950 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2] + rawSizes[3];
951 else /* NoAlpha */
952 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2];
953
954 if ((SrcSize - (srcp - pSrcData)) == 1)
955 srcp++; /* pad */
956 }
957 else /* RLE */
958 {
959 if (nYDst + nSrcHeight > nTotalHeight)
960 {
961 WLog_ERR(TAG,
962 "planar plane destination Y %" PRIu32 " + height %" PRIu32
963 " exceeds totalHeight %" PRIu32,
964 nYDst, nSrcHeight, nTotalHeight);
965 return FALSE;
966 }
967
968 if ((nXDst + nSrcWidth) * bpp > nDstStep)
969 {
970 WLog_ERR(TAG,
971 "planar plane destination (X %" PRIu32 " + width %" PRIu32
972 ") * bpp %" PRIu32 " exceeds stride %" PRIu32,
973 nXDst, nSrcWidth, bpp, nDstStep);
974 return FALSE;
975 }
976
977 status = planar_decompress_plane_rle(
978 planes[0], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[0]), pTempData, nTempStep,
979 nXDst, nYDst, nSrcWidth, nSrcHeight, 2, vFlip); /* RedPlane */
980
981 if (status < 0)
982 return FALSE;
983
984 status = planar_decompress_plane_rle(
985 planes[1], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[1]), pTempData, nTempStep,
986 nXDst, nYDst, nSrcWidth, nSrcHeight, 1, vFlip); /* GreenPlane */
987
988 if (status < 0)
989 return FALSE;
990
991 status = planar_decompress_plane_rle(
992 planes[2], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[2]), pTempData, nTempStep,
993 nXDst, nYDst, nSrcWidth, nSrcHeight, 0, vFlip); /* BluePlane */
994
995 if (status < 0)
996 return FALSE;
997
998 srcp += rleSizes[0] + rleSizes[1] + rleSizes[2];
999
1000 if (useAlpha)
1001 {
1002 status = planar_decompress_plane_rle(
1003 planes[3], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[3]), pTempData,
1004 nTempStep, nXDst, nYDst, nSrcWidth, nSrcHeight, 3, vFlip); /* AlphaPlane */
1005 }
1006 else
1007 status = planar_set_plane(0xFF, pTempData, nTempStep, nXDst, nYDst, nSrcWidth,
1008 nSrcHeight, 3, vFlip);
1009
1010 if (status < 0)
1011 return FALSE;
1012
1013 if (alpha)
1014 srcp += rleSizes[3];
1015 }
1016
1017 if (pTempData != pDstData)
1018 {
1019 if (!freerdp_image_copy_no_overlap(pDstData, DstFormat, nDstStep, nXDst, nYDst, w, h,
1020 pTempData, TempFormat, nTempStep, nXDst, nYDst,
1021 nullptr, FREERDP_FLIP_NONE))
1022 {
1023 WLog_ERR(TAG, "planar image copy failed");
1024 return FALSE;
1025 }
1026 }
1027 }
1028 else /* YCoCg */
1029 {
1030 UINT32 TempFormat = 0;
1031 BYTE* pTempData = planar->pTempData;
1032 UINT32 nTempStep = planar->nTempStep;
1033 UINT32 nTotalHeight = planar->maxHeight;
1034 BYTE* dst = &pDstData[nXDst * FreeRDPGetBytesPerPixel(DstFormat) + nYDst * nDstStep];
1035
1036 if (useAlpha)
1037 TempFormat = PIXEL_FORMAT_BGRA32;
1038 else
1039 TempFormat = PIXEL_FORMAT_BGRX32;
1040
1041 if (!pTempData)
1042 return FALSE;
1043
1044 if (rle) /* RLE encoded data. Decode and handle it like raw data. */
1045 {
1046 BYTE* rleBuffer[4] = WINPR_C_ARRAY_INIT;
1047
1048 if (!planar->rlePlanesBuffer)
1049 return FALSE;
1050
1051 rleBuffer[3] = planar->rlePlanesBuffer; /* AlphaPlane */
1052 rleBuffer[0] = rleBuffer[3] + planeSize; /* LumaOrRedPlane */
1053 rleBuffer[1] = rleBuffer[0] + planeSize; /* OrangeChromaOrGreenPlane */
1054 rleBuffer[2] = rleBuffer[1] + planeSize; /* GreenChromaOrBluePlane */
1055 if (useAlpha)
1056 {
1057 status = planar_decompress_plane_rle_only(
1058 planes[3], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[3]), rleBuffer[3],
1059 rawWidths[3], rawHeights[3]); /* AlphaPlane */
1060
1061 if (status < 0)
1062 return FALSE;
1063 }
1064
1065 if (alpha)
1066 srcp += rleSizes[3];
1067
1068 status = planar_decompress_plane_rle_only(
1069 planes[0], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[0]), rleBuffer[0],
1070 rawWidths[0], rawHeights[0]); /* LumaPlane */
1071
1072 if (status < 0)
1073 return FALSE;
1074
1075 status = planar_decompress_plane_rle_only(
1076 planes[1], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[1]), rleBuffer[1],
1077 rawWidths[1], rawHeights[1]); /* OrangeChromaPlane */
1078
1079 if (status < 0)
1080 return FALSE;
1081
1082 status = planar_decompress_plane_rle_only(
1083 planes[2], WINPR_ASSERTING_INT_CAST(uint32_t, rleSizes[2]), rleBuffer[2],
1084 rawWidths[2], rawHeights[2]); /* GreenChromaPlane */
1085
1086 if (status < 0)
1087 return FALSE;
1088
1089 planes[0] = rleBuffer[0];
1090 planes[1] = rleBuffer[1];
1091 planes[2] = rleBuffer[2];
1092 planes[3] = rleBuffer[3];
1093 }
1094
1095 /* RAW */
1096 {
1097 if (cs)
1098 { /* Chroma subsampling for Co and Cg:
1099 * Each pixel contains the value that should be expanded to
1100 * [2x,2y;2x+1,2y;2x+1,2y+1;2x;2y+1] */
1101 if (!planar_subsample_expand(planes[1], rawSizes[1], nSrcWidth, nSrcHeight,
1102 rawWidths[1], rawHeights[1], planar->deltaPlanes[0]))
1103 return FALSE;
1104
1105 planes[1] = planar->deltaPlanes[0];
1106 rawSizes[1] = planeSize; /* OrangeChromaOrGreenPlane */
1107 rawWidths[1] = nSrcWidth;
1108 rawHeights[1] = nSrcHeight;
1109
1110 if (!planar_subsample_expand(planes[2], rawSizes[2], nSrcWidth, nSrcHeight,
1111 rawWidths[2], rawHeights[2], planar->deltaPlanes[1]))
1112 return FALSE;
1113
1114 planes[2] = planar->deltaPlanes[1];
1115 rawSizes[2] = planeSize; /* GreenChromaOrBluePlane */
1116 rawWidths[2] = nSrcWidth;
1117 rawHeights[2] = nSrcHeight;
1118 }
1119
1120 if (!planar_decompress_planes_raw(planes, pTempData, TempFormat, nTempStep, nXDst,
1121 nYDst, nSrcWidth, nSrcHeight, vFlip, nTotalHeight))
1122 return FALSE;
1123
1124 if (alpha)
1125 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2] + rawSizes[3];
1126 else /* NoAlpha */
1127 srcp += rawSizes[0] + rawSizes[1] + rawSizes[2];
1128
1129 if ((SrcSize - (srcp - pSrcData)) == 1)
1130 srcp++; /* pad */
1131 }
1132
1133 WINPR_ASSERT(prims->YCoCgToRGB_8u_AC4R);
1134 int rc = prims->YCoCgToRGB_8u_AC4R(
1135 pTempData, WINPR_ASSERTING_INT_CAST(int32_t, nTempStep), dst, DstFormat,
1136 WINPR_ASSERTING_INT_CAST(int32_t, nDstStep), w, h, cll, useAlpha);
1137 if (rc != PRIMITIVES_SUCCESS)
1138 {
1139 WLog_ERR(TAG, "YCoCgToRGB_8u_AC4R failed with %d", rc);
1140 return FALSE;
1141 }
1142 }
1143
1144 WINPR_UNUSED(srcp);
1145 return TRUE;
1146}
1147
1148static inline BOOL freerdp_split_color_planes(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar,
1149 const BYTE* WINPR_RESTRICT data, UINT32 format,
1150 UINT32 width, UINT32 height, UINT32 scanline,
1151 BYTE* WINPR_RESTRICT planes[4])
1152{
1153 WINPR_ASSERT(planar);
1154
1155 if ((width > INT32_MAX) || (height > INT32_MAX) || (scanline > INT32_MAX))
1156 return FALSE;
1157
1158 if (scanline == 0)
1159 scanline = width * FreeRDPGetBytesPerPixel(format);
1160
1161 if (planar->topdown)
1162 {
1163 UINT32 k = 0;
1164 for (UINT32 i = 0; i < height; i++)
1165 {
1166 const BYTE* pixel = &data[1ULL * scanline * i];
1167
1168 for (UINT32 j = 0; j < width; j++)
1169 {
1170 const UINT32 color = FreeRDPReadColor(pixel, format);
1171 pixel += FreeRDPGetBytesPerPixel(format);
1172 FreeRDPSplitColor(color, format, &planes[1][k], &planes[2][k], &planes[3][k],
1173 &planes[0][k], nullptr);
1174 k++;
1175 }
1176 }
1177 }
1178 else
1179 {
1180 UINT32 k = 0;
1181
1182 for (INT64 i = (INT64)height - 1; i >= 0; i--)
1183 {
1184 const BYTE* pixel = &data[1ULL * scanline * (UINT32)i];
1185
1186 for (UINT32 j = 0; j < width; j++)
1187 {
1188 const UINT32 color = FreeRDPReadColor(pixel, format);
1189 pixel += FreeRDPGetBytesPerPixel(format);
1190 FreeRDPSplitColor(color, format, &planes[1][k], &planes[2][k], &planes[3][k],
1191 &planes[0][k], nullptr);
1192 k++;
1193 }
1194 }
1195 }
1196 return TRUE;
1197}
1198
1199static inline UINT32 freerdp_bitmap_planar_write_rle_bytes(const BYTE* WINPR_RESTRICT pInBuffer,
1200 UINT32 cRawBytes, UINT32 nRunLength,
1201 BYTE* WINPR_RESTRICT pOutBuffer,
1202 UINT32 outBufferSize)
1203{
1204 const BYTE* pInput = pInBuffer;
1205 BYTE* pOutput = pOutBuffer;
1206 BYTE controlByte = 0;
1207 UINT32 nBytesToWrite = 0;
1208
1209 if (!cRawBytes && !nRunLength)
1210 return 0;
1211
1212 if (nRunLength < 3)
1213 {
1214 cRawBytes += nRunLength;
1215 nRunLength = 0;
1216 }
1217
1218 while (cRawBytes)
1219 {
1220 if (cRawBytes < 16)
1221 {
1222 if (nRunLength > 15)
1223 {
1224 if (nRunLength < 18)
1225 {
1226 controlByte = PLANAR_CONTROL_BYTE(13, cRawBytes);
1227 nRunLength -= 13;
1228 cRawBytes = 0;
1229 }
1230 else
1231 {
1232 controlByte = PLANAR_CONTROL_BYTE(15, cRawBytes);
1233 nRunLength -= 15;
1234 cRawBytes = 0;
1235 }
1236 }
1237 else
1238 {
1239 controlByte = PLANAR_CONTROL_BYTE(nRunLength, cRawBytes);
1240 nRunLength = 0;
1241 cRawBytes = 0;
1242 }
1243 }
1244 else
1245 {
1246 controlByte = PLANAR_CONTROL_BYTE(0, 15);
1247 cRawBytes -= 15;
1248 }
1249
1250 if (outBufferSize < 1)
1251 return 0;
1252
1253 outBufferSize--;
1254 *pOutput = controlByte;
1255 pOutput++;
1256 nBytesToWrite = (controlByte >> 4);
1257
1258 if (nBytesToWrite)
1259 {
1260 if (outBufferSize < nBytesToWrite)
1261 return 0;
1262
1263 outBufferSize -= nBytesToWrite;
1264 CopyMemory(pOutput, pInput, nBytesToWrite);
1265 pOutput += nBytesToWrite;
1266 pInput += nBytesToWrite;
1267 }
1268 }
1269
1270 while (nRunLength)
1271 {
1272 if (nRunLength > 47)
1273 {
1274 if (nRunLength < 50)
1275 {
1276 controlByte = PLANAR_CONTROL_BYTE(2, 13);
1277 nRunLength -= 45;
1278 }
1279 else
1280 {
1281 controlByte = PLANAR_CONTROL_BYTE(2, 15);
1282 nRunLength -= 47;
1283 }
1284 }
1285 else if (nRunLength > 31)
1286 {
1287 controlByte = PLANAR_CONTROL_BYTE(2, (nRunLength - 32));
1288 nRunLength = 0;
1289 }
1290 else if (nRunLength > 15)
1291 {
1292 controlByte = PLANAR_CONTROL_BYTE(1, (nRunLength - 16));
1293 nRunLength = 0;
1294 }
1295 else
1296 {
1297 controlByte = PLANAR_CONTROL_BYTE(nRunLength, 0);
1298 nRunLength = 0;
1299 }
1300
1301 if (outBufferSize < 1)
1302 return 0;
1303
1304 --outBufferSize;
1305 *pOutput = controlByte;
1306 pOutput++;
1307 }
1308
1309 const intptr_t diff = (pOutput - pOutBuffer);
1310 if ((diff < 0) || (diff > UINT32_MAX))
1311 return 0;
1312 return (UINT32)diff;
1313}
1314
1315static inline UINT32 freerdp_bitmap_planar_encode_rle_bytes(const BYTE* WINPR_RESTRICT pInBuffer,
1316 UINT32 inBufferSize,
1317 BYTE* WINPR_RESTRICT pOutBuffer,
1318 UINT32 outBufferSize)
1319{
1320 BYTE symbol = 0;
1321 const BYTE* pInput = pInBuffer;
1322 BYTE* pOutput = pOutBuffer;
1323 const BYTE* pBytes = nullptr;
1324 UINT32 cRawBytes = 0;
1325 UINT32 nRunLength = 0;
1326 UINT32 nBytesWritten = 0;
1327 UINT32 nTotalBytesWritten = 0;
1328
1329 if (!outBufferSize)
1330 return 0;
1331
1332 do
1333 {
1334 if (!inBufferSize)
1335 break;
1336
1337 const UINT32 bSymbolMatch = (symbol == *pInput) != 0;
1338 symbol = *pInput;
1339 pInput++;
1340 inBufferSize--;
1341
1342 if (nRunLength && !bSymbolMatch)
1343 {
1344 if (nRunLength < 3)
1345 {
1346 cRawBytes += nRunLength;
1347 nRunLength = 0;
1348 }
1349 else
1350 {
1351 pBytes = pInput - (cRawBytes + nRunLength + 1);
1352 nBytesWritten = freerdp_bitmap_planar_write_rle_bytes(pBytes, cRawBytes, nRunLength,
1353 pOutput, outBufferSize);
1354 nRunLength = 0;
1355
1356 if (!nBytesWritten || (nBytesWritten > outBufferSize))
1357 return nRunLength;
1358
1359 nTotalBytesWritten += nBytesWritten;
1360 outBufferSize -= nBytesWritten;
1361 pOutput += nBytesWritten;
1362 cRawBytes = 0;
1363 }
1364 }
1365
1366 nRunLength += bSymbolMatch;
1367 cRawBytes += (!bSymbolMatch) != 0;
1368 } while (outBufferSize);
1369
1370 if (cRawBytes || nRunLength)
1371 {
1372 pBytes = pInput - (cRawBytes + nRunLength);
1373 nBytesWritten = freerdp_bitmap_planar_write_rle_bytes(pBytes, cRawBytes, nRunLength,
1374 pOutput, outBufferSize);
1375
1376 if (!nBytesWritten)
1377 return 0;
1378
1379 nTotalBytesWritten += nBytesWritten;
1380 }
1381
1382 if (inBufferSize)
1383 return 0;
1384
1385 return nTotalBytesWritten;
1386}
1387
1388BOOL freerdp_bitmap_planar_compress_plane_rle(const BYTE* WINPR_RESTRICT inPlane, UINT32 width,
1389 UINT32 height, BYTE* WINPR_RESTRICT outPlane,
1390 UINT32* WINPR_RESTRICT dstSize)
1391{
1392 if (!outPlane)
1393 return FALSE;
1394
1395 UINT32 index = 0;
1396 const BYTE* pInput = inPlane;
1397 BYTE* pOutput = outPlane;
1398 UINT32 outBufferSize = *dstSize;
1399 UINT32 nTotalBytesWritten = 0;
1400
1401 while (outBufferSize > 0)
1402 {
1403 const UINT32 nBytesWritten =
1404 freerdp_bitmap_planar_encode_rle_bytes(pInput, width, pOutput, outBufferSize);
1405
1406 if ((!nBytesWritten) || (nBytesWritten > outBufferSize))
1407 return FALSE;
1408
1409 outBufferSize -= nBytesWritten;
1410 nTotalBytesWritten += nBytesWritten;
1411 pOutput += nBytesWritten;
1412 pInput += width;
1413 index++;
1414
1415 if (index >= height)
1416 break;
1417 }
1418
1419 *dstSize = nTotalBytesWritten;
1420 return TRUE;
1421}
1422
1423static inline BOOL freerdp_bitmap_planar_compress_planes_rle(BYTE* WINPR_RESTRICT inPlanes[4],
1424 UINT32 width, UINT32 height,
1425 BYTE* WINPR_RESTRICT outPlanes,
1426 UINT32* WINPR_RESTRICT dstSizes,
1427 BOOL skipAlpha)
1428{
1429 UINT32 outPlanesSize = width * height * 4;
1430
1431 /* AlphaPlane */
1432 if (skipAlpha)
1433 {
1434 dstSizes[0] = 0;
1435 }
1436 else
1437 {
1438 dstSizes[0] = outPlanesSize;
1439
1440 if (!freerdp_bitmap_planar_compress_plane_rle(inPlanes[0], width, height, outPlanes,
1441 &dstSizes[0]))
1442 return FALSE;
1443
1444 outPlanes += dstSizes[0];
1445 outPlanesSize -= dstSizes[0];
1446 }
1447
1448 /* LumaOrRedPlane */
1449 dstSizes[1] = outPlanesSize;
1450
1451 if (!freerdp_bitmap_planar_compress_plane_rle(inPlanes[1], width, height, outPlanes,
1452 &dstSizes[1]))
1453 return FALSE;
1454
1455 outPlanes += dstSizes[1];
1456 outPlanesSize -= dstSizes[1];
1457 /* OrangeChromaOrGreenPlane */
1458 dstSizes[2] = outPlanesSize;
1459
1460 if (!freerdp_bitmap_planar_compress_plane_rle(inPlanes[2], width, height, outPlanes,
1461 &dstSizes[2]))
1462 return FALSE;
1463
1464 outPlanes += dstSizes[2];
1465 outPlanesSize -= dstSizes[2];
1466 /* GreenChromeOrBluePlane */
1467 dstSizes[3] = outPlanesSize;
1468
1469 return (freerdp_bitmap_planar_compress_plane_rle(inPlanes[3], width, height, outPlanes,
1470 &dstSizes[3]));
1471}
1472
1473BYTE* freerdp_bitmap_planar_delta_encode_plane(const BYTE* WINPR_RESTRICT inPlane, UINT32 width,
1474 UINT32 height, BYTE* WINPR_RESTRICT outPlane)
1475{
1476 if (!outPlane)
1477 {
1478 if (width * height == 0)
1479 return nullptr;
1480
1481 outPlane = (BYTE*)calloc(height, width);
1482 if (!outPlane)
1483 return nullptr;
1484 }
1485
1486 // first line is copied as is
1487 CopyMemory(outPlane, inPlane, width);
1488
1489 for (UINT32 y = 1; y < height; y++)
1490 {
1491 const size_t off = 1ull * width * y;
1492 BYTE* outPtr = &outPlane[off];
1493 const BYTE* srcPtr = &inPlane[off];
1494 const BYTE* prevLinePtr = &inPlane[off - width];
1495 for (UINT32 x = 0; x < width; x++)
1496 {
1497 const int delta = (int)srcPtr[x] - (int)prevLinePtr[x];
1498 const int s2c1i = (delta >= 0) ? delta : (INT_MAX + delta) + 1;
1499 const int8_t s2c1 = WINPR_CXX_COMPAT_CAST(int8_t, s2c1i);
1500 const uint32_t s2c =
1501 (s2c1 >= 0) ? ((UINT32)s2c1 << 1) : (((UINT32)(~(s2c1) + 1) << 1) - 1);
1502 outPtr[x] = (BYTE)s2c;
1503 }
1504 }
1505
1506 return outPlane;
1507}
1508
1509static inline BOOL freerdp_bitmap_planar_delta_encode_planes(BYTE* WINPR_RESTRICT inPlanes[4],
1510 UINT32 width, UINT32 height,
1511 BYTE* WINPR_RESTRICT outPlanes[4])
1512{
1513 for (UINT32 i = 0; i < 4; i++)
1514 {
1515 outPlanes[i] =
1516 freerdp_bitmap_planar_delta_encode_plane(inPlanes[i], width, height, outPlanes[i]);
1517
1518 if (!outPlanes[i])
1519 return FALSE;
1520 }
1521
1522 return TRUE;
1523}
1524
1525BYTE* freerdp_bitmap_compress_planar(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT context,
1526 const BYTE* WINPR_RESTRICT data, UINT32 format, UINT32 width,
1527 UINT32 height, UINT32 scanline, BYTE* WINPR_RESTRICT dstData,
1528 UINT32* WINPR_RESTRICT pDstSize)
1529{
1530 UINT32 size = 0;
1531 BYTE* dstp = nullptr;
1532 UINT32 dstSizes[4] = WINPR_C_ARRAY_INIT;
1533 BYTE FormatHeader = 0;
1534
1535 if (!context || !context->rlePlanesBuffer)
1536 return nullptr;
1537
1538 if (context->AllowSkipAlpha)
1539 FormatHeader |= PLANAR_FORMAT_HEADER_NA;
1540
1541 const UINT32 planeSize = width * height;
1542
1543 if (!context->AllowSkipAlpha)
1544 format = planar_invert_format(context, TRUE, format);
1545
1546 if (!freerdp_split_color_planes(context, data, format, width, height, scanline,
1547 context->planes))
1548 return nullptr;
1549
1550 if (context->AllowRunLengthEncoding)
1551 {
1552 if (!freerdp_bitmap_planar_delta_encode_planes(context->planes, width, height,
1553 context->deltaPlanes))
1554 return nullptr;
1555
1556 if (!freerdp_bitmap_planar_compress_planes_rle(context->deltaPlanes, width, height,
1557 context->rlePlanesBuffer, dstSizes,
1558 context->AllowSkipAlpha))
1559 return nullptr;
1560
1561 {
1562 uint32_t offset = 0;
1563 FormatHeader |= PLANAR_FORMAT_HEADER_RLE;
1564 context->rlePlanes[0] = &context->rlePlanesBuffer[offset];
1565 offset += dstSizes[0];
1566 context->rlePlanes[1] = &context->rlePlanesBuffer[offset];
1567 offset += dstSizes[1];
1568 context->rlePlanes[2] = &context->rlePlanesBuffer[offset];
1569 offset += dstSizes[2];
1570 context->rlePlanes[3] = &context->rlePlanesBuffer[offset];
1571
1572#if defined(WITH_DEBUG_CODECS)
1573 WLog_DBG(TAG,
1574 "R: [%" PRIu32 "/%" PRIu32 "] G: [%" PRIu32 "/%" PRIu32 "] B: [%" PRIu32
1575 " / %" PRIu32 "] ",
1576 dstSizes[1], planeSize, dstSizes[2], planeSize, dstSizes[3], planeSize);
1577#endif
1578 }
1579 }
1580
1581 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1582 {
1583 if (!context->AllowRunLengthEncoding)
1584 return nullptr;
1585
1586 if (context->rlePlanes[0] == nullptr)
1587 return nullptr;
1588
1589 if (context->rlePlanes[1] == nullptr)
1590 return nullptr;
1591
1592 if (context->rlePlanes[2] == nullptr)
1593 return nullptr;
1594
1595 if (context->rlePlanes[3] == nullptr)
1596 return nullptr;
1597 }
1598
1599 if (!dstData)
1600 {
1601 size = 1;
1602
1603 if (!(FormatHeader & PLANAR_FORMAT_HEADER_NA))
1604 {
1605 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1606 size += dstSizes[0];
1607 else
1608 size += planeSize;
1609 }
1610
1611 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1612 size += (dstSizes[1] + dstSizes[2] + dstSizes[3]);
1613 else
1614 size += (planeSize * 3);
1615
1616 if (!(FormatHeader & PLANAR_FORMAT_HEADER_RLE))
1617 size++;
1618
1619 dstData = malloc(size);
1620
1621 if (!dstData)
1622 return nullptr;
1623
1624 *pDstSize = size;
1625 }
1626
1627 dstp = dstData;
1628 *dstp = FormatHeader; /* FormatHeader */
1629 dstp++;
1630
1631 /* AlphaPlane */
1632
1633 if (!(FormatHeader & PLANAR_FORMAT_HEADER_NA))
1634 {
1635 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1636 {
1637 CopyMemory(dstp, context->rlePlanes[0], dstSizes[0]); /* Alpha */
1638 dstp += dstSizes[0];
1639 }
1640 else
1641 {
1642 CopyMemory(dstp, context->planes[0], planeSize); /* Alpha */
1643 dstp += planeSize;
1644 }
1645 }
1646
1647 /* LumaOrRedPlane */
1648
1649 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1650 {
1651 CopyMemory(dstp, context->rlePlanes[1], dstSizes[1]); /* Red */
1652 dstp += dstSizes[1];
1653 }
1654 else
1655 {
1656 CopyMemory(dstp, context->planes[1], planeSize); /* Red */
1657 dstp += planeSize;
1658 }
1659
1660 /* OrangeChromaOrGreenPlane */
1661
1662 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1663 {
1664 CopyMemory(dstp, context->rlePlanes[2], dstSizes[2]); /* Green */
1665 dstp += dstSizes[2];
1666 }
1667 else
1668 {
1669 CopyMemory(dstp, context->planes[2], planeSize); /* Green */
1670 dstp += planeSize;
1671 }
1672
1673 /* GreenChromeOrBluePlane */
1674
1675 if (FormatHeader & PLANAR_FORMAT_HEADER_RLE)
1676 {
1677 CopyMemory(dstp, context->rlePlanes[3], dstSizes[3]); /* Blue */
1678 dstp += dstSizes[3];
1679 }
1680 else
1681 {
1682 CopyMemory(dstp, context->planes[3], planeSize); /* Blue */
1683 dstp += planeSize;
1684 }
1685
1686 /* Pad1 (1 byte) */
1687
1688 if (!(FormatHeader & PLANAR_FORMAT_HEADER_RLE))
1689 {
1690 *dstp = 0;
1691 dstp++;
1692 }
1693
1694 const intptr_t diff = (dstp - dstData);
1695 if ((diff < 0) || (diff > UINT32_MAX))
1696 {
1697 free(dstData);
1698 return nullptr;
1699 }
1700 size = (UINT32)diff;
1701 *pDstSize = size;
1702 return dstData;
1703}
1704
1705BOOL freerdp_bitmap_planar_context_reset(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT context,
1706 UINT32 width, UINT32 height)
1707{
1708 if (!context)
1709 return FALSE;
1710
1711 context->bgr = FALSE;
1712 context->maxWidth = PLANAR_ALIGN(width, 4);
1713 context->maxHeight = PLANAR_ALIGN(height, 4);
1714 {
1715 const UINT64 tmp = (UINT64)context->maxWidth * context->maxHeight;
1716 if (tmp > UINT32_MAX)
1717 return FALSE;
1718 context->maxPlaneSize = (UINT32)tmp;
1719 }
1720
1721 if (context->maxWidth > UINT32_MAX / 4)
1722 return FALSE;
1723 context->nTempStep = context->maxWidth * 4;
1724
1725 memset((void*)context->planes, 0, sizeof(context->planes));
1726 memset((void*)context->rlePlanes, 0, sizeof(context->rlePlanes));
1727 memset((void*)context->deltaPlanes, 0, sizeof(context->deltaPlanes));
1728
1729 if (context->maxPlaneSize > 0)
1730 {
1731 void* tmp = winpr_aligned_recalloc(context->planesBuffer, context->maxPlaneSize, 4, 32);
1732 if (!tmp)
1733 return FALSE;
1734 context->planesBuffer = tmp;
1735
1736 tmp = winpr_aligned_recalloc(context->pTempData, context->maxPlaneSize, 6, 32);
1737 if (!tmp)
1738 return FALSE;
1739 context->pTempData = tmp;
1740
1741 tmp = winpr_aligned_recalloc(context->deltaPlanesBuffer, context->maxPlaneSize, 4, 32);
1742 if (!tmp)
1743 return FALSE;
1744 context->deltaPlanesBuffer = tmp;
1745
1746 tmp = winpr_aligned_recalloc(context->rlePlanesBuffer, context->maxPlaneSize, 4, 32);
1747 if (!tmp)
1748 return FALSE;
1749 context->rlePlanesBuffer = tmp;
1750
1751 context->planes[0] = &context->planesBuffer[0ULL * context->maxPlaneSize];
1752 context->planes[1] = &context->planesBuffer[1ULL * context->maxPlaneSize];
1753 context->planes[2] = &context->planesBuffer[2ULL * context->maxPlaneSize];
1754 context->planes[3] = &context->planesBuffer[3ULL * context->maxPlaneSize];
1755 context->deltaPlanes[0] = &context->deltaPlanesBuffer[0ULL * context->maxPlaneSize];
1756 context->deltaPlanes[1] = &context->deltaPlanesBuffer[1ULL * context->maxPlaneSize];
1757 context->deltaPlanes[2] = &context->deltaPlanesBuffer[2ULL * context->maxPlaneSize];
1758 context->deltaPlanes[3] = &context->deltaPlanesBuffer[3ULL * context->maxPlaneSize];
1759 }
1760 return TRUE;
1761}
1762
1763BITMAP_PLANAR_CONTEXT* freerdp_bitmap_planar_context_new(DWORD flags, UINT32 maxWidth,
1764 UINT32 maxHeight)
1765{
1766 BITMAP_PLANAR_CONTEXT* context =
1767 (BITMAP_PLANAR_CONTEXT*)winpr_aligned_calloc(1, sizeof(BITMAP_PLANAR_CONTEXT), 32);
1768
1769 if (!context)
1770 return nullptr;
1771
1772 if (flags & PLANAR_FORMAT_HEADER_NA)
1773 context->AllowSkipAlpha = TRUE;
1774
1775 if (flags & PLANAR_FORMAT_HEADER_RLE)
1776 context->AllowRunLengthEncoding = TRUE;
1777
1778 if (flags & PLANAR_FORMAT_HEADER_CS)
1779 context->AllowColorSubsampling = TRUE;
1780
1781 context->ColorLossLevel = flags & PLANAR_FORMAT_HEADER_CLL_MASK;
1782
1783 if (context->ColorLossLevel)
1784 context->AllowDynamicColorFidelity = TRUE;
1785
1786 if (!freerdp_bitmap_planar_context_reset(context, maxWidth, maxHeight))
1787 {
1788 WINPR_PRAGMA_DIAG_PUSH
1789 WINPR_PRAGMA_DIAG_IGNORED_MISMATCHED_DEALLOC
1790 freerdp_bitmap_planar_context_free(context);
1791 WINPR_PRAGMA_DIAG_POP
1792 return nullptr;
1793 }
1794
1795 return context;
1796}
1797
1798void freerdp_bitmap_planar_context_free(BITMAP_PLANAR_CONTEXT* context)
1799{
1800 if (!context)
1801 return;
1802
1803 winpr_aligned_free(context->pTempData);
1804 winpr_aligned_free(context->planesBuffer);
1805 winpr_aligned_free(context->deltaPlanesBuffer);
1806 winpr_aligned_free(context->rlePlanesBuffer);
1807 winpr_aligned_free(context);
1808}
1809
1810void freerdp_planar_switch_bgr(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar, BOOL bgr)
1811{
1812 WINPR_ASSERT(planar);
1813 planar->bgr = bgr;
1814}
1815
1816void freerdp_planar_topdown_image(BITMAP_PLANAR_CONTEXT* WINPR_RESTRICT planar, BOOL topdown)
1817{
1818 WINPR_ASSERT(planar);
1819 planar->topdown = topdown;
1820}
primitives_t
Definition primitives.h:255