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