OLD | NEW |
1 // Copyright 2014 PDFium Authors. All rights reserved. | 1 // Copyright 2014 PDFium Authors. All rights reserved. |
2 // Use of this source code is governed by a BSD-style license that can be | 2 // Use of this source code is governed by a BSD-style license that can be |
3 // found in the LICENSE file. | 3 // found in the LICENSE file. |
4 | 4 |
5 // Original code copyright 2014 Foxit Software Inc. http://www.foxitsoftware.com | 5 // Original code copyright 2014 Foxit Software Inc. http://www.foxitsoftware.com |
6 | 6 |
7 #include "core/src/fxcodec/lbmp/fx_bmp.h" | 7 #include "core/src/fxcodec/lbmp/fx_bmp.h" |
8 | 8 |
9 #include <algorithm> | 9 #include <algorithm> |
10 | 10 |
11 namespace { | 11 namespace { |
12 | 12 |
13 const size_t kBmpCoreHeaderSize = 12; | 13 const size_t kBmpCoreHeaderSize = 12; |
14 const size_t kBmpInfoHeaderSize = 40; | 14 const size_t kBmpInfoHeaderSize = 40; |
15 | 15 |
16 } // namespace | 16 // TODO(thestig): Replace with FXDWORD_GET_LSBFIRST? |
17 | 17 FX_DWORD GetDWord_LSBFirst(uint8_t* p) { |
18 FX_DWORD _GetDWord_LSBFirst(uint8_t* p) { | |
19 return p[0] | (p[1] << 8) | (p[2] << 16) | (p[3] << 24); | 18 return p[0] | (p[1] << 8) | (p[2] << 16) | (p[3] << 24); |
20 } | 19 } |
21 FX_WORD _GetWord_LSBFirst(uint8_t* p) { | 20 |
22 return p[0] | (p[1] << 8); | 21 void SetDWord_LSBFirst(uint8_t* p, FX_DWORD v) { |
23 } | |
24 void _SetDWord_LSBFirst(uint8_t* p, FX_DWORD v) { | |
25 p[0] = (uint8_t)v; | 22 p[0] = (uint8_t)v; |
26 p[1] = (uint8_t)(v >> 8); | 23 p[1] = (uint8_t)(v >> 8); |
27 p[2] = (uint8_t)(v >> 16); | 24 p[2] = (uint8_t)(v >> 16); |
28 p[3] = (uint8_t)(v >> 24); | 25 p[3] = (uint8_t)(v >> 24); |
29 } | 26 } |
30 void _SetWord_LSBFirst(uint8_t* p, FX_WORD v) { | 27 } // namespace |
| 28 |
| 29 FX_WORD GetWord_LSBFirst(uint8_t* p) { |
| 30 return p[0] | (p[1] << 8); |
| 31 } |
| 32 void SetWord_LSBFirst(uint8_t* p, FX_WORD v) { |
31 p[0] = (uint8_t)v; | 33 p[0] = (uint8_t)v; |
32 p[1] = (uint8_t)(v >> 8); | 34 p[1] = (uint8_t)(v >> 8); |
33 } | 35 } |
34 void _bmp_error(bmp_decompress_struct_p bmp_ptr, const FX_CHAR* err_msg) { | 36 void bmp_error(bmp_decompress_struct_p bmp_ptr, const FX_CHAR* err_msg) { |
35 if (bmp_ptr && bmp_ptr->_bmp_error_fn) { | 37 if (bmp_ptr && bmp_ptr->bmp_error_fn) { |
36 bmp_ptr->_bmp_error_fn(bmp_ptr, err_msg); | 38 bmp_ptr->bmp_error_fn(bmp_ptr, err_msg); |
37 } | 39 } |
38 } | 40 } |
39 bmp_decompress_struct_p _bmp_create_decompress() { | 41 bmp_decompress_struct_p bmp_create_decompress() { |
40 bmp_decompress_struct_p bmp_ptr = FX_Alloc(bmp_decompress_struct, 1); | 42 bmp_decompress_struct_p bmp_ptr = FX_Alloc(bmp_decompress_struct, 1); |
41 if (bmp_ptr == NULL) { | 43 if (bmp_ptr == NULL) { |
42 return NULL; | 44 return NULL; |
43 } | 45 } |
44 FXSYS_memset(bmp_ptr, 0, sizeof(bmp_decompress_struct)); | 46 FXSYS_memset(bmp_ptr, 0, sizeof(bmp_decompress_struct)); |
45 bmp_ptr->decode_status = BMP_D_STATUS_HEADER; | 47 bmp_ptr->decode_status = BMP_D_STATUS_HEADER; |
46 bmp_ptr->bmp_header_ptr = FX_Alloc(BmpFileHeader, 1); | 48 bmp_ptr->bmp_header_ptr = FX_Alloc(BmpFileHeader, 1); |
47 return bmp_ptr; | 49 return bmp_ptr; |
48 } | 50 } |
49 void _bmp_destroy_decompress(bmp_decompress_struct_pp bmp_ptr_ptr) { | 51 void bmp_destroy_decompress(bmp_decompress_struct_pp bmp_ptr_ptr) { |
50 if (bmp_ptr_ptr == NULL || *bmp_ptr_ptr == NULL) { | 52 if (bmp_ptr_ptr == NULL || *bmp_ptr_ptr == NULL) { |
51 return; | 53 return; |
52 } | 54 } |
53 bmp_decompress_struct_p bmp_ptr = *bmp_ptr_ptr; | 55 bmp_decompress_struct_p bmp_ptr = *bmp_ptr_ptr; |
54 *bmp_ptr_ptr = NULL; | 56 *bmp_ptr_ptr = NULL; |
55 if (bmp_ptr->out_row_buffer) { | 57 if (bmp_ptr->out_row_buffer) { |
56 FX_Free(bmp_ptr->out_row_buffer); | 58 FX_Free(bmp_ptr->out_row_buffer); |
57 } | 59 } |
58 FX_Free(bmp_ptr->pal_ptr); | 60 FX_Free(bmp_ptr->pal_ptr); |
59 FX_Free(bmp_ptr->bmp_header_ptr); | 61 FX_Free(bmp_ptr->bmp_header_ptr); |
60 FX_Free(bmp_ptr); | 62 FX_Free(bmp_ptr); |
61 } | 63 } |
62 int32_t _bmp_read_header(bmp_decompress_struct_p bmp_ptr) { | 64 int32_t bmp_read_header(bmp_decompress_struct_p bmp_ptr) { |
63 if (bmp_ptr == NULL) { | 65 if (bmp_ptr == NULL) { |
64 return 0; | 66 return 0; |
65 } | 67 } |
66 FX_DWORD skip_size_org = bmp_ptr->skip_size; | 68 FX_DWORD skip_size_org = bmp_ptr->skip_size; |
67 if (bmp_ptr->decode_status == BMP_D_STATUS_HEADER) { | 69 if (bmp_ptr->decode_status == BMP_D_STATUS_HEADER) { |
68 ASSERT(sizeof(BmpFileHeader) == 14); | 70 ASSERT(sizeof(BmpFileHeader) == 14); |
69 BmpFileHeader* bmp_header_ptr = NULL; | 71 BmpFileHeader* bmp_header_ptr = NULL; |
70 if (_bmp_read_data(bmp_ptr, (uint8_t**)&bmp_header_ptr, 14) == NULL) { | 72 if (bmp_read_data(bmp_ptr, (uint8_t**)&bmp_header_ptr, 14) == NULL) { |
71 return 2; | 73 return 2; |
72 } | 74 } |
73 bmp_ptr->bmp_header_ptr->bfType = | 75 bmp_ptr->bmp_header_ptr->bfType = |
74 _GetWord_LSBFirst((uint8_t*)&bmp_header_ptr->bfType); | 76 GetWord_LSBFirst((uint8_t*)&bmp_header_ptr->bfType); |
75 bmp_ptr->bmp_header_ptr->bfOffBits = | 77 bmp_ptr->bmp_header_ptr->bfOffBits = |
76 _GetDWord_LSBFirst((uint8_t*)&bmp_header_ptr->bfOffBits); | 78 GetDWord_LSBFirst((uint8_t*)&bmp_header_ptr->bfOffBits); |
77 bmp_ptr->data_size = _GetDWord_LSBFirst((uint8_t*)&bmp_header_ptr->bfSize); | 79 bmp_ptr->data_size = GetDWord_LSBFirst((uint8_t*)&bmp_header_ptr->bfSize); |
78 if (bmp_ptr->bmp_header_ptr->bfType != BMP_SIGNATURE) { | 80 if (bmp_ptr->bmp_header_ptr->bfType != BMP_SIGNATURE) { |
79 _bmp_error(bmp_ptr, "Not A Bmp Image"); | 81 bmp_error(bmp_ptr, "Not A Bmp Image"); |
80 return 0; | 82 return 0; |
81 } | 83 } |
82 if (bmp_ptr->avail_in < sizeof(FX_DWORD)) { | 84 if (bmp_ptr->avail_in < sizeof(FX_DWORD)) { |
83 bmp_ptr->skip_size = skip_size_org; | 85 bmp_ptr->skip_size = skip_size_org; |
84 return 2; | 86 return 2; |
85 } | 87 } |
86 bmp_ptr->img_ifh_size = | 88 bmp_ptr->img_ifh_size = |
87 _GetDWord_LSBFirst(bmp_ptr->next_in + bmp_ptr->skip_size); | 89 GetDWord_LSBFirst(bmp_ptr->next_in + bmp_ptr->skip_size); |
88 bmp_ptr->pal_type = 0; | 90 bmp_ptr->pal_type = 0; |
89 static_assert(sizeof(BmpCoreHeader) == kBmpCoreHeaderSize, | 91 static_assert(sizeof(BmpCoreHeader) == kBmpCoreHeaderSize, |
90 "BmpCoreHeader has wrong size"); | 92 "BmpCoreHeader has wrong size"); |
91 static_assert(sizeof(BmpInfoHeader) == kBmpInfoHeaderSize, | 93 static_assert(sizeof(BmpInfoHeader) == kBmpInfoHeaderSize, |
92 "BmpInfoHeader has wrong size"); | 94 "BmpInfoHeader has wrong size"); |
93 switch (bmp_ptr->img_ifh_size) { | 95 switch (bmp_ptr->img_ifh_size) { |
94 case kBmpCoreHeaderSize: { | 96 case kBmpCoreHeaderSize: { |
95 bmp_ptr->pal_type = 1; | 97 bmp_ptr->pal_type = 1; |
96 BmpCoreHeaderPtr bmp_core_header_ptr = NULL; | 98 BmpCoreHeaderPtr bmp_core_header_ptr = NULL; |
97 if (_bmp_read_data(bmp_ptr, (uint8_t**)&bmp_core_header_ptr, | 99 if (bmp_read_data(bmp_ptr, (uint8_t**)&bmp_core_header_ptr, |
98 bmp_ptr->img_ifh_size) == NULL) { | 100 bmp_ptr->img_ifh_size) == NULL) { |
99 bmp_ptr->skip_size = skip_size_org; | 101 bmp_ptr->skip_size = skip_size_org; |
100 return 2; | 102 return 2; |
101 } | 103 } |
102 bmp_ptr->width = (FX_DWORD)_GetWord_LSBFirst( | 104 bmp_ptr->width = |
103 (uint8_t*)&bmp_core_header_ptr->bcWidth); | 105 GetWord_LSBFirst((uint8_t*)&bmp_core_header_ptr->bcWidth); |
104 bmp_ptr->height = (FX_DWORD)_GetWord_LSBFirst( | 106 bmp_ptr->height = |
105 (uint8_t*)&bmp_core_header_ptr->bcHeight); | 107 GetWord_LSBFirst((uint8_t*)&bmp_core_header_ptr->bcHeight); |
106 bmp_ptr->bitCounts = | 108 bmp_ptr->bitCounts = |
107 _GetWord_LSBFirst((uint8_t*)&bmp_core_header_ptr->bcBitCount); | 109 GetWord_LSBFirst((uint8_t*)&bmp_core_header_ptr->bcBitCount); |
108 bmp_ptr->compress_flag = BMP_RGB; | 110 bmp_ptr->compress_flag = BMP_RGB; |
109 bmp_ptr->imgTB_flag = FALSE; | 111 bmp_ptr->imgTB_flag = FALSE; |
110 } break; | 112 } break; |
111 case kBmpInfoHeaderSize: { | 113 case kBmpInfoHeaderSize: { |
112 BmpInfoHeaderPtr bmp_info_header_ptr = NULL; | 114 BmpInfoHeaderPtr bmp_info_header_ptr = NULL; |
113 if (_bmp_read_data(bmp_ptr, (uint8_t**)&bmp_info_header_ptr, | 115 if (bmp_read_data(bmp_ptr, (uint8_t**)&bmp_info_header_ptr, |
114 bmp_ptr->img_ifh_size) == NULL) { | 116 bmp_ptr->img_ifh_size) == NULL) { |
115 bmp_ptr->skip_size = skip_size_org; | 117 bmp_ptr->skip_size = skip_size_org; |
116 return 2; | 118 return 2; |
117 } | 119 } |
118 bmp_ptr->width = | 120 bmp_ptr->width = |
119 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biWidth); | 121 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biWidth); |
120 bmp_ptr->height = | 122 bmp_ptr->height = |
121 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biHeight); | 123 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biHeight); |
122 bmp_ptr->bitCounts = | 124 bmp_ptr->bitCounts = |
123 _GetWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biBitCount); | 125 GetWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biBitCount); |
124 bmp_ptr->compress_flag = | 126 bmp_ptr->compress_flag = |
125 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biCompression); | 127 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biCompression); |
126 bmp_ptr->color_used = | 128 bmp_ptr->color_used = |
127 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biClrUsed); | 129 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biClrUsed); |
128 bmp_ptr->dpi_x = (int32_t)_GetDWord_LSBFirst( | 130 bmp_ptr->dpi_x = (int32_t)GetDWord_LSBFirst( |
129 (uint8_t*)&bmp_info_header_ptr->biXPelsPerMeter); | 131 (uint8_t*)&bmp_info_header_ptr->biXPelsPerMeter); |
130 bmp_ptr->dpi_y = (int32_t)_GetDWord_LSBFirst( | 132 bmp_ptr->dpi_y = (int32_t)GetDWord_LSBFirst( |
131 (uint8_t*)&bmp_info_header_ptr->biYPelsPerMeter); | 133 (uint8_t*)&bmp_info_header_ptr->biYPelsPerMeter); |
132 if (bmp_ptr->height < 0) { | 134 if (bmp_ptr->height < 0) { |
133 bmp_ptr->height = -bmp_ptr->height; | 135 bmp_ptr->height = -bmp_ptr->height; |
134 bmp_ptr->imgTB_flag = TRUE; | 136 bmp_ptr->imgTB_flag = TRUE; |
135 } | 137 } |
136 } break; | 138 } break; |
137 default: { | 139 default: { |
138 if (bmp_ptr->img_ifh_size > | 140 if (bmp_ptr->img_ifh_size > |
139 std::min(kBmpInfoHeaderSize, sizeof(BmpInfoHeader))) { | 141 std::min(kBmpInfoHeaderSize, sizeof(BmpInfoHeader))) { |
140 BmpInfoHeaderPtr bmp_info_header_ptr = NULL; | 142 BmpInfoHeaderPtr bmp_info_header_ptr = NULL; |
141 if (_bmp_read_data(bmp_ptr, (uint8_t**)&bmp_info_header_ptr, | 143 if (bmp_read_data(bmp_ptr, (uint8_t**)&bmp_info_header_ptr, |
142 bmp_ptr->img_ifh_size) == NULL) { | 144 bmp_ptr->img_ifh_size) == NULL) { |
143 bmp_ptr->skip_size = skip_size_org; | 145 bmp_ptr->skip_size = skip_size_org; |
144 return 2; | 146 return 2; |
145 } | 147 } |
146 FX_WORD biPlanes; | 148 FX_WORD biPlanes; |
147 bmp_ptr->width = | 149 bmp_ptr->width = |
148 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biWidth); | 150 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biWidth); |
149 bmp_ptr->height = | 151 bmp_ptr->height = |
150 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biHeight); | 152 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biHeight); |
151 bmp_ptr->bitCounts = | 153 bmp_ptr->bitCounts = |
152 _GetWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biBitCount); | 154 GetWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biBitCount); |
153 bmp_ptr->compress_flag = | 155 bmp_ptr->compress_flag = |
154 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biCompression); | 156 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biCompression); |
155 bmp_ptr->color_used = | 157 bmp_ptr->color_used = |
156 _GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biClrUsed); | 158 GetDWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biClrUsed); |
157 biPlanes = | 159 biPlanes = GetWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biPlanes); |
158 _GetWord_LSBFirst((uint8_t*)&bmp_info_header_ptr->biPlanes); | 160 bmp_ptr->dpi_x = GetDWord_LSBFirst( |
159 bmp_ptr->dpi_x = _GetDWord_LSBFirst( | |
160 (uint8_t*)&bmp_info_header_ptr->biXPelsPerMeter); | 161 (uint8_t*)&bmp_info_header_ptr->biXPelsPerMeter); |
161 bmp_ptr->dpi_y = _GetDWord_LSBFirst( | 162 bmp_ptr->dpi_y = GetDWord_LSBFirst( |
162 (uint8_t*)&bmp_info_header_ptr->biYPelsPerMeter); | 163 (uint8_t*)&bmp_info_header_ptr->biYPelsPerMeter); |
163 if (bmp_ptr->height < 0) { | 164 if (bmp_ptr->height < 0) { |
164 bmp_ptr->height = -bmp_ptr->height; | 165 bmp_ptr->height = -bmp_ptr->height; |
165 bmp_ptr->imgTB_flag = TRUE; | 166 bmp_ptr->imgTB_flag = TRUE; |
166 } | 167 } |
167 if (bmp_ptr->compress_flag == BMP_RGB && biPlanes == 1 && | 168 if (bmp_ptr->compress_flag == BMP_RGB && biPlanes == 1 && |
168 bmp_ptr->color_used == 0) { | 169 bmp_ptr->color_used == 0) { |
169 break; | 170 break; |
170 } | 171 } |
171 } | 172 } |
172 _bmp_error(bmp_ptr, "Unsupported Bmp File"); | 173 bmp_error(bmp_ptr, "Unsupported Bmp File"); |
173 return 0; | 174 return 0; |
174 } | 175 } |
175 } | 176 } |
176 ASSERT(bmp_ptr->width > 0); | 177 ASSERT(bmp_ptr->width > 0); |
177 ASSERT(bmp_ptr->compress_flag <= BMP_BITFIELDS); | 178 ASSERT(bmp_ptr->compress_flag <= BMP_BITFIELDS); |
178 switch (bmp_ptr->bitCounts) { | 179 switch (bmp_ptr->bitCounts) { |
179 case 1: | 180 case 1: |
180 case 4: | 181 case 4: |
181 case 8: | 182 case 8: |
182 case 16: | 183 case 16: |
183 case 24: { | 184 case 24: { |
184 if (bmp_ptr->color_used > ((FX_DWORD)1) << bmp_ptr->bitCounts) { | 185 if (bmp_ptr->color_used > ((FX_DWORD)1) << bmp_ptr->bitCounts) { |
185 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 186 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
186 return 0; | 187 return 0; |
187 } | 188 } |
188 } | 189 } |
189 case 32: { | 190 case 32: { |
190 if (bmp_ptr->width <= 0 || bmp_ptr->compress_flag > BMP_BITFIELDS) { | 191 if (bmp_ptr->width <= 0 || bmp_ptr->compress_flag > BMP_BITFIELDS) { |
191 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 192 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
192 return 0; | 193 return 0; |
193 } | 194 } |
194 } break; | 195 } break; |
195 default: | 196 default: |
196 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 197 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
197 return 0; | 198 return 0; |
198 } | 199 } |
199 bmp_ptr->src_row_bytes = BMP_WIDTHBYTES(bmp_ptr->width, bmp_ptr->bitCounts); | 200 bmp_ptr->src_row_bytes = BMP_WIDTHBYTES(bmp_ptr->width, bmp_ptr->bitCounts); |
200 switch (bmp_ptr->bitCounts) { | 201 switch (bmp_ptr->bitCounts) { |
201 case 1: | 202 case 1: |
202 case 4: | 203 case 4: |
203 case 8: | 204 case 8: |
204 bmp_ptr->out_row_bytes = BMP_WIDTHBYTES(bmp_ptr->width, 8); | 205 bmp_ptr->out_row_bytes = BMP_WIDTHBYTES(bmp_ptr->width, 8); |
205 bmp_ptr->components = 1; | 206 bmp_ptr->components = 1; |
206 break; | 207 break; |
207 case 16: | 208 case 16: |
208 case 24: | 209 case 24: |
209 bmp_ptr->out_row_bytes = BMP_WIDTHBYTES(bmp_ptr->width, 24); | 210 bmp_ptr->out_row_bytes = BMP_WIDTHBYTES(bmp_ptr->width, 24); |
210 bmp_ptr->components = 3; | 211 bmp_ptr->components = 3; |
211 break; | 212 break; |
212 case 32: | 213 case 32: |
213 bmp_ptr->out_row_bytes = bmp_ptr->src_row_bytes; | 214 bmp_ptr->out_row_bytes = bmp_ptr->src_row_bytes; |
214 bmp_ptr->components = 4; | 215 bmp_ptr->components = 4; |
215 break; | 216 break; |
216 } | 217 } |
217 FX_Free(bmp_ptr->out_row_buffer); | 218 FX_Free(bmp_ptr->out_row_buffer); |
218 bmp_ptr->out_row_buffer = FX_Alloc(uint8_t, bmp_ptr->out_row_bytes); | 219 bmp_ptr->out_row_buffer = FX_Alloc(uint8_t, bmp_ptr->out_row_bytes); |
219 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 220 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
220 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_PAL); | 221 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_PAL); |
221 } | 222 } |
222 if (bmp_ptr->decode_status == BMP_D_STATUS_PAL) { | 223 if (bmp_ptr->decode_status == BMP_D_STATUS_PAL) { |
223 skip_size_org = bmp_ptr->skip_size; | 224 skip_size_org = bmp_ptr->skip_size; |
224 #ifdef BMP_SUPPORT_BITFIELD | |
225 if (bmp_ptr->compress_flag == BMP_BITFIELDS) { | 225 if (bmp_ptr->compress_flag == BMP_BITFIELDS) { |
226 if (bmp_ptr->bitCounts != 16 && bmp_ptr->bitCounts != 32) { | 226 if (bmp_ptr->bitCounts != 16 && bmp_ptr->bitCounts != 32) { |
227 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 227 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
228 return 0; | 228 return 0; |
229 } | 229 } |
230 FX_DWORD* mask; | 230 FX_DWORD* mask; |
231 if (_bmp_read_data(bmp_ptr, (uint8_t**)&mask, 3 * sizeof(FX_DWORD)) == | 231 if (bmp_read_data(bmp_ptr, (uint8_t**)&mask, 3 * sizeof(FX_DWORD)) == |
232 NULL) { | 232 NULL) { |
233 bmp_ptr->skip_size = skip_size_org; | 233 bmp_ptr->skip_size = skip_size_org; |
234 return 2; | 234 return 2; |
235 } | 235 } |
236 bmp_ptr->mask_red = _GetDWord_LSBFirst((uint8_t*)&mask[0]); | 236 bmp_ptr->mask_red = GetDWord_LSBFirst((uint8_t*)&mask[0]); |
237 bmp_ptr->mask_green = _GetDWord_LSBFirst((uint8_t*)&mask[1]); | 237 bmp_ptr->mask_green = GetDWord_LSBFirst((uint8_t*)&mask[1]); |
238 bmp_ptr->mask_blue = _GetDWord_LSBFirst((uint8_t*)&mask[2]); | 238 bmp_ptr->mask_blue = GetDWord_LSBFirst((uint8_t*)&mask[2]); |
239 if (bmp_ptr->mask_red & bmp_ptr->mask_green || | 239 if (bmp_ptr->mask_red & bmp_ptr->mask_green || |
240 bmp_ptr->mask_red & bmp_ptr->mask_blue || | 240 bmp_ptr->mask_red & bmp_ptr->mask_blue || |
241 bmp_ptr->mask_green & bmp_ptr->mask_blue) { | 241 bmp_ptr->mask_green & bmp_ptr->mask_blue) { |
242 _bmp_error(bmp_ptr, "The Bitfield Bmp File Is Corrupt"); | 242 bmp_error(bmp_ptr, "The Bitfield Bmp File Is Corrupt"); |
243 return 0; | 243 return 0; |
244 } | 244 } |
245 if (bmp_ptr->bmp_header_ptr->bfOffBits < 26 + bmp_ptr->img_ifh_size) { | 245 if (bmp_ptr->bmp_header_ptr->bfOffBits < 26 + bmp_ptr->img_ifh_size) { |
246 bmp_ptr->bmp_header_ptr->bfOffBits = 26 + bmp_ptr->img_ifh_size; | 246 bmp_ptr->bmp_header_ptr->bfOffBits = 26 + bmp_ptr->img_ifh_size; |
247 } | 247 } |
248 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); | 248 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); |
249 return 1; | 249 return 1; |
250 } else if (bmp_ptr->bitCounts == 16) { | 250 } else if (bmp_ptr->bitCounts == 16) { |
251 bmp_ptr->mask_red = 0x7C00; | 251 bmp_ptr->mask_red = 0x7C00; |
252 bmp_ptr->mask_green = 0x03E0; | 252 bmp_ptr->mask_green = 0x03E0; |
253 bmp_ptr->mask_blue = 0x001F; | 253 bmp_ptr->mask_blue = 0x001F; |
254 } | 254 } |
255 #else | |
256 if (bmp_ptr->compress_flag == BMP_BITFIELDS || bmp_ptr->bitCounts == 16) { | |
257 _bmp_error(bmp_ptr, "Unsupported Bitfield Bmp File"); | |
258 return 0; | |
259 } | |
260 #endif | |
261 bmp_ptr->pal_num = 0; | 255 bmp_ptr->pal_num = 0; |
262 if (bmp_ptr->bitCounts < 16) { | 256 if (bmp_ptr->bitCounts < 16) { |
263 bmp_ptr->pal_num = 1 << bmp_ptr->bitCounts; | 257 bmp_ptr->pal_num = 1 << bmp_ptr->bitCounts; |
264 if (bmp_ptr->color_used != 0) { | 258 if (bmp_ptr->color_used != 0) { |
265 bmp_ptr->pal_num = bmp_ptr->color_used; | 259 bmp_ptr->pal_num = bmp_ptr->color_used; |
266 } | 260 } |
267 uint8_t* src_pal_ptr = NULL; | 261 uint8_t* src_pal_ptr = NULL; |
268 FX_DWORD src_pal_size = bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4); | 262 FX_DWORD src_pal_size = bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4); |
269 if (_bmp_read_data(bmp_ptr, (uint8_t**)&src_pal_ptr, src_pal_size) == | 263 if (bmp_read_data(bmp_ptr, (uint8_t**)&src_pal_ptr, src_pal_size) == |
270 NULL) { | 264 NULL) { |
271 bmp_ptr->skip_size = skip_size_org; | 265 bmp_ptr->skip_size = skip_size_org; |
272 return 2; | 266 return 2; |
273 } | 267 } |
274 FX_Free(bmp_ptr->pal_ptr); | 268 FX_Free(bmp_ptr->pal_ptr); |
275 bmp_ptr->pal_ptr = FX_Alloc(FX_DWORD, bmp_ptr->pal_num); | 269 bmp_ptr->pal_ptr = FX_Alloc(FX_DWORD, bmp_ptr->pal_num); |
276 int32_t src_pal_index = 0; | 270 int32_t src_pal_index = 0; |
277 if (bmp_ptr->pal_type == BMP_PAL_OLD) { | 271 if (bmp_ptr->pal_type == BMP_PAL_OLD) { |
278 while (src_pal_index < bmp_ptr->pal_num) { | 272 while (src_pal_index < bmp_ptr->pal_num) { |
279 bmp_ptr->pal_ptr[src_pal_index++] = BMP_PAL_ENCODE( | 273 bmp_ptr->pal_ptr[src_pal_index++] = BMP_PAL_ENCODE( |
280 0x00, src_pal_ptr[2], src_pal_ptr[1], src_pal_ptr[0]); | 274 0x00, src_pal_ptr[2], src_pal_ptr[1], src_pal_ptr[0]); |
281 src_pal_ptr += 3; | 275 src_pal_ptr += 3; |
282 } | 276 } |
283 } else { | 277 } else { |
284 while (src_pal_index < bmp_ptr->pal_num) { | 278 while (src_pal_index < bmp_ptr->pal_num) { |
285 bmp_ptr->pal_ptr[src_pal_index++] = BMP_PAL_ENCODE( | 279 bmp_ptr->pal_ptr[src_pal_index++] = BMP_PAL_ENCODE( |
286 src_pal_ptr[3], src_pal_ptr[2], src_pal_ptr[1], src_pal_ptr[0]); | 280 src_pal_ptr[3], src_pal_ptr[2], src_pal_ptr[1], src_pal_ptr[0]); |
287 src_pal_ptr += 4; | 281 src_pal_ptr += 4; |
288 } | 282 } |
289 } | 283 } |
290 } | 284 } |
291 if (bmp_ptr->bmp_header_ptr->bfOffBits < | 285 if (bmp_ptr->bmp_header_ptr->bfOffBits < |
292 14 + bmp_ptr->img_ifh_size + | 286 14 + bmp_ptr->img_ifh_size + |
293 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4)) { | 287 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4)) { |
294 bmp_ptr->bmp_header_ptr->bfOffBits = | 288 bmp_ptr->bmp_header_ptr->bfOffBits = |
295 14 + bmp_ptr->img_ifh_size + | 289 14 + bmp_ptr->img_ifh_size + |
296 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4); | 290 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4); |
297 } | 291 } |
298 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); | 292 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); |
299 } | 293 } |
300 return 1; | 294 return 1; |
301 } | 295 } |
302 int32_t _bmp_decode_image(bmp_decompress_struct_p bmp_ptr) { | 296 int32_t bmp_decode_image(bmp_decompress_struct_p bmp_ptr) { |
303 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA_PRE) { | 297 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA_PRE) { |
304 bmp_ptr->avail_in = 0; | 298 bmp_ptr->avail_in = 0; |
305 if (!bmp_ptr->_bmp_get_data_position_fn( | 299 if (!bmp_ptr->bmp_get_data_position_fn( |
306 bmp_ptr, bmp_ptr->bmp_header_ptr->bfOffBits)) { | 300 bmp_ptr, bmp_ptr->bmp_header_ptr->bfOffBits)) { |
307 bmp_ptr->decode_status = BMP_D_STATUS_TAIL; | 301 bmp_ptr->decode_status = BMP_D_STATUS_TAIL; |
308 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt, Unexpected Stream Offset"); | 302 bmp_error(bmp_ptr, "The Bmp File Is Corrupt, Unexpected Stream Offset"); |
309 return 0; | 303 return 0; |
310 } | 304 } |
311 bmp_ptr->row_num = 0; | 305 bmp_ptr->row_num = 0; |
312 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 306 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
313 } | 307 } |
314 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA) { | 308 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA) { |
315 switch (bmp_ptr->compress_flag) { | 309 switch (bmp_ptr->compress_flag) { |
316 case BMP_RGB: | 310 case BMP_RGB: |
317 case BMP_BITFIELDS: | 311 case BMP_BITFIELDS: |
318 return _bmp_decode_rgb(bmp_ptr); | 312 return bmp_decode_rgb(bmp_ptr); |
319 case BMP_RLE8: | 313 case BMP_RLE8: |
320 return _bmp_decode_rle8(bmp_ptr); | 314 return bmp_decode_rle8(bmp_ptr); |
321 case BMP_RLE4: | 315 case BMP_RLE4: |
322 return _bmp_decode_rle4(bmp_ptr); | 316 return bmp_decode_rle4(bmp_ptr); |
323 } | 317 } |
324 } | 318 } |
325 _bmp_error(bmp_ptr, "Any Uncontrol Error"); | 319 bmp_error(bmp_ptr, "Any Uncontrol Error"); |
326 return 0; | 320 return 0; |
327 } | 321 } |
328 int32_t _bmp_decode_rgb(bmp_decompress_struct_p bmp_ptr) { | 322 int32_t bmp_decode_rgb(bmp_decompress_struct_p bmp_ptr) { |
329 uint8_t* row_buf = bmp_ptr->out_row_buffer; | 323 uint8_t* row_buf = bmp_ptr->out_row_buffer; |
330 uint8_t* des_buf = NULL; | 324 uint8_t* des_buf = NULL; |
331 while (bmp_ptr->row_num < bmp_ptr->height) { | 325 while (bmp_ptr->row_num < bmp_ptr->height) { |
332 if (_bmp_read_data(bmp_ptr, &des_buf, bmp_ptr->src_row_bytes) == NULL) { | 326 if (bmp_read_data(bmp_ptr, &des_buf, bmp_ptr->src_row_bytes) == NULL) { |
333 return 2; | 327 return 2; |
334 } | 328 } |
335 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 329 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
336 switch (bmp_ptr->bitCounts) { | 330 switch (bmp_ptr->bitCounts) { |
337 case 1: { | 331 case 1: { |
338 for (int32_t col = 0; col < bmp_ptr->width; col++) { | 332 for (int32_t col = 0; col < bmp_ptr->width; col++) { |
339 *row_buf++ = des_buf[col >> 3] & (0x80 >> (col % 8)) ? 0x01 : 0x00; | 333 *row_buf++ = des_buf[col >> 3] & (0x80 >> (col % 8)) ? 0x01 : 0x00; |
340 } | 334 } |
341 } break; | 335 } break; |
342 case 4: { | 336 case 4: { |
343 for (int32_t col = 0; col < bmp_ptr->width; col++) { | 337 for (int32_t col = 0; col < bmp_ptr->width; col++) { |
344 *row_buf++ = (col & 0x01) ? (des_buf[col >> 1] & 0x0F) | 338 *row_buf++ = (col & 0x01) ? (des_buf[col >> 1] & 0x0F) |
345 : ((des_buf[col >> 1] & 0xF0) >> 4); | 339 : ((des_buf[col >> 1] & 0xF0) >> 4); |
346 } | 340 } |
347 } break; | 341 } break; |
348 #ifdef BMP_SUPPORT_BITFIELD | |
349 case 16: { | 342 case 16: { |
350 FX_WORD* buf = (FX_WORD*)des_buf; | 343 FX_WORD* buf = (FX_WORD*)des_buf; |
351 uint8_t blue_bits = 0; | 344 uint8_t blue_bits = 0; |
352 uint8_t green_bits = 0; | 345 uint8_t green_bits = 0; |
353 uint8_t red_bits = 0; | 346 uint8_t red_bits = 0; |
354 for (int32_t i = 0; i < 16; i++) { | 347 for (int32_t i = 0; i < 16; i++) { |
355 if ((bmp_ptr->mask_blue >> i) & 0x01) { | 348 if ((bmp_ptr->mask_blue >> i) & 0x01) { |
356 blue_bits++; | 349 blue_bits++; |
357 } | 350 } |
358 if ((bmp_ptr->mask_green >> i) & 0x01) { | 351 if ((bmp_ptr->mask_green >> i) & 0x01) { |
359 green_bits++; | 352 green_bits++; |
360 } | 353 } |
361 if ((bmp_ptr->mask_red >> i) & 0x01) { | 354 if ((bmp_ptr->mask_red >> i) & 0x01) { |
362 red_bits++; | 355 red_bits++; |
363 } | 356 } |
364 } | 357 } |
365 green_bits += blue_bits; | 358 green_bits += blue_bits; |
366 red_bits += green_bits; | 359 red_bits += green_bits; |
367 blue_bits = 8 - blue_bits; | 360 blue_bits = 8 - blue_bits; |
368 green_bits -= 8; | 361 green_bits -= 8; |
369 red_bits -= 8; | 362 red_bits -= 8; |
370 for (int32_t col = 0; col < bmp_ptr->width; col++) { | 363 for (int32_t col = 0; col < bmp_ptr->width; col++) { |
371 *buf = _GetWord_LSBFirst((uint8_t*)buf); | 364 *buf = GetWord_LSBFirst((uint8_t*)buf); |
372 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_blue) << blue_bits); | 365 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_blue) << blue_bits); |
373 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_green) >> green_bits); | 366 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_green) >> green_bits); |
374 *row_buf++ = (uint8_t)((*buf++ & bmp_ptr->mask_red) >> red_bits); | 367 *row_buf++ = (uint8_t)((*buf++ & bmp_ptr->mask_red) >> red_bits); |
375 } | 368 } |
376 } break; | 369 } break; |
377 #endif | |
378 case 8: | 370 case 8: |
379 case 24: | 371 case 24: |
380 case 32: | 372 case 32: |
381 FXSYS_memcpy(bmp_ptr->out_row_buffer, des_buf, bmp_ptr->src_row_bytes); | 373 FXSYS_memcpy(bmp_ptr->out_row_buffer, des_buf, bmp_ptr->src_row_bytes); |
382 break; | 374 break; |
383 } | 375 } |
384 row_buf = bmp_ptr->out_row_buffer; | 376 row_buf = bmp_ptr->out_row_buffer; |
385 bmp_ptr->_bmp_get_row_fn(bmp_ptr, | 377 bmp_ptr->bmp_get_row_fn(bmp_ptr, |
386 bmp_ptr->imgTB_flag | 378 bmp_ptr->imgTB_flag |
387 ? bmp_ptr->row_num++ | 379 ? bmp_ptr->row_num++ |
388 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 380 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
389 bmp_ptr->out_row_buffer); | 381 bmp_ptr->out_row_buffer); |
390 } | 382 } |
391 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 383 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
392 return 1; | 384 return 1; |
393 } | 385 } |
394 int32_t _bmp_decode_rle8(bmp_decompress_struct_p bmp_ptr) { | 386 int32_t bmp_decode_rle8(bmp_decompress_struct_p bmp_ptr) { |
395 uint8_t* first_byte_ptr = NULL; | 387 uint8_t* first_byte_ptr = NULL; |
396 uint8_t* second_byte_ptr = NULL; | 388 uint8_t* second_byte_ptr = NULL; |
397 bmp_ptr->col_num = 0; | 389 bmp_ptr->col_num = 0; |
398 while (TRUE) { | 390 while (TRUE) { |
399 FX_DWORD skip_size_org = bmp_ptr->skip_size; | 391 FX_DWORD skip_size_org = bmp_ptr->skip_size; |
400 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 392 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
401 return 2; | 393 return 2; |
402 } | 394 } |
403 switch (*first_byte_ptr) { | 395 switch (*first_byte_ptr) { |
404 case RLE_MARKER: { | 396 case RLE_MARKER: { |
405 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 397 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
406 bmp_ptr->skip_size = skip_size_org; | 398 bmp_ptr->skip_size = skip_size_org; |
407 return 2; | 399 return 2; |
408 } | 400 } |
409 switch (*first_byte_ptr) { | 401 switch (*first_byte_ptr) { |
410 case RLE_EOL: { | 402 case RLE_EOL: { |
411 if (bmp_ptr->row_num >= bmp_ptr->height) { | 403 if (bmp_ptr->row_num >= bmp_ptr->height) { |
412 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 404 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
413 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 405 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
414 return 0; | 406 return 0; |
415 } | 407 } |
416 bmp_ptr->_bmp_get_row_fn( | 408 bmp_ptr->bmp_get_row_fn( |
417 bmp_ptr, bmp_ptr->imgTB_flag | 409 bmp_ptr, bmp_ptr->imgTB_flag |
418 ? bmp_ptr->row_num++ | 410 ? bmp_ptr->row_num++ |
419 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 411 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
420 bmp_ptr->out_row_buffer); | 412 bmp_ptr->out_row_buffer); |
421 bmp_ptr->col_num = 0; | 413 bmp_ptr->col_num = 0; |
422 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 414 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
423 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 415 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
424 continue; | 416 continue; |
425 } | 417 } |
426 case RLE_EOI: { | 418 case RLE_EOI: { |
427 if (bmp_ptr->row_num < bmp_ptr->height) { | 419 if (bmp_ptr->row_num < bmp_ptr->height) { |
428 bmp_ptr->_bmp_get_row_fn( | 420 bmp_ptr->bmp_get_row_fn( |
429 bmp_ptr, bmp_ptr->imgTB_flag | 421 bmp_ptr, bmp_ptr->imgTB_flag |
430 ? bmp_ptr->row_num++ | 422 ? bmp_ptr->row_num++ |
431 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 423 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
432 bmp_ptr->out_row_buffer); | 424 bmp_ptr->out_row_buffer); |
433 } | 425 } |
434 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 426 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
435 return 1; | 427 return 1; |
436 } | 428 } |
437 case RLE_DELTA: { | 429 case RLE_DELTA: { |
438 uint8_t* delta_ptr; | 430 uint8_t* delta_ptr; |
439 if (_bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { | 431 if (bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { |
440 bmp_ptr->skip_size = skip_size_org; | 432 bmp_ptr->skip_size = skip_size_org; |
441 return 2; | 433 return 2; |
442 } | 434 } |
443 bmp_ptr->col_num += (int32_t)delta_ptr[0]; | 435 bmp_ptr->col_num += (int32_t)delta_ptr[0]; |
444 int32_t bmp_row_num_next = bmp_ptr->row_num + (int32_t)delta_ptr[1]; | 436 int32_t bmp_row_num_next = bmp_ptr->row_num + (int32_t)delta_ptr[1]; |
445 if (bmp_ptr->col_num >= bmp_ptr->out_row_bytes || | 437 if (bmp_ptr->col_num >= bmp_ptr->out_row_bytes || |
446 bmp_row_num_next >= bmp_ptr->height) { | 438 bmp_row_num_next >= bmp_ptr->height) { |
447 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); | 439 bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); |
448 return 0; | 440 return 0; |
449 } | 441 } |
450 while (bmp_ptr->row_num < bmp_row_num_next) { | 442 while (bmp_ptr->row_num < bmp_row_num_next) { |
451 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 443 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
452 bmp_ptr->_bmp_get_row_fn( | 444 bmp_ptr->bmp_get_row_fn( |
453 bmp_ptr, bmp_ptr->imgTB_flag | 445 bmp_ptr, bmp_ptr->imgTB_flag |
454 ? bmp_ptr->row_num++ | 446 ? bmp_ptr->row_num++ |
455 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 447 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
456 bmp_ptr->out_row_buffer); | 448 bmp_ptr->out_row_buffer); |
457 } | 449 } |
458 } break; | 450 } break; |
459 default: { | 451 default: { |
460 if ((int32_t)(*first_byte_ptr) > | 452 if ((int32_t)(*first_byte_ptr) > |
461 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { | 453 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { |
462 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 454 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
463 return 0; | 455 return 0; |
464 } | 456 } |
465 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, | 457 if (bmp_read_data(bmp_ptr, &second_byte_ptr, |
466 *first_byte_ptr & 1 ? *first_byte_ptr + 1 | 458 *first_byte_ptr & 1 ? *first_byte_ptr + 1 |
467 : *first_byte_ptr) == NULL) { | 459 : *first_byte_ptr) == NULL) { |
468 bmp_ptr->skip_size = skip_size_org; | 460 bmp_ptr->skip_size = skip_size_org; |
469 return 2; | 461 return 2; |
470 } | 462 } |
471 FXSYS_memcpy(bmp_ptr->out_row_buffer + bmp_ptr->col_num, | 463 FXSYS_memcpy(bmp_ptr->out_row_buffer + bmp_ptr->col_num, |
472 second_byte_ptr, *first_byte_ptr); | 464 second_byte_ptr, *first_byte_ptr); |
473 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); | 465 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); |
474 } | 466 } |
475 } | 467 } |
476 } break; | 468 } break; |
477 default: { | 469 default: { |
478 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { | 470 if (bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { |
479 bmp_ptr->skip_size = skip_size_org; | 471 bmp_ptr->skip_size = skip_size_org; |
480 return 2; | 472 return 2; |
481 } | 473 } |
482 if ((int32_t)(*first_byte_ptr) > | 474 if ((int32_t)(*first_byte_ptr) > |
483 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { | 475 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { |
484 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 476 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
485 return 0; | 477 return 0; |
486 } | 478 } |
487 FXSYS_memset(bmp_ptr->out_row_buffer + bmp_ptr->col_num, | 479 FXSYS_memset(bmp_ptr->out_row_buffer + bmp_ptr->col_num, |
488 *second_byte_ptr, *first_byte_ptr); | 480 *second_byte_ptr, *first_byte_ptr); |
489 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); | 481 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); |
490 } | 482 } |
491 } | 483 } |
492 } | 484 } |
493 _bmp_error(bmp_ptr, "Any Uncontrol Error"); | 485 bmp_error(bmp_ptr, "Any Uncontrol Error"); |
494 return 0; | 486 return 0; |
495 } | 487 } |
496 int32_t _bmp_decode_rle4(bmp_decompress_struct_p bmp_ptr) { | 488 int32_t bmp_decode_rle4(bmp_decompress_struct_p bmp_ptr) { |
497 uint8_t* first_byte_ptr = NULL; | 489 uint8_t* first_byte_ptr = NULL; |
498 uint8_t* second_byte_ptr = NULL; | 490 uint8_t* second_byte_ptr = NULL; |
499 bmp_ptr->col_num = 0; | 491 bmp_ptr->col_num = 0; |
500 while (TRUE) { | 492 while (TRUE) { |
501 FX_DWORD skip_size_org = bmp_ptr->skip_size; | 493 FX_DWORD skip_size_org = bmp_ptr->skip_size; |
502 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 494 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
503 return 2; | 495 return 2; |
504 } | 496 } |
505 switch (*first_byte_ptr) { | 497 switch (*first_byte_ptr) { |
506 case RLE_MARKER: { | 498 case RLE_MARKER: { |
507 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 499 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
508 bmp_ptr->skip_size = skip_size_org; | 500 bmp_ptr->skip_size = skip_size_org; |
509 return 2; | 501 return 2; |
510 } | 502 } |
511 switch (*first_byte_ptr) { | 503 switch (*first_byte_ptr) { |
512 case RLE_EOL: { | 504 case RLE_EOL: { |
513 if (bmp_ptr->row_num >= bmp_ptr->height) { | 505 if (bmp_ptr->row_num >= bmp_ptr->height) { |
514 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 506 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
515 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 507 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
516 return 0; | 508 return 0; |
517 } | 509 } |
518 bmp_ptr->_bmp_get_row_fn( | 510 bmp_ptr->bmp_get_row_fn( |
519 bmp_ptr, bmp_ptr->imgTB_flag | 511 bmp_ptr, bmp_ptr->imgTB_flag |
520 ? bmp_ptr->row_num++ | 512 ? bmp_ptr->row_num++ |
521 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 513 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
522 bmp_ptr->out_row_buffer); | 514 bmp_ptr->out_row_buffer); |
523 bmp_ptr->col_num = 0; | 515 bmp_ptr->col_num = 0; |
524 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 516 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
525 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 517 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
526 continue; | 518 continue; |
527 } | 519 } |
528 case RLE_EOI: { | 520 case RLE_EOI: { |
529 if (bmp_ptr->row_num < bmp_ptr->height) { | 521 if (bmp_ptr->row_num < bmp_ptr->height) { |
530 bmp_ptr->_bmp_get_row_fn( | 522 bmp_ptr->bmp_get_row_fn( |
531 bmp_ptr, bmp_ptr->imgTB_flag | 523 bmp_ptr, bmp_ptr->imgTB_flag |
532 ? bmp_ptr->row_num++ | 524 ? bmp_ptr->row_num++ |
533 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 525 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
534 bmp_ptr->out_row_buffer); | 526 bmp_ptr->out_row_buffer); |
535 } | 527 } |
536 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 528 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
537 return 1; | 529 return 1; |
538 } | 530 } |
539 case RLE_DELTA: { | 531 case RLE_DELTA: { |
540 uint8_t* delta_ptr; | 532 uint8_t* delta_ptr; |
541 if (_bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { | 533 if (bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { |
542 bmp_ptr->skip_size = skip_size_org; | 534 bmp_ptr->skip_size = skip_size_org; |
543 return 2; | 535 return 2; |
544 } | 536 } |
545 bmp_ptr->col_num += (int32_t)delta_ptr[0]; | 537 bmp_ptr->col_num += (int32_t)delta_ptr[0]; |
546 int32_t bmp_row_num_next = bmp_ptr->row_num + (int32_t)delta_ptr[1]; | 538 int32_t bmp_row_num_next = bmp_ptr->row_num + (int32_t)delta_ptr[1]; |
547 if (bmp_ptr->col_num >= bmp_ptr->out_row_bytes || | 539 if (bmp_ptr->col_num >= bmp_ptr->out_row_bytes || |
548 bmp_row_num_next >= bmp_ptr->height) { | 540 bmp_row_num_next >= bmp_ptr->height) { |
549 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); | 541 bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); |
550 return 0; | 542 return 0; |
551 } | 543 } |
552 while (bmp_ptr->row_num < bmp_row_num_next) { | 544 while (bmp_ptr->row_num < bmp_row_num_next) { |
553 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 545 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
554 bmp_ptr->_bmp_get_row_fn( | 546 bmp_ptr->bmp_get_row_fn( |
555 bmp_ptr, bmp_ptr->imgTB_flag | 547 bmp_ptr, bmp_ptr->imgTB_flag |
556 ? bmp_ptr->row_num++ | 548 ? bmp_ptr->row_num++ |
557 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 549 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
558 bmp_ptr->out_row_buffer); | 550 bmp_ptr->out_row_buffer); |
559 } | 551 } |
560 } break; | 552 } break; |
561 default: { | 553 default: { |
562 uint8_t size = (uint8_t)(((FX_WORD)(*first_byte_ptr) + 1) >> 1); | 554 uint8_t size = (uint8_t)(((FX_WORD)(*first_byte_ptr) + 1) >> 1); |
563 if ((int32_t)*first_byte_ptr >= | 555 if ((int32_t)*first_byte_ptr >= |
564 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { | 556 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { |
565 if (size + (bmp_ptr->col_num >> 1) > bmp_ptr->src_row_bytes) { | 557 if (size + (bmp_ptr->col_num >> 1) > bmp_ptr->src_row_bytes) { |
566 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 558 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
567 return 0; | 559 return 0; |
568 } | 560 } |
569 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; | 561 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; |
570 } | 562 } |
571 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, | 563 if (bmp_read_data(bmp_ptr, &second_byte_ptr, |
572 size & 1 ? size + 1 : size) == NULL) { | 564 size & 1 ? size + 1 : size) == NULL) { |
573 bmp_ptr->skip_size = skip_size_org; | 565 bmp_ptr->skip_size = skip_size_org; |
574 return 2; | 566 return 2; |
575 } | 567 } |
576 for (uint8_t i = 0; i < *first_byte_ptr; i++) { | 568 for (uint8_t i = 0; i < *first_byte_ptr; i++) { |
577 if (i & 0x01) { | 569 if (i & 0x01) { |
578 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 570 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
579 (*second_byte_ptr++ & 0x0F); | 571 (*second_byte_ptr++ & 0x0F); |
580 } else { | 572 } else { |
581 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 573 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
582 ((*second_byte_ptr & 0xF0) >> 4); | 574 ((*second_byte_ptr & 0xF0) >> 4); |
583 } | 575 } |
584 } | 576 } |
585 } | 577 } |
586 } | 578 } |
587 } break; | 579 } break; |
588 default: { | 580 default: { |
589 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { | 581 if (bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { |
590 bmp_ptr->skip_size = skip_size_org; | 582 bmp_ptr->skip_size = skip_size_org; |
591 return 2; | 583 return 2; |
592 } | 584 } |
593 if ((int32_t)*first_byte_ptr > | 585 if ((int32_t)*first_byte_ptr > |
594 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { | 586 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { |
595 uint8_t size = (uint8_t)(((FX_WORD)(*first_byte_ptr) + 1) >> 1); | 587 uint8_t size = (uint8_t)(((FX_WORD)(*first_byte_ptr) + 1) >> 1); |
596 if (size + (bmp_ptr->col_num >> 1) > bmp_ptr->src_row_bytes) { | 588 if (size + (bmp_ptr->col_num >> 1) > bmp_ptr->src_row_bytes) { |
597 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 589 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
598 return 0; | 590 return 0; |
599 } | 591 } |
600 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; | 592 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; |
601 } | 593 } |
602 for (uint8_t i = 0; i < *first_byte_ptr; i++) { | 594 for (uint8_t i = 0; i < *first_byte_ptr; i++) { |
603 if (i & 0x01) { | 595 if (i & 0x01) { |
604 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 596 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
605 (*second_byte_ptr & 0x0F); | 597 (*second_byte_ptr & 0x0F); |
606 } else { | 598 } else { |
607 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 599 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
608 ((*second_byte_ptr & 0xF0) >> 4); | 600 ((*second_byte_ptr & 0xF0) >> 4); |
609 } | 601 } |
610 } | 602 } |
611 } | 603 } |
612 } | 604 } |
613 } | 605 } |
614 _bmp_error(bmp_ptr, "Any Uncontrol Error"); | 606 bmp_error(bmp_ptr, "Any Uncontrol Error"); |
615 return 0; | 607 return 0; |
616 } | 608 } |
617 uint8_t* _bmp_read_data(bmp_decompress_struct_p bmp_ptr, | 609 uint8_t* bmp_read_data(bmp_decompress_struct_p bmp_ptr, |
618 uint8_t** des_buf_pp, | 610 uint8_t** des_buf_pp, |
619 FX_DWORD data_size) { | 611 FX_DWORD data_size) { |
620 if (bmp_ptr == NULL || bmp_ptr->avail_in < bmp_ptr->skip_size + data_size) { | 612 if (bmp_ptr == NULL || bmp_ptr->avail_in < bmp_ptr->skip_size + data_size) { |
621 return NULL; | 613 return NULL; |
622 } | 614 } |
623 *des_buf_pp = bmp_ptr->next_in + bmp_ptr->skip_size; | 615 *des_buf_pp = bmp_ptr->next_in + bmp_ptr->skip_size; |
624 bmp_ptr->skip_size += data_size; | 616 bmp_ptr->skip_size += data_size; |
625 return *des_buf_pp; | 617 return *des_buf_pp; |
626 } | 618 } |
627 void _bmp_save_decoding_status(bmp_decompress_struct_p bmp_ptr, | 619 void bmp_save_decoding_status(bmp_decompress_struct_p bmp_ptr, int32_t status) { |
628 int32_t status) { | |
629 bmp_ptr->decode_status = status; | 620 bmp_ptr->decode_status = status; |
630 bmp_ptr->next_in += bmp_ptr->skip_size; | 621 bmp_ptr->next_in += bmp_ptr->skip_size; |
631 bmp_ptr->avail_in -= bmp_ptr->skip_size; | 622 bmp_ptr->avail_in -= bmp_ptr->skip_size; |
632 bmp_ptr->skip_size = 0; | 623 bmp_ptr->skip_size = 0; |
633 } | 624 } |
634 void _bmp_input_buffer(bmp_decompress_struct_p bmp_ptr, | 625 void bmp_input_buffer(bmp_decompress_struct_p bmp_ptr, |
635 uint8_t* src_buf, | 626 uint8_t* src_buf, |
636 FX_DWORD src_size) { | 627 FX_DWORD src_size) { |
637 bmp_ptr->next_in = src_buf; | 628 bmp_ptr->next_in = src_buf; |
638 bmp_ptr->avail_in = src_size; | 629 bmp_ptr->avail_in = src_size; |
639 bmp_ptr->skip_size = 0; | 630 bmp_ptr->skip_size = 0; |
640 } | 631 } |
641 FX_DWORD _bmp_get_avail_input(bmp_decompress_struct_p bmp_ptr, | 632 FX_DWORD bmp_get_avail_input(bmp_decompress_struct_p bmp_ptr, |
642 uint8_t** avial_buf_ptr) { | 633 uint8_t** avial_buf_ptr) { |
643 if (avial_buf_ptr) { | 634 if (avial_buf_ptr) { |
644 *avial_buf_ptr = NULL; | 635 *avial_buf_ptr = NULL; |
645 if (bmp_ptr->avail_in > 0) { | 636 if (bmp_ptr->avail_in > 0) { |
646 *avial_buf_ptr = bmp_ptr->next_in; | 637 *avial_buf_ptr = bmp_ptr->next_in; |
647 } | 638 } |
648 } | 639 } |
649 return bmp_ptr->avail_in; | 640 return bmp_ptr->avail_in; |
650 } | 641 } |
651 bmp_compress_struct_p _bmp_create_compress() { | 642 bmp_compress_struct_p bmp_create_compress() { |
652 bmp_compress_struct_p bmp_ptr; | 643 bmp_compress_struct_p bmp_ptr; |
653 bmp_ptr = FX_Alloc(bmp_compress_struct, 1); | 644 bmp_ptr = FX_Alloc(bmp_compress_struct, 1); |
654 if (bmp_ptr) { | 645 if (bmp_ptr) { |
655 FXSYS_memset(bmp_ptr, 0, sizeof(bmp_compress_struct)); | 646 FXSYS_memset(bmp_ptr, 0, sizeof(bmp_compress_struct)); |
656 } | 647 } |
657 return bmp_ptr; | 648 return bmp_ptr; |
658 } | 649 } |
659 void _bmp_destroy_compress(bmp_compress_struct_p bmp_ptr) { | 650 void bmp_destroy_compress(bmp_compress_struct_p bmp_ptr) { |
660 if (bmp_ptr) { | 651 if (bmp_ptr) { |
661 if (bmp_ptr->src_free && bmp_ptr->src_buf) { | 652 if (bmp_ptr->src_free && bmp_ptr->src_buf) { |
662 FX_Free(bmp_ptr->src_buf); | 653 FX_Free(bmp_ptr->src_buf); |
663 } | 654 } |
664 FX_Free(bmp_ptr); | 655 FX_Free(bmp_ptr); |
665 } | 656 } |
666 } | 657 } |
667 static void WriteFileHeader(BmpFileHeaderPtr head_ptr, uint8_t* dst_buf) { | 658 static void WriteFileHeader(BmpFileHeaderPtr head_ptr, uint8_t* dst_buf) { |
668 FX_DWORD offset; | 659 FX_DWORD offset; |
669 offset = 0; | 660 offset = 0; |
670 _SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfType); | 661 SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfType); |
671 offset += 2; | 662 offset += 2; |
672 _SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfSize); | 663 SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfSize); |
673 offset += 4; | 664 offset += 4; |
674 _SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved1); | 665 SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved1); |
675 offset += 2; | 666 offset += 2; |
676 _SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved2); | 667 SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved2); |
677 offset += 2; | 668 offset += 2; |
678 _SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfOffBits); | 669 SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfOffBits); |
679 offset += 4; | 670 offset += 4; |
680 } | 671 } |
681 static void WriteInfoHeader(BmpInfoHeaderPtr info_head_ptr, uint8_t* dst_buf) { | 672 static void WriteInfoHeader(BmpInfoHeaderPtr info_head_ptr, uint8_t* dst_buf) { |
682 FX_DWORD offset; | 673 FX_DWORD offset; |
683 offset = sizeof(BmpFileHeader); | 674 offset = sizeof(BmpFileHeader); |
684 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSize); | 675 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSize); |
685 offset += 4; | 676 offset += 4; |
686 _SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biWidth); | 677 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biWidth); |
687 offset += 4; | 678 offset += 4; |
688 _SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biHeight); | 679 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biHeight); |
689 offset += 4; | 680 offset += 4; |
690 _SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biPlanes); | 681 SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biPlanes); |
691 offset += 2; | 682 offset += 2; |
692 _SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biBitCount); | 683 SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biBitCount); |
693 offset += 2; | 684 offset += 2; |
694 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biCompression); | 685 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biCompression); |
695 offset += 4; | 686 offset += 4; |
696 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSizeImage); | 687 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSizeImage); |
697 offset += 4; | 688 offset += 4; |
698 _SetDWord_LSBFirst(&dst_buf[offset], | 689 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biXPelsPerMeter); |
699 (FX_DWORD)info_head_ptr->biXPelsPerMeter); | |
700 offset += 4; | 690 offset += 4; |
701 _SetDWord_LSBFirst(&dst_buf[offset], | 691 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biYPelsPerMeter); |
702 (FX_DWORD)info_head_ptr->biYPelsPerMeter); | |
703 offset += 4; | 692 offset += 4; |
704 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrUsed); | 693 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrUsed); |
705 offset += 4; | 694 offset += 4; |
706 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrImportant); | 695 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrImportant); |
707 offset += 4; | 696 offset += 4; |
708 } | 697 } |
709 #ifdef BMP_SUPPORT_BITFIELD | 698 static void bmp_encode_bitfields(bmp_compress_struct_p bmp_ptr, |
710 static void _bmp_encode_bitfields(bmp_compress_struct_p bmp_ptr, | 699 uint8_t*& dst_buf, |
711 uint8_t*& dst_buf, | 700 FX_DWORD& dst_size) { |
712 FX_DWORD& dst_size) { | |
713 if (bmp_ptr->info_header.biBitCount != 16 && | 701 if (bmp_ptr->info_header.biBitCount != 16 && |
714 bmp_ptr->info_header.biBitCount != 32) { | 702 bmp_ptr->info_header.biBitCount != 32) { |
715 return; | 703 return; |
716 } | 704 } |
717 FX_DWORD size, dst_pos, i; | 705 FX_DWORD size, dst_pos, i; |
718 size = bmp_ptr->src_pitch * bmp_ptr->src_row * | 706 size = bmp_ptr->src_pitch * bmp_ptr->src_row * |
719 bmp_ptr->info_header.biBitCount / 16; | 707 bmp_ptr->info_header.biBitCount / 16; |
720 dst_pos = bmp_ptr->file_header.bfOffBits; | 708 dst_pos = bmp_ptr->file_header.bfOffBits; |
721 dst_size += size; | 709 dst_size += size; |
722 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 710 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); |
(...skipping 11 matching lines...) Expand all Loading... |
734 if (bmp_ptr->bit_type == BMP_BIT_565) { | 722 if (bmp_ptr->bit_type == BMP_BIT_565) { |
735 mask_red = 0xF800; | 723 mask_red = 0xF800; |
736 mask_green = 0x07E0; | 724 mask_green = 0x07E0; |
737 mask_blue = 0x001F; | 725 mask_blue = 0x001F; |
738 } | 726 } |
739 if (bmp_ptr->info_header.biBitCount == 32) { | 727 if (bmp_ptr->info_header.biBitCount == 32) { |
740 mask_red = 0xFF0000; | 728 mask_red = 0xFF0000; |
741 mask_green = 0x00FF00; | 729 mask_green = 0x00FF00; |
742 mask_blue = 0x0000FF; | 730 mask_blue = 0x0000FF; |
743 } | 731 } |
744 _SetDWord_LSBFirst(&dst_buf[dst_pos], mask_red); | 732 SetDWord_LSBFirst(&dst_buf[dst_pos], mask_red); |
745 dst_pos += 4; | 733 dst_pos += 4; |
746 _SetDWord_LSBFirst(&dst_buf[dst_pos], mask_green); | 734 SetDWord_LSBFirst(&dst_buf[dst_pos], mask_green); |
747 dst_pos += 4; | 735 dst_pos += 4; |
748 _SetDWord_LSBFirst(&dst_buf[dst_pos], mask_blue); | 736 SetDWord_LSBFirst(&dst_buf[dst_pos], mask_blue); |
749 dst_pos += 4; | 737 dst_pos += 4; |
750 bmp_ptr->file_header.bfOffBits = dst_pos; | 738 bmp_ptr->file_header.bfOffBits = dst_pos; |
751 } | 739 } |
752 uint8_t blue_bits = 0; | 740 uint8_t blue_bits = 0; |
753 uint8_t green_bits = 0; | 741 uint8_t green_bits = 0; |
754 uint8_t red_bits = 0; | 742 uint8_t red_bits = 0; |
755 for (i = 0; i < bmp_ptr->info_header.biBitCount; i++) { | 743 for (i = 0; i < bmp_ptr->info_header.biBitCount; i++) { |
756 if ((mask_blue >> i) & 0x01) { | 744 if ((mask_blue >> i) & 0x01) { |
757 blue_bits++; | 745 blue_bits++; |
758 } | 746 } |
(...skipping 16 matching lines...) Expand all Loading... |
775 uint8_t g = bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch + i++]; | 763 uint8_t g = bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch + i++]; |
776 uint8_t r = bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch + i++]; | 764 uint8_t r = bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch + i++]; |
777 if (bmp_ptr->src_bpp == 32) { | 765 if (bmp_ptr->src_bpp == 32) { |
778 i++; | 766 i++; |
779 } | 767 } |
780 FX_DWORD pix_val = 0; | 768 FX_DWORD pix_val = 0; |
781 pix_val |= (b >> blue_bits) & mask_blue; | 769 pix_val |= (b >> blue_bits) & mask_blue; |
782 pix_val |= (g << green_bits) & mask_green; | 770 pix_val |= (g << green_bits) & mask_green; |
783 pix_val |= (r << red_bits) & mask_red; | 771 pix_val |= (r << red_bits) & mask_red; |
784 if (bmp_ptr->info_header.biBitCount == 16) { | 772 if (bmp_ptr->info_header.biBitCount == 16) { |
785 _SetWord_LSBFirst(&dst_buf[dst_pos], (FX_WORD)pix_val); | 773 SetWord_LSBFirst(&dst_buf[dst_pos], pix_val); |
786 dst_pos += 2; | 774 dst_pos += 2; |
787 } else { | 775 } else { |
788 _SetDWord_LSBFirst(&dst_buf[dst_pos], pix_val); | 776 SetDWord_LSBFirst(&dst_buf[dst_pos], pix_val); |
789 dst_pos += 4; | 777 dst_pos += 4; |
790 } | 778 } |
791 } | 779 } |
792 } | 780 } |
793 dst_size = dst_pos; | 781 dst_size = dst_pos; |
794 } | 782 } |
795 #endif | 783 |
796 static void _bmp_encode_rgb(bmp_compress_struct_p bmp_ptr, | 784 static void bmp_encode_rgb(bmp_compress_struct_p bmp_ptr, |
797 uint8_t*& dst_buf, | 785 uint8_t*& dst_buf, |
798 FX_DWORD& dst_size) { | 786 FX_DWORD& dst_size) { |
799 if (bmp_ptr->info_header.biBitCount == 16) { | 787 if (bmp_ptr->info_header.biBitCount == 16) { |
800 #ifdef BMP_SUPPORT_BITFIELD | 788 bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); |
801 _bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); | |
802 #endif | |
803 return; | 789 return; |
804 } | 790 } |
805 FX_DWORD size, dst_pos; | 791 FX_DWORD size, dst_pos; |
806 FX_DWORD dst_pitch = | 792 FX_DWORD dst_pitch = |
807 (bmp_ptr->src_width * bmp_ptr->info_header.biBitCount + 31) / 32 * 4; | 793 (bmp_ptr->src_width * bmp_ptr->info_header.biBitCount + 31) / 32 * 4; |
808 size = dst_pitch * bmp_ptr->src_row; | 794 size = dst_pitch * bmp_ptr->src_row; |
809 dst_pos = bmp_ptr->file_header.bfOffBits; | 795 dst_pos = bmp_ptr->file_header.bfOffBits; |
810 dst_size += size; | 796 dst_size += size; |
811 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 797 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); |
812 if (dst_buf == NULL) { | 798 if (dst_buf == NULL) { |
813 return; | 799 return; |
814 } | 800 } |
815 FXSYS_memset(&dst_buf[dst_pos], 0, size); | 801 FXSYS_memset(&dst_buf[dst_pos], 0, size); |
816 for (int32_t row_num = bmp_ptr->src_row - 1; row_num > -1; row_num--) { | 802 for (int32_t row_num = bmp_ptr->src_row - 1; row_num > -1; row_num--) { |
817 FXSYS_memcpy(&dst_buf[dst_pos], | 803 FXSYS_memcpy(&dst_buf[dst_pos], |
818 &bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch], | 804 &bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch], |
819 bmp_ptr->src_pitch); | 805 bmp_ptr->src_pitch); |
820 dst_pos += dst_pitch; | 806 dst_pos += dst_pitch; |
821 } | 807 } |
822 dst_size = dst_pos; | 808 dst_size = dst_pos; |
823 } | 809 } |
824 static uint8_t _bmp_rle8_search(const uint8_t* buf, int32_t len) { | 810 static uint8_t bmp_rle8_search(const uint8_t* buf, int32_t len) { |
825 uint8_t num; | 811 uint8_t num; |
826 num = 1; | 812 num = 1; |
827 while (num < len) { | 813 while (num < len) { |
828 if (buf[num - 1] != buf[num] || num == 0xFF) { | 814 if (buf[num - 1] != buf[num] || num == 0xFF) { |
829 break; | 815 break; |
830 } | 816 } |
831 num++; | 817 num++; |
832 } | 818 } |
833 return num; | 819 return num; |
834 } | 820 } |
835 static void _bmp_encode_rle8(bmp_compress_struct_p bmp_ptr, | 821 static void bmp_encode_rle8(bmp_compress_struct_p bmp_ptr, |
836 uint8_t*& dst_buf, | 822 uint8_t*& dst_buf, |
837 FX_DWORD& dst_size) { | 823 FX_DWORD& dst_size) { |
838 FX_DWORD size, dst_pos, index; | 824 FX_DWORD size, dst_pos, index; |
839 uint8_t rle[2] = {0}; | 825 uint8_t rle[2] = {0}; |
840 size = bmp_ptr->src_pitch * bmp_ptr->src_row * 2; | 826 size = bmp_ptr->src_pitch * bmp_ptr->src_row * 2; |
841 dst_pos = bmp_ptr->file_header.bfOffBits; | 827 dst_pos = bmp_ptr->file_header.bfOffBits; |
842 dst_size += size; | 828 dst_size += size; |
843 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 829 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); |
844 if (dst_buf == NULL) { | 830 if (dst_buf == NULL) { |
845 return; | 831 return; |
846 } | 832 } |
847 FXSYS_memset(&dst_buf[dst_pos], 0, size); | 833 FXSYS_memset(&dst_buf[dst_pos], 0, size); |
848 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1;) { | 834 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1;) { |
849 index = row_num * bmp_ptr->src_pitch; | 835 index = row_num * bmp_ptr->src_pitch; |
850 rle[0] = _bmp_rle8_search(&bmp_ptr->src_buf[index + i], size - index - i); | 836 rle[0] = bmp_rle8_search(&bmp_ptr->src_buf[index + i], size - index - i); |
851 rle[1] = bmp_ptr->src_buf[index + i]; | 837 rle[1] = bmp_ptr->src_buf[index + i]; |
852 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { | 838 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { |
853 rle[0] = uint8_t(bmp_ptr->src_pitch - i); | 839 rle[0] = uint8_t(bmp_ptr->src_pitch - i); |
854 if (rle[0]) { | 840 if (rle[0]) { |
855 dst_buf[dst_pos++] = rle[0]; | 841 dst_buf[dst_pos++] = rle[0]; |
856 dst_buf[dst_pos++] = rle[1]; | 842 dst_buf[dst_pos++] = rle[1]; |
857 } | 843 } |
858 dst_buf[dst_pos++] = RLE_MARKER; | 844 dst_buf[dst_pos++] = RLE_MARKER; |
859 dst_buf[dst_pos++] = RLE_EOL; | 845 dst_buf[dst_pos++] = RLE_EOL; |
860 i = 0; | 846 i = 0; |
861 row_num--; | 847 row_num--; |
862 } else { | 848 } else { |
863 i += rle[0]; | 849 i += rle[0]; |
864 dst_buf[dst_pos++] = rle[0]; | 850 dst_buf[dst_pos++] = rle[0]; |
865 dst_buf[dst_pos++] = rle[1]; | 851 dst_buf[dst_pos++] = rle[1]; |
866 } | 852 } |
867 } | 853 } |
868 dst_buf[dst_pos++] = RLE_MARKER; | 854 dst_buf[dst_pos++] = RLE_MARKER; |
869 dst_buf[dst_pos++] = RLE_EOI; | 855 dst_buf[dst_pos++] = RLE_EOI; |
870 dst_size = dst_pos; | 856 dst_size = dst_pos; |
871 } | 857 } |
872 static uint8_t _bmp_rle4_search(const uint8_t* buf, int32_t len) { | 858 static uint8_t bmp_rle4_search(const uint8_t* buf, int32_t len) { |
873 uint8_t num; | 859 uint8_t num; |
874 num = 2; | 860 num = 2; |
875 while (num < len) { | 861 while (num < len) { |
876 if (buf[num - 2] != buf[num] || num == 0xFF) { | 862 if (buf[num - 2] != buf[num] || num == 0xFF) { |
877 break; | 863 break; |
878 } | 864 } |
879 num++; | 865 num++; |
880 } | 866 } |
881 return num; | 867 return num; |
882 } | 868 } |
883 static void _bmp_encode_rle4(bmp_compress_struct_p bmp_ptr, | 869 static void bmp_encode_rle4(bmp_compress_struct_p bmp_ptr, |
884 uint8_t*& dst_buf, | 870 uint8_t*& dst_buf, |
885 FX_DWORD& dst_size) { | 871 FX_DWORD& dst_size) { |
886 FX_DWORD size, dst_pos, index; | 872 FX_DWORD size, dst_pos, index; |
887 uint8_t rle[2] = {0}; | 873 uint8_t rle[2] = {0}; |
888 size = bmp_ptr->src_pitch * bmp_ptr->src_row; | 874 size = bmp_ptr->src_pitch * bmp_ptr->src_row; |
889 dst_pos = bmp_ptr->file_header.bfOffBits; | 875 dst_pos = bmp_ptr->file_header.bfOffBits; |
890 dst_size += size; | 876 dst_size += size; |
891 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 877 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); |
892 if (dst_buf == NULL) { | 878 if (dst_buf == NULL) { |
893 return; | 879 return; |
894 } | 880 } |
895 FXSYS_memset(&dst_buf[dst_pos], 0, size); | 881 FXSYS_memset(&dst_buf[dst_pos], 0, size); |
896 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1; | 882 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1; |
897 rle[1] = 0) { | 883 rle[1] = 0) { |
898 index = row_num * bmp_ptr->src_pitch; | 884 index = row_num * bmp_ptr->src_pitch; |
899 rle[0] = _bmp_rle4_search(&bmp_ptr->src_buf[index + i], size - index - i); | 885 rle[0] = bmp_rle4_search(&bmp_ptr->src_buf[index + i], size - index - i); |
900 rle[1] |= (bmp_ptr->src_buf[index + i] & 0x0f) << 4; | 886 rle[1] |= (bmp_ptr->src_buf[index + i] & 0x0f) << 4; |
901 rle[1] |= bmp_ptr->src_buf[index + i + 1] & 0x0f; | 887 rle[1] |= bmp_ptr->src_buf[index + i + 1] & 0x0f; |
902 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { | 888 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { |
903 rle[0] = uint8_t(bmp_ptr->src_pitch - i); | 889 rle[0] = uint8_t(bmp_ptr->src_pitch - i); |
904 if (rle[0]) { | 890 if (rle[0]) { |
905 dst_buf[dst_pos++] = rle[0]; | 891 dst_buf[dst_pos++] = rle[0]; |
906 dst_buf[dst_pos++] = rle[1]; | 892 dst_buf[dst_pos++] = rle[1]; |
907 } | 893 } |
908 dst_buf[dst_pos++] = RLE_MARKER; | 894 dst_buf[dst_pos++] = RLE_MARKER; |
909 dst_buf[dst_pos++] = RLE_EOL; | 895 dst_buf[dst_pos++] = RLE_EOL; |
910 i = 0; | 896 i = 0; |
911 row_num--; | 897 row_num--; |
912 } else { | 898 } else { |
913 i += rle[0]; | 899 i += rle[0]; |
914 dst_buf[dst_pos++] = rle[0]; | 900 dst_buf[dst_pos++] = rle[0]; |
915 dst_buf[dst_pos++] = rle[1]; | 901 dst_buf[dst_pos++] = rle[1]; |
916 } | 902 } |
917 } | 903 } |
918 dst_buf[dst_pos++] = RLE_MARKER; | 904 dst_buf[dst_pos++] = RLE_MARKER; |
919 dst_buf[dst_pos++] = RLE_EOI; | 905 dst_buf[dst_pos++] = RLE_EOI; |
920 dst_size = dst_pos; | 906 dst_size = dst_pos; |
921 } | 907 } |
922 FX_BOOL _bmp_encode_image(bmp_compress_struct_p bmp_ptr, | 908 FX_BOOL bmp_encode_image(bmp_compress_struct_p bmp_ptr, |
923 uint8_t*& dst_buf, | 909 uint8_t*& dst_buf, |
924 FX_DWORD& dst_size) { | 910 FX_DWORD& dst_size) { |
925 FX_DWORD head_size = sizeof(BmpFileHeader) + sizeof(BmpInfoHeader); | 911 FX_DWORD head_size = sizeof(BmpFileHeader) + sizeof(BmpInfoHeader); |
926 FX_DWORD pal_size = sizeof(FX_DWORD) * bmp_ptr->pal_num; | 912 FX_DWORD pal_size = sizeof(FX_DWORD) * bmp_ptr->pal_num; |
927 if (bmp_ptr->info_header.biClrUsed > 0 && | 913 if (bmp_ptr->info_header.biClrUsed > 0 && |
928 bmp_ptr->info_header.biClrUsed < bmp_ptr->pal_num) { | 914 bmp_ptr->info_header.biClrUsed < bmp_ptr->pal_num) { |
929 pal_size = sizeof(FX_DWORD) * bmp_ptr->info_header.biClrUsed; | 915 pal_size = sizeof(FX_DWORD) * bmp_ptr->info_header.biClrUsed; |
930 } | 916 } |
931 dst_size = head_size + sizeof(FX_DWORD) * bmp_ptr->pal_num; | 917 dst_size = head_size + sizeof(FX_DWORD) * bmp_ptr->pal_num; |
932 dst_buf = FX_TryAlloc(uint8_t, dst_size); | 918 dst_buf = FX_TryAlloc(uint8_t, dst_size); |
933 if (dst_buf == NULL) { | 919 if (dst_buf == NULL) { |
934 return FALSE; | 920 return FALSE; |
935 } | 921 } |
936 FXSYS_memset(dst_buf, 0, dst_size); | 922 FXSYS_memset(dst_buf, 0, dst_size); |
937 bmp_ptr->file_header.bfOffBits = head_size; | 923 bmp_ptr->file_header.bfOffBits = head_size; |
938 if (bmp_ptr->pal_ptr && pal_size) { | 924 if (bmp_ptr->pal_ptr && pal_size) { |
939 FXSYS_memcpy(&dst_buf[head_size], bmp_ptr->pal_ptr, pal_size); | 925 FXSYS_memcpy(&dst_buf[head_size], bmp_ptr->pal_ptr, pal_size); |
940 bmp_ptr->file_header.bfOffBits += pal_size; | 926 bmp_ptr->file_header.bfOffBits += pal_size; |
941 } | 927 } |
942 WriteInfoHeader(&bmp_ptr->info_header, dst_buf); | 928 WriteInfoHeader(&bmp_ptr->info_header, dst_buf); |
943 switch (bmp_ptr->info_header.biCompression) { | 929 switch (bmp_ptr->info_header.biCompression) { |
944 case BMP_RGB: | 930 case BMP_RGB: |
945 _bmp_encode_rgb(bmp_ptr, dst_buf, dst_size); | 931 bmp_encode_rgb(bmp_ptr, dst_buf, dst_size); |
946 break; | 932 break; |
947 case BMP_BITFIELDS: | 933 case BMP_BITFIELDS: |
948 #ifdef BMP_SUPPORT_BITFIELD | 934 bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); |
949 _bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); | |
950 #endif | |
951 break; | 935 break; |
952 case BMP_RLE8: | 936 case BMP_RLE8: |
953 _bmp_encode_rle8(bmp_ptr, dst_buf, dst_size); | 937 bmp_encode_rle8(bmp_ptr, dst_buf, dst_size); |
954 break; | 938 break; |
955 case BMP_RLE4: | 939 case BMP_RLE4: |
956 _bmp_encode_rle4(bmp_ptr, dst_buf, dst_size); | 940 bmp_encode_rle4(bmp_ptr, dst_buf, dst_size); |
957 break; | 941 break; |
958 default: | 942 default: |
959 break; | 943 break; |
960 } | 944 } |
961 bmp_ptr->file_header.bfSize = dst_size; | 945 bmp_ptr->file_header.bfSize = dst_size; |
962 WriteFileHeader(&bmp_ptr->file_header, dst_buf); | 946 WriteFileHeader(&bmp_ptr->file_header, dst_buf); |
963 return TRUE; | 947 return TRUE; |
964 } | 948 } |
OLD | NEW |