/src/FreeRDP/libfreerdp/codec/interleaved.c
Line | Count | Source |
1 | | /** |
2 | | * FreeRDP: A Remote Desktop Protocol Implementation |
3 | | * Interleaved RLE Bitmap Codec |
4 | | * |
5 | | * Copyright 2014 Marc-Andre Moreau <marcandre.moreau@gmail.com> |
6 | | * Copyright 2015 Thincast Technologies GmbH |
7 | | * Copyright 2015 DI (FH) Martin Haimberger <martin.haimberger@thincast.com> |
8 | | * Copyright 2016 Armin Novak <armin.novak@thincast.com> |
9 | | * Copyright 2016 Thincast Technologies GmbH |
10 | | * |
11 | | * Licensed under the Apache License, Version 2.0 (the "License"); |
12 | | * you may not use this file except in compliance with the License. |
13 | | * You may obtain a copy of the License at |
14 | | * |
15 | | * http://www.apache.org/licenses/LICENSE-2.0 |
16 | | * |
17 | | * Unless required by applicable law or agreed to in writing, software |
18 | | * distributed under the License is distributed on an "AS IS" BASIS, |
19 | | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
20 | | * See the License for the specific language governing permissions and |
21 | | * limitations under the License. |
22 | | */ |
23 | | |
24 | | #include <winpr/assert.h> |
25 | | #include <winpr/cast.h> |
26 | | #include <freerdp/config.h> |
27 | | |
28 | | #include <freerdp/codec/interleaved.h> |
29 | | #include <freerdp/log.h> |
30 | | |
31 | | #define TAG FREERDP_TAG("codec") |
32 | | |
33 | | #define UNROLL_BODY(_exp, _count) \ |
34 | 2.25M | do \ |
35 | 2.25M | { \ |
36 | 15.5M | for (size_t x = 0; x < (_count); x++) \ |
37 | 13.2M | { \ |
38 | 13.2M | do \ |
39 | 13.2M | { \ |
40 | 47.9M | _exp \ |
41 | 13.2M | } while (FALSE); \ |
42 | 13.2M | } \ |
43 | 2.25M | } while (FALSE) |
44 | | |
45 | | #define UNROLL_MULTIPLE(_condition, _exp, _count) \ |
46 | 1.83M | do \ |
47 | 1.83M | { \ |
48 | 4.09M | while ((_condition) >= (_count)) \ |
49 | 2.25M | { \ |
50 | 2.25M | UNROLL_BODY(_exp, _count); \ |
51 | 2.25M | (_condition) -= (_count); \ |
52 | 2.25M | } \ |
53 | 1.83M | } while (FALSE) |
54 | | |
55 | | #define UNROLL(_condition, _exp) \ |
56 | 612k | do \ |
57 | 612k | { \ |
58 | 612k | UNROLL_MULTIPLE(_condition, _exp, 16); \ |
59 | 612k | UNROLL_MULTIPLE(_condition, _exp, 4); \ |
60 | 612k | UNROLL_MULTIPLE(_condition, _exp, 1); \ |
61 | 612k | } while (FALSE) |
62 | | |
63 | | /* |
64 | | RLE Compressed Bitmap Stream (RLE_BITMAP_STREAM) |
65 | | http://msdn.microsoft.com/en-us/library/cc240895%28v=prot.10%29.aspx |
66 | | pseudo-code |
67 | | http://msdn.microsoft.com/en-us/library/dd240593%28v=prot.10%29.aspx |
68 | | */ |
69 | | |
70 | 851k | #define REGULAR_BG_RUN 0x00 |
71 | 159k | #define MEGA_MEGA_BG_RUN 0xF0 |
72 | 402k | #define REGULAR_FG_RUN 0x01 |
73 | 33.0k | #define MEGA_MEGA_FG_RUN 0xF1 |
74 | 155k | #define LITE_SET_FG_FG_RUN 0x0C |
75 | 81.9k | #define MEGA_MEGA_SET_FG_RUN 0xF6 |
76 | 39.8k | #define LITE_DITHERED_RUN 0x0E |
77 | 18.8k | #define MEGA_MEGA_DITHERED_RUN 0xF8 |
78 | 438k | #define REGULAR_COLOR_RUN 0x03 |
79 | 40.1k | #define MEGA_MEGA_COLOR_RUN 0xF3 |
80 | 28.3k | #define REGULAR_FGBG_IMAGE 0x02 |
81 | 25.5k | #define MEGA_MEGA_FGBG_IMAGE 0xF2 |
82 | 65.9k | #define LITE_SET_FG_FGBG_IMAGE 0x0D |
83 | 48.1k | #define MEGA_MEGA_SET_FGBG_IMAGE 0xF7 |
84 | 449k | #define REGULAR_COLOR_IMAGE 0x04 |
85 | 36.1k | #define MEGA_MEGA_COLOR_IMAGE 0xF4 |
86 | 2.59k | #define SPECIAL_FGBG_1 0xF9 |
87 | 2.59k | #define SPECIAL_FGBG_2 0xFA |
88 | 4.19k | #define SPECIAL_WHITE 0xFD |
89 | 2.79k | #define SPECIAL_BLACK 0xFE |
90 | | |
91 | | #define BLACK_PIXEL 0x000000 |
92 | | |
93 | | typedef UINT32 PIXEL; |
94 | | |
95 | | static const BYTE g_MaskSpecialFgBg1 = 0x03; |
96 | | static const BYTE g_MaskSpecialFgBg2 = 0x05; |
97 | | |
98 | | static const BYTE g_MaskRegularRunLength = 0x1F; |
99 | | static const BYTE g_MaskLiteRunLength = 0x0F; |
100 | | |
101 | | #if defined(WITH_DEBUG_CODECS) |
102 | | static const char* rle_code_str(UINT32 code) |
103 | | { |
104 | | switch (code) |
105 | | { |
106 | | case REGULAR_BG_RUN: |
107 | | return "REGULAR_BG_RUN"; |
108 | | case MEGA_MEGA_BG_RUN: |
109 | | return "MEGA_MEGA_BG_RUN"; |
110 | | case REGULAR_FG_RUN: |
111 | | return "REGULAR_FG_RUN"; |
112 | | case MEGA_MEGA_FG_RUN: |
113 | | return "MEGA_MEGA_FG_RUN"; |
114 | | case LITE_SET_FG_FG_RUN: |
115 | | return "LITE_SET_FG_FG_RUN"; |
116 | | case MEGA_MEGA_SET_FG_RUN: |
117 | | return "MEGA_MEGA_SET_FG_RUN"; |
118 | | case LITE_DITHERED_RUN: |
119 | | return "LITE_DITHERED_RUN"; |
120 | | case MEGA_MEGA_DITHERED_RUN: |
121 | | return "MEGA_MEGA_DITHERED_RUN"; |
122 | | case REGULAR_COLOR_RUN: |
123 | | return "REGULAR_COLOR_RUN"; |
124 | | case MEGA_MEGA_COLOR_RUN: |
125 | | return "MEGA_MEGA_COLOR_RUN"; |
126 | | case REGULAR_FGBG_IMAGE: |
127 | | return "REGULAR_FGBG_IMAGE"; |
128 | | case MEGA_MEGA_FGBG_IMAGE: |
129 | | return "MEGA_MEGA_FGBG_IMAGE"; |
130 | | case LITE_SET_FG_FGBG_IMAGE: |
131 | | return "LITE_SET_FG_FGBG_IMAGE"; |
132 | | case MEGA_MEGA_SET_FGBG_IMAGE: |
133 | | return "MEGA_MEGA_SET_FGBG_IMAGE"; |
134 | | case REGULAR_COLOR_IMAGE: |
135 | | return "REGULAR_COLOR_IMAGE"; |
136 | | case MEGA_MEGA_COLOR_IMAGE: |
137 | | return "MEGA_MEGA_COLOR_IMAGE"; |
138 | | case SPECIAL_FGBG_1: |
139 | | return "SPECIAL_FGBG_1"; |
140 | | case SPECIAL_FGBG_2: |
141 | | return "SPECIAL_FGBG_2"; |
142 | | case SPECIAL_WHITE: |
143 | | return "SPECIAL_WHITE"; |
144 | | case SPECIAL_BLACK: |
145 | | return "SPECIAL_BLACK"; |
146 | | default: |
147 | | return "UNKNOWN"; |
148 | | } |
149 | | } |
150 | | #endif |
151 | | |
152 | | #define buffer_within_range(pbSrc, size, pbEnd) \ |
153 | 828k | buffer_within_range_((pbSrc), (size), (pbEnd), __func__, __FILE__, __LINE__) |
154 | | static inline BOOL buffer_within_range_(const void* pbSrc, size_t size, const void* pbEnd, |
155 | | const char* fkt, const char* file, size_t line) |
156 | 828k | { |
157 | 828k | WINPR_UNUSED(file); |
158 | 828k | WINPR_ASSERT(pbSrc); |
159 | 828k | WINPR_ASSERT(pbEnd); |
160 | | |
161 | 828k | if ((const char*)pbSrc + size > (const char*)pbEnd) |
162 | 3.52k | { |
163 | 3.52k | WLog_ERR(TAG, "[%s:%" PRIuz "] pbSrc=%p + %" PRIuz " > pbEnd=%p", fkt, line, pbSrc, size, |
164 | 3.52k | pbEnd); |
165 | 3.52k | return FALSE; |
166 | 3.52k | } |
167 | 825k | return TRUE; |
168 | 828k | } |
169 | | |
170 | | /** |
171 | | * Reads the supplied order header and extracts the compression |
172 | | * order code ID. |
173 | | */ |
174 | | static inline UINT32 ExtractCodeId(BYTE bOrderHdr) |
175 | 504k | { |
176 | 504k | if ((bOrderHdr & 0xC0U) != 0xC0U) |
177 | 443k | { |
178 | | /* REGULAR orders |
179 | | * (000x xxxx, 001x xxxx, 010x xxxx, 011x xxxx, 100x xxxx) |
180 | | */ |
181 | 443k | return bOrderHdr >> 5; |
182 | 443k | } |
183 | 61.2k | else if ((bOrderHdr & 0xF0U) == 0xF0U) |
184 | 29.3k | { |
185 | | /* MEGA and SPECIAL orders (0xF*) */ |
186 | 29.3k | return bOrderHdr; |
187 | 29.3k | } |
188 | 31.9k | else |
189 | 31.9k | { |
190 | | /* LITE orders |
191 | | * 1100 xxxx, 1101 xxxx, 1110 xxxx) |
192 | | */ |
193 | 31.9k | return bOrderHdr >> 4; |
194 | 31.9k | } |
195 | 504k | } |
196 | | |
197 | | /** |
198 | | * Extract the run length of a compression order. |
199 | | */ |
200 | | static UINT ExtractRunLengthRegularFgBg(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
201 | 14.1k | { |
202 | 14.1k | UINT runLength = 0; |
203 | | |
204 | 14.1k | WINPR_ASSERT(pbOrderHdr); |
205 | 14.1k | WINPR_ASSERT(pbEnd); |
206 | 14.1k | WINPR_ASSERT(advance); |
207 | | |
208 | 14.1k | runLength = (*pbOrderHdr) & g_MaskRegularRunLength; |
209 | 14.1k | if (runLength == 0) |
210 | 6.14k | { |
211 | 6.14k | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
212 | 25 | { |
213 | 25 | *advance = 0; |
214 | 25 | return 0; |
215 | 25 | } |
216 | 6.12k | runLength = *(pbOrderHdr + 1) + 1; |
217 | 6.12k | (*advance)++; |
218 | 6.12k | } |
219 | 8.02k | else |
220 | 8.02k | runLength = runLength * 8; |
221 | | |
222 | 14.1k | return runLength; |
223 | 14.1k | } |
224 | | |
225 | | static UINT ExtractRunLengthLiteFgBg(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
226 | 3.87k | { |
227 | 3.87k | UINT runLength = 0; |
228 | | |
229 | 3.87k | WINPR_ASSERT(pbOrderHdr); |
230 | 3.87k | WINPR_ASSERT(pbEnd); |
231 | 3.87k | WINPR_ASSERT(advance); |
232 | | |
233 | 3.87k | runLength = *pbOrderHdr & g_MaskLiteRunLength; |
234 | 3.87k | if (runLength == 0) |
235 | 431 | { |
236 | 431 | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
237 | 18 | { |
238 | 18 | *advance = 0; |
239 | 18 | return 0; |
240 | 18 | } |
241 | 413 | runLength = *(pbOrderHdr + 1) + 1; |
242 | 413 | (*advance)++; |
243 | 413 | } |
244 | 3.44k | else |
245 | 3.44k | runLength = runLength * 8; |
246 | | |
247 | 3.85k | return runLength; |
248 | 3.87k | } |
249 | | |
250 | | static UINT ExtractRunLengthRegular(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
251 | 427k | { |
252 | 427k | UINT runLength = 0; |
253 | | |
254 | 427k | WINPR_ASSERT(pbOrderHdr); |
255 | 427k | WINPR_ASSERT(pbEnd); |
256 | 427k | WINPR_ASSERT(advance); |
257 | | |
258 | 427k | runLength = *pbOrderHdr & g_MaskRegularRunLength; |
259 | 427k | if (runLength == 0) |
260 | 187k | { |
261 | 187k | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
262 | 602 | { |
263 | 602 | *advance = 0; |
264 | 602 | return 0; |
265 | 602 | } |
266 | 187k | runLength = *(pbOrderHdr + 1) + 32; |
267 | 187k | (*advance)++; |
268 | 187k | } |
269 | | |
270 | 427k | return runLength; |
271 | 427k | } |
272 | | |
273 | | static UINT ExtractRunLengthMegaMega(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
274 | 12.3k | { |
275 | 12.3k | UINT runLength = 0; |
276 | | |
277 | 12.3k | WINPR_ASSERT(pbOrderHdr); |
278 | 12.3k | WINPR_ASSERT(pbEnd); |
279 | 12.3k | WINPR_ASSERT(advance); |
280 | | |
281 | 12.3k | if (!buffer_within_range(pbOrderHdr, 3, pbEnd)) |
282 | 346 | { |
283 | 346 | *advance = 0; |
284 | 346 | return 0; |
285 | 346 | } |
286 | | |
287 | 11.9k | runLength = ((UINT16)pbOrderHdr[1]) | ((((UINT16)pbOrderHdr[2]) << 8) & 0xFF00); |
288 | 11.9k | (*advance) += 2; |
289 | | |
290 | 11.9k | return runLength; |
291 | 12.3k | } |
292 | | |
293 | | static UINT ExtractRunLengthLite(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
294 | 28.0k | { |
295 | 28.0k | UINT runLength = 0; |
296 | | |
297 | 28.0k | WINPR_ASSERT(pbOrderHdr); |
298 | 28.0k | WINPR_ASSERT(pbEnd); |
299 | 28.0k | WINPR_ASSERT(advance); |
300 | | |
301 | 28.0k | runLength = *pbOrderHdr & g_MaskLiteRunLength; |
302 | 28.0k | if (runLength == 0) |
303 | 4.96k | { |
304 | 4.96k | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
305 | 30 | { |
306 | 30 | *advance = 0; |
307 | 30 | return 0; |
308 | 30 | } |
309 | 4.93k | runLength = *(pbOrderHdr + 1) + 16; |
310 | 4.93k | (*advance)++; |
311 | 4.93k | } |
312 | 28.0k | return runLength; |
313 | 28.0k | } |
314 | | |
315 | | static inline UINT32 ExtractRunLength(UINT32 code, const BYTE* pbOrderHdr, const BYTE* pbEnd, |
316 | | UINT32* advance) |
317 | 486k | { |
318 | 486k | UINT32 runLength = 0; |
319 | 486k | UINT32 ladvance = 1; |
320 | | |
321 | 486k | WINPR_ASSERT(pbOrderHdr); |
322 | 486k | WINPR_ASSERT(pbEnd); |
323 | 486k | WINPR_ASSERT(advance); |
324 | | |
325 | | #if defined(WITH_DEBUG_CODECS) |
326 | | WLog_VRB(TAG, "extracting %s", rle_code_str(code)); |
327 | | #endif |
328 | | |
329 | 486k | *advance = 0; |
330 | 486k | if (!buffer_within_range(pbOrderHdr, 0, pbEnd)) |
331 | 0 | return 0; |
332 | | |
333 | 486k | switch (code) |
334 | 486k | { |
335 | 14.1k | case REGULAR_FGBG_IMAGE: |
336 | 14.1k | runLength = ExtractRunLengthRegularFgBg(pbOrderHdr, pbEnd, &ladvance); |
337 | 14.1k | break; |
338 | | |
339 | 3.87k | case LITE_SET_FG_FGBG_IMAGE: |
340 | 3.87k | runLength = ExtractRunLengthLiteFgBg(pbOrderHdr, pbEnd, &ladvance); |
341 | 3.87k | break; |
342 | | |
343 | 346k | case REGULAR_BG_RUN: |
344 | 374k | case REGULAR_FG_RUN: |
345 | 406k | case REGULAR_COLOR_RUN: |
346 | 427k | case REGULAR_COLOR_IMAGE: |
347 | 427k | runLength = ExtractRunLengthRegular(pbOrderHdr, pbEnd, &ladvance); |
348 | 427k | break; |
349 | | |
350 | 16.2k | case LITE_SET_FG_FG_RUN: |
351 | 28.0k | case LITE_DITHERED_RUN: |
352 | 28.0k | runLength = ExtractRunLengthLite(pbOrderHdr, pbEnd, &ladvance); |
353 | 28.0k | break; |
354 | | |
355 | 1.48k | case MEGA_MEGA_BG_RUN: |
356 | 3.35k | case MEGA_MEGA_FG_RUN: |
357 | 4.37k | case MEGA_MEGA_SET_FG_RUN: |
358 | 5.69k | case MEGA_MEGA_DITHERED_RUN: |
359 | 6.99k | case MEGA_MEGA_COLOR_RUN: |
360 | 9.16k | case MEGA_MEGA_FGBG_IMAGE: |
361 | 10.0k | case MEGA_MEGA_SET_FGBG_IMAGE: |
362 | 12.3k | case MEGA_MEGA_COLOR_IMAGE: |
363 | 12.3k | runLength = ExtractRunLengthMegaMega(pbOrderHdr, pbEnd, &ladvance); |
364 | 12.3k | break; |
365 | | |
366 | 0 | default: |
367 | 0 | runLength = 0; |
368 | 0 | ladvance = 0; |
369 | 0 | break; |
370 | 486k | } |
371 | | |
372 | 486k | *advance = ladvance; |
373 | 486k | return runLength; |
374 | 486k | } |
375 | | |
376 | | #define ensure_capacity(start, end, size, base) \ |
377 | 954k | ensure_capacity_((start), (end), (size), (base), __func__, __FILE__, __LINE__) |
378 | | static inline BOOL ensure_capacity_(const BYTE* start, const BYTE* end, size_t size, size_t base, |
379 | | const char* fkt, WINPR_ATTR_UNUSED const char* file, |
380 | | size_t line) |
381 | 954k | { |
382 | 954k | const size_t available = (uintptr_t)end - (uintptr_t)start; |
383 | 954k | const BOOL rc = available >= size * base; |
384 | 954k | const BOOL res = rc && (start <= end); |
385 | | |
386 | 954k | if (!res) |
387 | 2.97k | WLog_ERR(TAG, |
388 | 954k | "[%s:%" PRIuz "] failed: start=%p <= end=%p, available=%" PRIuz " >= size=%" PRIuz |
389 | 954k | " * base=%" PRIuz, |
390 | 954k | fkt, line, WINPR_CXX_COMPAT_CAST(const void*, start), |
391 | 954k | WINPR_CXX_COMPAT_CAST(const void*, end), available, size, base); |
392 | 954k | return res; |
393 | 954k | } |
394 | | |
395 | | static inline void write_pixel_8(BYTE* _buf, BYTE _pix) |
396 | 0 | { |
397 | 0 | WINPR_ASSERT(_buf); |
398 | 0 | *_buf = _pix; |
399 | 0 | } |
400 | | |
401 | | static inline void write_pixel_24(BYTE* _buf, UINT32 _pix) |
402 | 4.34M | { |
403 | 4.34M | WINPR_ASSERT(_buf); |
404 | 4.34M | (_buf)[0] = (BYTE)(_pix); |
405 | 4.34M | (_buf)[1] = (BYTE)((_pix) >> 8); |
406 | 4.34M | (_buf)[2] = (BYTE)((_pix) >> 16); |
407 | 4.34M | } |
408 | | |
409 | | static inline void write_pixel_16(BYTE* _buf, UINT16 _pix) |
410 | 9.86M | { |
411 | 9.86M | WINPR_ASSERT(_buf); |
412 | 9.86M | _buf[0] = _pix & 0xFF; |
413 | 9.86M | _buf[1] = (_pix >> 8) & 0xFF; |
414 | 9.86M | } |
415 | | |
416 | | #undef DESTWRITEPIXEL |
417 | | #undef DESTREADPIXEL |
418 | | #undef SRCREADPIXEL |
419 | | #undef WRITEFGBGIMAGE |
420 | | #undef WRITEFIRSTLINEFGBGIMAGE |
421 | | #undef RLEDECOMPRESS |
422 | | #undef RLEEXTRA |
423 | | #undef WHITE_PIXEL |
424 | | #undef PIXEL_SIZE |
425 | | #undef PIXEL |
426 | | #define PIXEL_SIZE 1 |
427 | 0 | #define PIXEL BYTE |
428 | 0 | #define WHITE_PIXEL 0xFF |
429 | | #define DESTWRITEPIXEL(_buf, _pix) \ |
430 | 0 | do \ |
431 | 0 | { \ |
432 | 0 | write_pixel_8(_buf, _pix); \ |
433 | 0 | (_buf) += 1; \ |
434 | 0 | } while (0) |
435 | 0 | #define DESTREADPIXEL(_pix, _buf) _pix = (_buf)[0] |
436 | | #define SRCREADPIXEL(_pix, _buf) \ |
437 | 0 | do \ |
438 | 0 | { \ |
439 | 0 | (_pix) = (_buf)[0]; \ |
440 | 0 | (_buf) += 1; \ |
441 | 0 | } while (0) |
442 | | |
443 | 0 | #define WRITEFGBGIMAGE WriteFgBgImage8to8 |
444 | 0 | #define WRITEFIRSTLINEFGBGIMAGE WriteFirstLineFgBgImage8to8 |
445 | | #define RLEDECOMPRESS RleDecompress8to8 |
446 | | #define RLEEXTRA |
447 | | #undef ENSURE_CAPACITY |
448 | 0 | #define ENSURE_CAPACITY(_start, _end, _size) ensure_capacity(_start, _end, _size, 1) |
449 | | #include "include/bitmap.h" |
450 | | |
451 | | #undef DESTWRITEPIXEL |
452 | | #undef DESTREADPIXEL |
453 | | #undef SRCREADPIXEL |
454 | | #undef WRITEFGBGIMAGE |
455 | | #undef WRITEFIRSTLINEFGBGIMAGE |
456 | | #undef RLEDECOMPRESS |
457 | | #undef RLEEXTRA |
458 | | #undef WHITE_PIXEL |
459 | | #undef PIXEL_SIZE |
460 | | #undef PIXEL |
461 | | #define PIXEL_SIZE 2 |
462 | 114k | #define PIXEL UINT16 |
463 | 11.3k | #define WHITE_PIXEL 0xFFFF |
464 | | #define DESTWRITEPIXEL(_buf, _pix) \ |
465 | 212k | do \ |
466 | 212k | { \ |
467 | 212k | write_pixel_16(_buf, _pix); \ |
468 | 212k | (_buf) += 2; \ |
469 | 212k | } while (0) |
470 | 191k | #define DESTREADPIXEL(_pix, _buf) _pix = ((UINT16*)(_buf))[0] |
471 | | #define SRCREADPIXEL(_pix, _buf) \ |
472 | 53.2k | do \ |
473 | 53.2k | { \ |
474 | 53.2k | (_pix) = WINPR_ASSERTING_INT_CAST(UINT16, (_buf)[0] | (((_buf)[1] << 8) & 0xFF00)); \ |
475 | 53.2k | (_buf) += 2; \ |
476 | 53.2k | } while (0) |
477 | 68.6k | #define WRITEFGBGIMAGE WriteFgBgImage16to16 |
478 | 38.6k | #define WRITEFIRSTLINEFGBGIMAGE WriteFirstLineFgBgImage16to16 |
479 | | #define RLEDECOMPRESS RleDecompress16to16 |
480 | | #define RLEEXTRA |
481 | | #undef ENSURE_CAPACITY |
482 | 650k | #define ENSURE_CAPACITY(_start, _end, _size) ensure_capacity(_start, _end, _size, 2) |
483 | | #include "include/bitmap.h" |
484 | | |
485 | | #undef DESTWRITEPIXEL |
486 | | #undef DESTREADPIXEL |
487 | | #undef SRCREADPIXEL |
488 | | #undef WRITEFGBGIMAGE |
489 | | #undef WRITEFIRSTLINEFGBGIMAGE |
490 | | #undef RLEDECOMPRESS |
491 | | #undef RLEEXTRA |
492 | | #undef WHITE_PIXEL |
493 | | #undef PIXEL_SIZE |
494 | | #undef PIXEL |
495 | | #define PIXEL_SIZE 3 |
496 | 48.8k | #define PIXEL UINT32 |
497 | 5.69k | #define WHITE_PIXEL 0xffffff |
498 | | #define DESTWRITEPIXEL(_buf, _pix) \ |
499 | 102k | do \ |
500 | 102k | { \ |
501 | 102k | write_pixel_24(_buf, _pix); \ |
502 | 102k | (_buf) += 3; \ |
503 | 102k | } while (0) |
504 | | #define DESTREADPIXEL(_pix, _buf) \ |
505 | 92.4k | _pix = (_buf)[0] | (((_buf)[1] << 8) & 0xFF00) | (((_buf)[2] << 16) & 0xFF0000) |
506 | | #define SRCREADPIXEL(_pix, _buf) \ |
507 | 26.0k | do \ |
508 | 26.0k | { \ |
509 | 26.0k | (_pix) = (_buf)[0] | (((_buf)[1] << 8) & 0xFF00) | (((_buf)[2] << 16) & 0xFF0000); \ |
510 | 26.0k | (_buf) += 3; \ |
511 | 26.0k | } while (0) |
512 | | |
513 | 26.0k | #define WRITEFGBGIMAGE WriteFgBgImage24to24 |
514 | 18.8k | #define WRITEFIRSTLINEFGBGIMAGE WriteFirstLineFgBgImage24to24 |
515 | | #define RLEDECOMPRESS RleDecompress24to24 |
516 | | #define RLEEXTRA |
517 | | #undef ENSURE_CAPACITY |
518 | 304k | #define ENSURE_CAPACITY(_start, _end, _size) ensure_capacity(_start, _end, _size, 3) |
519 | | #include "include/bitmap.h" |
520 | | |
521 | | struct S_BITMAP_INTERLEAVED_CONTEXT |
522 | | { |
523 | | BOOL Compressor; |
524 | | |
525 | | UINT32 TempSize; |
526 | | BYTE* TempBuffer; |
527 | | |
528 | | wStream* bts; |
529 | | }; |
530 | | |
531 | | BOOL interleaved_decompress(BITMAP_INTERLEAVED_CONTEXT* WINPR_RESTRICT interleaved, |
532 | | const BYTE* WINPR_RESTRICT pSrcData, UINT32 SrcSize, UINT32 nSrcWidth, |
533 | | UINT32 nSrcHeight, UINT32 bpp, BYTE* WINPR_RESTRICT pDstData, |
534 | | UINT32 DstFormat, UINT32 nDstStep, UINT32 nXDst, UINT32 nYDst, |
535 | | UINT32 nDstWidth, UINT32 nDstHeight, |
536 | | const gdiPalette* WINPR_RESTRICT palette) |
537 | 17.0k | { |
538 | 17.0k | UINT32 scanline = 0; |
539 | 17.0k | UINT32 SrcFormat = 0; |
540 | 17.0k | UINT32 BufferSize = 0; |
541 | | |
542 | 17.0k | if (!interleaved || !pSrcData || !pDstData) |
543 | 0 | { |
544 | 0 | WLog_ERR(TAG, "invalid arguments: interleaved=%p, pSrcData=%p, pDstData=%p", |
545 | 0 | WINPR_CXX_COMPAT_CAST(const void*, interleaved), |
546 | 0 | WINPR_CXX_COMPAT_CAST(const void*, pSrcData), |
547 | 0 | WINPR_CXX_COMPAT_CAST(const void*, pDstData)); |
548 | 0 | return FALSE; |
549 | 0 | } |
550 | | |
551 | 17.0k | switch (bpp) |
552 | 17.0k | { |
553 | 5.69k | case 24: |
554 | 5.69k | scanline = nSrcWidth * 3; |
555 | 5.69k | SrcFormat = PIXEL_FORMAT_BGR24; |
556 | 5.69k | break; |
557 | | |
558 | 5.69k | case 16: |
559 | 5.69k | scanline = nSrcWidth * 2; |
560 | 5.69k | SrcFormat = PIXEL_FORMAT_RGB16; |
561 | 5.69k | break; |
562 | | |
563 | 5.69k | case 15: |
564 | 5.69k | scanline = nSrcWidth * 2; |
565 | 5.69k | SrcFormat = PIXEL_FORMAT_RGB15; |
566 | 5.69k | break; |
567 | | |
568 | 0 | case 8: |
569 | 0 | scanline = nSrcWidth; |
570 | 0 | SrcFormat = PIXEL_FORMAT_RGB8; |
571 | 0 | break; |
572 | | |
573 | 0 | default: |
574 | 0 | WLog_ERR(TAG, "Invalid color depth %" PRIu32 "", bpp); |
575 | 0 | return FALSE; |
576 | 17.0k | } |
577 | | |
578 | 17.0k | BufferSize = scanline * nSrcHeight; |
579 | | |
580 | 17.0k | if (BufferSize > interleaved->TempSize) |
581 | 0 | { |
582 | 0 | interleaved->TempBuffer = |
583 | 0 | winpr_aligned_recalloc(interleaved->TempBuffer, BufferSize, sizeof(BYTE), 16); |
584 | 0 | interleaved->TempSize = BufferSize; |
585 | 0 | } |
586 | | |
587 | 17.0k | if (!interleaved->TempBuffer) |
588 | 0 | { |
589 | 0 | WLog_ERR(TAG, "interleaved->TempBuffer=nullptr"); |
590 | 0 | return FALSE; |
591 | 0 | } |
592 | | |
593 | 17.0k | switch (bpp) |
594 | 17.0k | { |
595 | 5.69k | case 24: |
596 | 5.69k | if (!RleDecompress24to24(pSrcData, SrcSize, interleaved->TempBuffer, scanline, |
597 | 5.69k | nSrcWidth, nSrcHeight)) |
598 | 4.22k | { |
599 | 4.22k | WLog_ERR(TAG, "RleDecompress24to24 failed"); |
600 | 4.22k | return FALSE; |
601 | 4.22k | } |
602 | | |
603 | 1.47k | break; |
604 | | |
605 | 5.69k | case 16: |
606 | 11.3k | case 15: |
607 | 11.3k | if (!RleDecompress16to16(pSrcData, SrcSize, interleaved->TempBuffer, scanline, |
608 | 11.3k | nSrcWidth, nSrcHeight)) |
609 | 8.47k | { |
610 | 8.47k | WLog_ERR(TAG, "RleDecompress16to16 failed"); |
611 | 8.47k | return FALSE; |
612 | 8.47k | } |
613 | | |
614 | 2.92k | break; |
615 | | |
616 | 2.92k | case 8: |
617 | 0 | if (!RleDecompress8to8(pSrcData, SrcSize, interleaved->TempBuffer, scanline, nSrcWidth, |
618 | 0 | nSrcHeight)) |
619 | 0 | { |
620 | 0 | WLog_ERR(TAG, "RleDecompress8to8 failed"); |
621 | 0 | return FALSE; |
622 | 0 | } |
623 | | |
624 | 0 | break; |
625 | | |
626 | 0 | default: |
627 | 0 | WLog_ERR(TAG, "Invalid color depth %" PRIu32 "", bpp); |
628 | 0 | return FALSE; |
629 | 17.0k | } |
630 | | |
631 | 4.39k | if (!freerdp_image_copy_no_overlap(pDstData, DstFormat, nDstStep, nXDst, nYDst, nDstWidth, |
632 | 4.39k | nDstHeight, interleaved->TempBuffer, SrcFormat, scanline, 0, |
633 | 4.39k | 0, palette, FREERDP_FLIP_VERTICAL | FREERDP_KEEP_DST_ALPHA)) |
634 | 0 | { |
635 | 0 | WLog_ERR(TAG, "freerdp_image_copy failed"); |
636 | 0 | return FALSE; |
637 | 0 | } |
638 | 4.39k | return TRUE; |
639 | 4.39k | } |
640 | | |
641 | | BOOL interleaved_compress(BITMAP_INTERLEAVED_CONTEXT* WINPR_RESTRICT interleaved, |
642 | | BYTE* WINPR_RESTRICT pDstData, UINT32* WINPR_RESTRICT pDstSize, |
643 | | UINT32 nWidth, UINT32 nHeight, const BYTE* WINPR_RESTRICT pSrcData, |
644 | | UINT32 SrcFormat, UINT32 nSrcStep, UINT32 nXSrc, UINT32 nYSrc, |
645 | | const gdiPalette* WINPR_RESTRICT palette, UINT32 bpp) |
646 | 0 | { |
647 | 0 | BOOL status = 0; |
648 | 0 | wStream* s = nullptr; |
649 | 0 | UINT32 DstFormat = 0; |
650 | 0 | const UINT32 maxSize = 64 * 64 * 4; |
651 | |
|
652 | 0 | if (!interleaved || !pDstData || !pSrcData) |
653 | 0 | return FALSE; |
654 | | |
655 | 0 | if ((nWidth == 0) || (nHeight == 0)) |
656 | 0 | return FALSE; |
657 | | |
658 | 0 | if (nWidth % 4) |
659 | 0 | { |
660 | 0 | WLog_ERR(TAG, "interleaved_compress: width is not a multiple of 4"); |
661 | 0 | return FALSE; |
662 | 0 | } |
663 | | |
664 | 0 | if ((nWidth > 64) || (nHeight > 64)) |
665 | 0 | { |
666 | 0 | WLog_ERR(TAG, |
667 | 0 | "interleaved_compress: width (%" PRIu32 ") or height (%" PRIu32 |
668 | 0 | ") is greater than 64", |
669 | 0 | nWidth, nHeight); |
670 | 0 | return FALSE; |
671 | 0 | } |
672 | | |
673 | 0 | switch (bpp) |
674 | 0 | { |
675 | 0 | case 24: |
676 | 0 | DstFormat = PIXEL_FORMAT_BGRX32; |
677 | 0 | break; |
678 | | |
679 | 0 | case 16: |
680 | 0 | DstFormat = PIXEL_FORMAT_RGB16; |
681 | 0 | break; |
682 | | |
683 | 0 | case 15: |
684 | 0 | DstFormat = PIXEL_FORMAT_RGB15; |
685 | 0 | break; |
686 | | |
687 | 0 | default: |
688 | 0 | return FALSE; |
689 | 0 | } |
690 | | |
691 | 0 | if (!freerdp_image_copy_no_overlap(interleaved->TempBuffer, DstFormat, 0, 0, 0, nWidth, nHeight, |
692 | 0 | pSrcData, SrcFormat, nSrcStep, nXSrc, nYSrc, palette, |
693 | 0 | FREERDP_KEEP_DST_ALPHA)) |
694 | 0 | return FALSE; |
695 | | |
696 | 0 | s = Stream_New(pDstData, *pDstSize); |
697 | |
|
698 | 0 | if (!s) |
699 | 0 | return FALSE; |
700 | | |
701 | 0 | Stream_ResetPosition(interleaved->bts); |
702 | |
|
703 | 0 | status = (freerdp_bitmap_compress(interleaved->TempBuffer, nWidth, nHeight, s, bpp, maxSize, |
704 | 0 | nHeight - 1, interleaved->bts, 0) >= 0); |
705 | |
|
706 | 0 | Stream_SealLength(s); |
707 | 0 | *pDstSize = (UINT32)Stream_Length(s); |
708 | 0 | Stream_Free(s, FALSE); |
709 | 0 | return status; |
710 | 0 | } |
711 | | |
712 | | BOOL bitmap_interleaved_context_reset(BITMAP_INTERLEAVED_CONTEXT* WINPR_RESTRICT interleaved) |
713 | 17.0k | { |
714 | 17.0k | return (interleaved != nullptr); |
715 | 17.0k | } |
716 | | |
717 | | BITMAP_INTERLEAVED_CONTEXT* bitmap_interleaved_context_new(WINPR_ATTR_UNUSED BOOL Compressor) |
718 | 5.69k | { |
719 | 5.69k | BITMAP_INTERLEAVED_CONTEXT* interleaved = nullptr; |
720 | 5.69k | interleaved = (BITMAP_INTERLEAVED_CONTEXT*)winpr_aligned_recalloc( |
721 | 5.69k | nullptr, 1, sizeof(BITMAP_INTERLEAVED_CONTEXT), 32); |
722 | | |
723 | 5.69k | if (interleaved) |
724 | 5.69k | { |
725 | 5.69k | interleaved->TempSize = 64 * 64 * 4; |
726 | 5.69k | interleaved->TempBuffer = winpr_aligned_calloc(interleaved->TempSize, sizeof(BYTE), 16); |
727 | | |
728 | 5.69k | if (!interleaved->TempBuffer) |
729 | 0 | goto fail; |
730 | | |
731 | 5.69k | interleaved->bts = Stream_New(nullptr, interleaved->TempSize); |
732 | | |
733 | 5.69k | if (!interleaved->bts) |
734 | 0 | goto fail; |
735 | 5.69k | } |
736 | | |
737 | 5.69k | return interleaved; |
738 | | |
739 | 0 | fail: |
740 | 0 | WINPR_PRAGMA_DIAG_PUSH |
741 | 0 | WINPR_PRAGMA_DIAG_IGNORED_MISMATCHED_DEALLOC |
742 | 0 | bitmap_interleaved_context_free(interleaved); |
743 | 0 | WINPR_PRAGMA_DIAG_POP |
744 | 0 | return nullptr; |
745 | 5.69k | } |
746 | | |
747 | | void bitmap_interleaved_context_free(BITMAP_INTERLEAVED_CONTEXT* WINPR_RESTRICT interleaved) |
748 | 5.69k | { |
749 | 5.69k | if (!interleaved) |
750 | 0 | return; |
751 | | |
752 | 5.69k | winpr_aligned_free(interleaved->TempBuffer); |
753 | 5.69k | Stream_Free(interleaved->bts, TRUE); |
754 | 5.69k | winpr_aligned_free(interleaved); |
755 | 5.69k | } |