/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.11M | do \ |
35 | 2.11M | { \ |
36 | 14.8M | for (size_t x = 0; x < (_count); x++) \ |
37 | 12.7M | { \ |
38 | 12.7M | do \ |
39 | 12.7M | { \ |
40 | 47.9M | _exp \ |
41 | 12.7M | } while (FALSE); \ |
42 | 12.7M | } \ |
43 | 2.11M | } while (FALSE) |
44 | | |
45 | | #define UNROLL_MULTIPLE(_condition, _exp, _count) \ |
46 | 1.73M | do \ |
47 | 1.73M | { \ |
48 | 3.84M | while ((_condition) >= (_count)) \ |
49 | 2.11M | { \ |
50 | 2.11M | UNROLL_BODY(_exp, _count); \ |
51 | 2.11M | (_condition) -= (_count); \ |
52 | 2.11M | } \ |
53 | 1.73M | } while (FALSE) |
54 | | |
55 | | #define UNROLL(_condition, _exp) \ |
56 | 578k | do \ |
57 | 578k | { \ |
58 | 578k | UNROLL_MULTIPLE(_condition, _exp, 16); \ |
59 | 578k | UNROLL_MULTIPLE(_condition, _exp, 4); \ |
60 | 578k | UNROLL_MULTIPLE(_condition, _exp, 1); \ |
61 | 578k | } 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 | 774k | #define REGULAR_BG_RUN 0x00 |
71 | 144k | #define MEGA_MEGA_BG_RUN 0xF0 |
72 | 372k | #define REGULAR_FG_RUN 0x01 |
73 | 33.4k | #define MEGA_MEGA_FG_RUN 0xF1 |
74 | 152k | #define LITE_SET_FG_FG_RUN 0x0C |
75 | 81.5k | #define MEGA_MEGA_SET_FG_RUN 0xF6 |
76 | 36.4k | #define LITE_DITHERED_RUN 0x0E |
77 | 17.5k | #define MEGA_MEGA_DITHERED_RUN 0xF8 |
78 | 405k | #define REGULAR_COLOR_RUN 0x03 |
79 | 39.0k | #define MEGA_MEGA_COLOR_RUN 0xF3 |
80 | 27.4k | #define REGULAR_FGBG_IMAGE 0x02 |
81 | 25.0k | #define MEGA_MEGA_FGBG_IMAGE 0xF2 |
82 | 66.1k | #define LITE_SET_FG_FGBG_IMAGE 0x0D |
83 | 48.1k | #define MEGA_MEGA_SET_FGBG_IMAGE 0xF7 |
84 | 394k | #define REGULAR_COLOR_IMAGE 0x04 |
85 | 24.9k | #define MEGA_MEGA_COLOR_IMAGE 0xF4 |
86 | 2.14k | #define SPECIAL_FGBG_1 0xF9 |
87 | 2.77k | #define SPECIAL_FGBG_2 0xFA |
88 | 3.69k | #define SPECIAL_WHITE 0xFD |
89 | 2.81k | #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 | 757k | 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 | 757k | { |
157 | 757k | WINPR_UNUSED(file); |
158 | 757k | WINPR_ASSERT(pbSrc); |
159 | 757k | WINPR_ASSERT(pbEnd); |
160 | | |
161 | 757k | if ((const char*)pbSrc + size > (const char*)pbEnd) |
162 | 3.34k | { |
163 | 3.34k | WLog_ERR(TAG, "[%s:%" PRIuz "] pbSrc=%p + %" PRIuz " > pbEnd=%p", fkt, line, pbSrc, size, |
164 | 3.34k | pbEnd); |
165 | 3.34k | return FALSE; |
166 | 3.34k | } |
167 | 754k | return TRUE; |
168 | 757k | } |
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 | 458k | { |
176 | 458k | if ((bOrderHdr & 0xC0U) != 0xC0U) |
177 | 399k | { |
178 | | /* REGULAR orders |
179 | | * (000x xxxx, 001x xxxx, 010x xxxx, 011x xxxx, 100x xxxx) |
180 | | */ |
181 | 399k | return bOrderHdr >> 5; |
182 | 399k | } |
183 | 58.8k | else if ((bOrderHdr & 0xF0U) == 0xF0U) |
184 | 28.8k | { |
185 | | /* MEGA and SPECIAL orders (0xF*) */ |
186 | 28.8k | return bOrderHdr; |
187 | 28.8k | } |
188 | 29.9k | else |
189 | 29.9k | { |
190 | | /* LITE orders |
191 | | * 1100 xxxx, 1101 xxxx, 1110 xxxx) |
192 | | */ |
193 | 29.9k | return bOrderHdr >> 4; |
194 | 29.9k | } |
195 | 458k | } |
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 | 13.7k | { |
202 | 13.7k | UINT runLength = 0; |
203 | | |
204 | 13.7k | WINPR_ASSERT(pbOrderHdr); |
205 | 13.7k | WINPR_ASSERT(pbEnd); |
206 | 13.7k | WINPR_ASSERT(advance); |
207 | | |
208 | 13.7k | runLength = (*pbOrderHdr) & g_MaskRegularRunLength; |
209 | 13.7k | if (runLength == 0) |
210 | 6.02k | { |
211 | 6.02k | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
212 | 29 | { |
213 | 29 | *advance = 0; |
214 | 29 | return 0; |
215 | 29 | } |
216 | 5.99k | runLength = *(pbOrderHdr + 1) + 1; |
217 | 5.99k | (*advance)++; |
218 | 5.99k | } |
219 | 7.72k | else |
220 | 7.72k | runLength = runLength * 8; |
221 | | |
222 | 13.7k | return runLength; |
223 | 13.7k | } |
224 | | |
225 | | static UINT ExtractRunLengthLiteFgBg(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
226 | 4.16k | { |
227 | 4.16k | UINT runLength = 0; |
228 | | |
229 | 4.16k | WINPR_ASSERT(pbOrderHdr); |
230 | 4.16k | WINPR_ASSERT(pbEnd); |
231 | 4.16k | WINPR_ASSERT(advance); |
232 | | |
233 | 4.16k | runLength = *pbOrderHdr & g_MaskLiteRunLength; |
234 | 4.16k | if (runLength == 0) |
235 | 284 | { |
236 | 284 | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
237 | 12 | { |
238 | 12 | *advance = 0; |
239 | 12 | return 0; |
240 | 12 | } |
241 | 272 | runLength = *(pbOrderHdr + 1) + 1; |
242 | 272 | (*advance)++; |
243 | 272 | } |
244 | 3.88k | else |
245 | 3.88k | runLength = runLength * 8; |
246 | | |
247 | 4.15k | return runLength; |
248 | 4.16k | } |
249 | | |
250 | | static UINT ExtractRunLengthRegular(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
251 | 384k | { |
252 | 384k | UINT runLength = 0; |
253 | | |
254 | 384k | WINPR_ASSERT(pbOrderHdr); |
255 | 384k | WINPR_ASSERT(pbEnd); |
256 | 384k | WINPR_ASSERT(advance); |
257 | | |
258 | 384k | runLength = *pbOrderHdr & g_MaskRegularRunLength; |
259 | 384k | if (runLength == 0) |
260 | 166k | { |
261 | 166k | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
262 | 620 | { |
263 | 620 | *advance = 0; |
264 | 620 | return 0; |
265 | 620 | } |
266 | 166k | runLength = *(pbOrderHdr + 1) + 32; |
267 | 166k | (*advance)++; |
268 | 166k | } |
269 | | |
270 | 383k | return runLength; |
271 | 384k | } |
272 | | |
273 | | static UINT ExtractRunLengthMegaMega(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
274 | 12.6k | { |
275 | 12.6k | UINT runLength = 0; |
276 | | |
277 | 12.6k | WINPR_ASSERT(pbOrderHdr); |
278 | 12.6k | WINPR_ASSERT(pbEnd); |
279 | 12.6k | WINPR_ASSERT(advance); |
280 | | |
281 | 12.6k | if (!buffer_within_range(pbOrderHdr, 3, pbEnd)) |
282 | 357 | { |
283 | 357 | *advance = 0; |
284 | 357 | return 0; |
285 | 357 | } |
286 | | |
287 | 12.3k | runLength = ((UINT16)pbOrderHdr[1]) | ((((UINT16)pbOrderHdr[2]) << 8) & 0xFF00); |
288 | 12.3k | (*advance) += 2; |
289 | | |
290 | 12.3k | return runLength; |
291 | 12.6k | } |
292 | | |
293 | | static UINT ExtractRunLengthLite(const BYTE* pbOrderHdr, const BYTE* pbEnd, UINT32* advance) |
294 | 25.8k | { |
295 | 25.8k | UINT runLength = 0; |
296 | | |
297 | 25.8k | WINPR_ASSERT(pbOrderHdr); |
298 | 25.8k | WINPR_ASSERT(pbEnd); |
299 | 25.8k | WINPR_ASSERT(advance); |
300 | | |
301 | 25.8k | runLength = *pbOrderHdr & g_MaskLiteRunLength; |
302 | 25.8k | if (runLength == 0) |
303 | 4.99k | { |
304 | 4.99k | if (!buffer_within_range(pbOrderHdr, 2, pbEnd)) |
305 | 22 | { |
306 | 22 | *advance = 0; |
307 | 22 | return 0; |
308 | 22 | } |
309 | 4.97k | runLength = *(pbOrderHdr + 1) + 16; |
310 | 4.97k | (*advance)++; |
311 | 4.97k | } |
312 | 25.7k | return runLength; |
313 | 25.8k | } |
314 | | |
315 | | static inline UINT32 ExtractRunLength(UINT32 code, const BYTE* pbOrderHdr, const BYTE* pbEnd, |
316 | | UINT32* advance) |
317 | 440k | { |
318 | 440k | UINT32 runLength = 0; |
319 | 440k | UINT32 ladvance = 1; |
320 | | |
321 | 440k | WINPR_ASSERT(pbOrderHdr); |
322 | 440k | WINPR_ASSERT(pbEnd); |
323 | 440k | WINPR_ASSERT(advance); |
324 | | |
325 | | #if defined(WITH_DEBUG_CODECS) |
326 | | WLog_VRB(TAG, "extracting %s", rle_code_str(code)); |
327 | | #endif |
328 | | |
329 | 440k | *advance = 0; |
330 | 440k | if (!buffer_within_range(pbOrderHdr, 0, pbEnd)) |
331 | 0 | return 0; |
332 | | |
333 | 440k | switch (code) |
334 | 440k | { |
335 | 13.7k | case REGULAR_FGBG_IMAGE: |
336 | 13.7k | runLength = ExtractRunLengthRegularFgBg(pbOrderHdr, pbEnd, &ladvance); |
337 | 13.7k | break; |
338 | | |
339 | 4.16k | case LITE_SET_FG_FGBG_IMAGE: |
340 | 4.16k | runLength = ExtractRunLengthLiteFgBg(pbOrderHdr, pbEnd, &ladvance); |
341 | 4.16k | break; |
342 | | |
343 | 315k | case REGULAR_BG_RUN: |
344 | 343k | case REGULAR_FG_RUN: |
345 | 374k | case REGULAR_COLOR_RUN: |
346 | 384k | case REGULAR_COLOR_IMAGE: |
347 | 384k | runLength = ExtractRunLengthRegular(pbOrderHdr, pbEnd, &ladvance); |
348 | 384k | break; |
349 | | |
350 | 15.1k | case LITE_SET_FG_FG_RUN: |
351 | 25.8k | case LITE_DITHERED_RUN: |
352 | 25.8k | runLength = ExtractRunLengthLite(pbOrderHdr, pbEnd, &ladvance); |
353 | 25.8k | break; |
354 | | |
355 | 1.61k | case MEGA_MEGA_BG_RUN: |
356 | 3.43k | case MEGA_MEGA_FG_RUN: |
357 | 4.45k | case MEGA_MEGA_SET_FG_RUN: |
358 | 5.67k | case MEGA_MEGA_DITHERED_RUN: |
359 | 7.04k | case MEGA_MEGA_COLOR_RUN: |
360 | 9.19k | case MEGA_MEGA_FGBG_IMAGE: |
361 | 10.2k | case MEGA_MEGA_SET_FGBG_IMAGE: |
362 | 12.6k | case MEGA_MEGA_COLOR_IMAGE: |
363 | 12.6k | runLength = ExtractRunLengthMegaMega(pbOrderHdr, pbEnd, &ladvance); |
364 | 12.6k | break; |
365 | | |
366 | 0 | default: |
367 | 0 | runLength = 0; |
368 | 0 | ladvance = 0; |
369 | 0 | break; |
370 | 440k | } |
371 | | |
372 | 440k | *advance = ladvance; |
373 | 440k | return runLength; |
374 | 440k | } |
375 | | |
376 | | #define ensure_capacity(start, end, size, base) \ |
377 | 879k | 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 | 879k | { |
382 | 879k | const size_t available = (uintptr_t)end - (uintptr_t)start; |
383 | 879k | const BOOL rc = available >= size * base; |
384 | 879k | const BOOL res = rc && (start <= end); |
385 | | |
386 | 879k | if (!res) |
387 | 2.80k | WLog_ERR(TAG, |
388 | 879k | "[%s:%" PRIuz "] failed: start=%p <= end=%p, available=%" PRIuz " >= size=%" PRIuz |
389 | 879k | " * base=%" PRIuz, |
390 | 879k | fkt, line, WINPR_CXX_COMPAT_CAST(const void*, start), |
391 | 879k | WINPR_CXX_COMPAT_CAST(const void*, end), available, size, base); |
392 | 879k | return res; |
393 | 879k | } |
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.20M | { |
403 | 4.20M | WINPR_ASSERT(_buf); |
404 | 4.20M | (_buf)[0] = (BYTE)(_pix); |
405 | 4.20M | (_buf)[1] = (BYTE)((_pix) >> 8); |
406 | 4.20M | (_buf)[2] = (BYTE)((_pix) >> 16); |
407 | 4.20M | } |
408 | | |
409 | | static inline void write_pixel_16(BYTE* _buf, UINT16 _pix) |
410 | 9.44M | { |
411 | 9.44M | WINPR_ASSERT(_buf); |
412 | 9.44M | _buf[0] = _pix & 0xFF; |
413 | 9.44M | _buf[1] = (_pix >> 8) & 0xFF; |
414 | 9.44M | } |
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 | 119k | #define PIXEL UINT16 |
463 | 11.0k | #define WHITE_PIXEL 0xFFFF |
464 | | #define DESTWRITEPIXEL(_buf, _pix) \ |
465 | 192k | do \ |
466 | 192k | { \ |
467 | 192k | write_pixel_16(_buf, _pix); \ |
468 | 192k | (_buf) += 2; \ |
469 | 192k | } while (0) |
470 | 172k | #define DESTREADPIXEL(_pix, _buf) _pix = ((UINT16*)(_buf))[0] |
471 | | #define SRCREADPIXEL(_pix, _buf) \ |
472 | 50.5k | do \ |
473 | 50.5k | { \ |
474 | 50.5k | (_pix) = WINPR_ASSERTING_INT_CAST(UINT16, (_buf)[0] | (((_buf)[1] << 8) & 0xFF00)); \ |
475 | 50.5k | (_buf) += 2; \ |
476 | 50.5k | } while (0) |
477 | 75.1k | #define WRITEFGBGIMAGE WriteFgBgImage16to16 |
478 | 38.5k | #define WRITEFIRSTLINEFGBGIMAGE WriteFirstLineFgBgImage16to16 |
479 | | #define RLEDECOMPRESS RleDecompress16to16 |
480 | | #define RLEEXTRA |
481 | | #undef ENSURE_CAPACITY |
482 | 597k | #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 | 51.7k | #define PIXEL UINT32 |
497 | 5.51k | #define WHITE_PIXEL 0xffffff |
498 | | #define DESTWRITEPIXEL(_buf, _pix) \ |
499 | 93.5k | do \ |
500 | 93.5k | { \ |
501 | 93.5k | write_pixel_24(_buf, _pix); \ |
502 | 93.5k | (_buf) += 3; \ |
503 | 93.5k | } while (0) |
504 | | #define DESTREADPIXEL(_pix, _buf) \ |
505 | 83.6k | _pix = (_buf)[0] | (((_buf)[1] << 8) & 0xFF00) | (((_buf)[2] << 16) & 0xFF0000) |
506 | | #define SRCREADPIXEL(_pix, _buf) \ |
507 | 24.6k | do \ |
508 | 24.6k | { \ |
509 | 24.6k | (_pix) = (_buf)[0] | (((_buf)[1] << 8) & 0xFF00) | (((_buf)[2] << 16) & 0xFF0000); \ |
510 | 24.6k | (_buf) += 3; \ |
511 | 24.6k | } while (0) |
512 | | |
513 | 29.6k | #define WRITEFGBGIMAGE WriteFgBgImage24to24 |
514 | 20.2k | #define WRITEFIRSTLINEFGBGIMAGE WriteFirstLineFgBgImage24to24 |
515 | | #define RLEDECOMPRESS RleDecompress24to24 |
516 | | #define RLEEXTRA |
517 | | #undef ENSURE_CAPACITY |
518 | 282k | #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 | 16.5k | { |
538 | 16.5k | UINT32 scanline = 0; |
539 | 16.5k | UINT32 SrcFormat = 0; |
540 | 16.5k | UINT32 BufferSize = 0; |
541 | | |
542 | 16.5k | 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 | 16.5k | switch (bpp) |
552 | 16.5k | { |
553 | 5.51k | case 24: |
554 | 5.51k | scanline = nSrcWidth * 3; |
555 | 5.51k | SrcFormat = PIXEL_FORMAT_BGR24; |
556 | 5.51k | break; |
557 | | |
558 | 5.51k | case 16: |
559 | 5.51k | scanline = nSrcWidth * 2; |
560 | 5.51k | SrcFormat = PIXEL_FORMAT_RGB16; |
561 | 5.51k | break; |
562 | | |
563 | 5.51k | case 15: |
564 | 5.51k | scanline = nSrcWidth * 2; |
565 | 5.51k | SrcFormat = PIXEL_FORMAT_RGB15; |
566 | 5.51k | 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 | 16.5k | } |
577 | | |
578 | 16.5k | BufferSize = scanline * nSrcHeight; |
579 | | |
580 | 16.5k | 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 | 16.5k | if (!interleaved->TempBuffer) |
588 | 0 | { |
589 | 0 | WLog_ERR(TAG, "interleaved->TempBuffer=NULL"); |
590 | 0 | return FALSE; |
591 | 0 | } |
592 | | |
593 | 16.5k | switch (bpp) |
594 | 16.5k | { |
595 | 5.51k | case 24: |
596 | 5.51k | if (!RleDecompress24to24(pSrcData, SrcSize, interleaved->TempBuffer, scanline, |
597 | 5.51k | nSrcWidth, nSrcHeight)) |
598 | 4.05k | { |
599 | 4.05k | WLog_ERR(TAG, "RleDecompress24to24 failed"); |
600 | 4.05k | return FALSE; |
601 | 4.05k | } |
602 | | |
603 | 1.45k | break; |
604 | | |
605 | 5.51k | case 16: |
606 | 11.0k | case 15: |
607 | 11.0k | if (!RleDecompress16to16(pSrcData, SrcSize, interleaved->TempBuffer, scanline, |
608 | 11.0k | nSrcWidth, nSrcHeight)) |
609 | 8.22k | { |
610 | 8.22k | WLog_ERR(TAG, "RleDecompress16to16 failed"); |
611 | 8.22k | return FALSE; |
612 | 8.22k | } |
613 | | |
614 | 2.80k | break; |
615 | | |
616 | 2.80k | 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 | 16.5k | } |
630 | | |
631 | 4.25k | if (!freerdp_image_copy_no_overlap(pDstData, DstFormat, nDstStep, nXDst, nYDst, nDstWidth, |
632 | 4.25k | nDstHeight, interleaved->TempBuffer, SrcFormat, scanline, 0, |
633 | 4.25k | 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.25k | return TRUE; |
639 | 4.25k | } |
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 = NULL; |
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_SetPosition(interleaved->bts, 0); |
702 | |
|
703 | 0 | if (freerdp_bitmap_compress(interleaved->TempBuffer, nWidth, nHeight, s, bpp, maxSize, |
704 | 0 | nHeight - 1, interleaved->bts, 0) < 0) |
705 | 0 | status = FALSE; |
706 | 0 | else |
707 | 0 | status = TRUE; |
708 | |
|
709 | 0 | Stream_SealLength(s); |
710 | 0 | *pDstSize = (UINT32)Stream_Length(s); |
711 | 0 | Stream_Free(s, FALSE); |
712 | 0 | return status; |
713 | 0 | } |
714 | | |
715 | | BOOL bitmap_interleaved_context_reset(BITMAP_INTERLEAVED_CONTEXT* WINPR_RESTRICT interleaved) |
716 | 16.5k | { |
717 | 16.5k | if (!interleaved) |
718 | 0 | return FALSE; |
719 | | |
720 | 16.5k | return TRUE; |
721 | 16.5k | } |
722 | | |
723 | | BITMAP_INTERLEAVED_CONTEXT* bitmap_interleaved_context_new(WINPR_ATTR_UNUSED BOOL Compressor) |
724 | 5.51k | { |
725 | 5.51k | BITMAP_INTERLEAVED_CONTEXT* interleaved = NULL; |
726 | 5.51k | interleaved = (BITMAP_INTERLEAVED_CONTEXT*)winpr_aligned_recalloc( |
727 | 5.51k | NULL, 1, sizeof(BITMAP_INTERLEAVED_CONTEXT), 32); |
728 | | |
729 | 5.51k | if (interleaved) |
730 | 5.51k | { |
731 | 5.51k | interleaved->TempSize = 64 * 64 * 4; |
732 | 5.51k | interleaved->TempBuffer = winpr_aligned_calloc(interleaved->TempSize, sizeof(BYTE), 16); |
733 | | |
734 | 5.51k | if (!interleaved->TempBuffer) |
735 | 0 | goto fail; |
736 | | |
737 | 5.51k | interleaved->bts = Stream_New(NULL, interleaved->TempSize); |
738 | | |
739 | 5.51k | if (!interleaved->bts) |
740 | 0 | goto fail; |
741 | 5.51k | } |
742 | | |
743 | 5.51k | return interleaved; |
744 | | |
745 | 0 | fail: |
746 | 0 | WINPR_PRAGMA_DIAG_PUSH |
747 | 0 | WINPR_PRAGMA_DIAG_IGNORED_MISMATCHED_DEALLOC |
748 | 0 | bitmap_interleaved_context_free(interleaved); |
749 | 0 | WINPR_PRAGMA_DIAG_POP |
750 | 0 | return NULL; |
751 | 5.51k | } |
752 | | |
753 | | void bitmap_interleaved_context_free(BITMAP_INTERLEAVED_CONTEXT* WINPR_RESTRICT interleaved) |
754 | 5.51k | { |
755 | 5.51k | if (!interleaved) |
756 | 0 | return; |
757 | | |
758 | 5.51k | winpr_aligned_free(interleaved->TempBuffer); |
759 | 5.51k | Stream_Free(interleaved->bts, TRUE); |
760 | 5.51k | winpr_aligned_free(interleaved); |
761 | 5.51k | } |