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 (FX_DWORD)GetWord_LSBFirst((uint8_t*)&bmp_core_header_ptr->bcWidth); |
Tom Sepez
2016/02/25 19:00:39
nit: do we need the casts to FX_DWORD since its ju
Lei Zhang
2016/02/25 20:38:36
Done.
| |
104 bmp_ptr->height = (FX_DWORD)_GetWord_LSBFirst( | 106 bmp_ptr->height = (FX_DWORD)GetWord_LSBFirst( |
105 (uint8_t*)&bmp_core_header_ptr->bcHeight); | 107 (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 #ifdef BMP_SUPPORT_BITFIELD |
225 if (bmp_ptr->compress_flag == BMP_BITFIELDS) { | 226 if (bmp_ptr->compress_flag == BMP_BITFIELDS) { |
226 if (bmp_ptr->bitCounts != 16 && bmp_ptr->bitCounts != 32) { | 227 if (bmp_ptr->bitCounts != 16 && bmp_ptr->bitCounts != 32) { |
227 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 228 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
228 return 0; | 229 return 0; |
229 } | 230 } |
230 FX_DWORD* mask; | 231 FX_DWORD* mask; |
231 if (_bmp_read_data(bmp_ptr, (uint8_t**)&mask, 3 * sizeof(FX_DWORD)) == | 232 if (bmp_read_data(bmp_ptr, (uint8_t**)&mask, 3 * sizeof(FX_DWORD)) == |
232 NULL) { | 233 NULL) { |
233 bmp_ptr->skip_size = skip_size_org; | 234 bmp_ptr->skip_size = skip_size_org; |
234 return 2; | 235 return 2; |
235 } | 236 } |
236 bmp_ptr->mask_red = _GetDWord_LSBFirst((uint8_t*)&mask[0]); | 237 bmp_ptr->mask_red = GetDWord_LSBFirst((uint8_t*)&mask[0]); |
237 bmp_ptr->mask_green = _GetDWord_LSBFirst((uint8_t*)&mask[1]); | 238 bmp_ptr->mask_green = GetDWord_LSBFirst((uint8_t*)&mask[1]); |
238 bmp_ptr->mask_blue = _GetDWord_LSBFirst((uint8_t*)&mask[2]); | 239 bmp_ptr->mask_blue = GetDWord_LSBFirst((uint8_t*)&mask[2]); |
239 if (bmp_ptr->mask_red & bmp_ptr->mask_green || | 240 if (bmp_ptr->mask_red & bmp_ptr->mask_green || |
240 bmp_ptr->mask_red & bmp_ptr->mask_blue || | 241 bmp_ptr->mask_red & bmp_ptr->mask_blue || |
241 bmp_ptr->mask_green & bmp_ptr->mask_blue) { | 242 bmp_ptr->mask_green & bmp_ptr->mask_blue) { |
242 _bmp_error(bmp_ptr, "The Bitfield Bmp File Is Corrupt"); | 243 bmp_error(bmp_ptr, "The Bitfield Bmp File Is Corrupt"); |
243 return 0; | 244 return 0; |
244 } | 245 } |
245 if (bmp_ptr->bmp_header_ptr->bfOffBits < 26 + bmp_ptr->img_ifh_size) { | 246 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; | 247 bmp_ptr->bmp_header_ptr->bfOffBits = 26 + bmp_ptr->img_ifh_size; |
247 } | 248 } |
248 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); | 249 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); |
249 return 1; | 250 return 1; |
250 } else if (bmp_ptr->bitCounts == 16) { | 251 } else if (bmp_ptr->bitCounts == 16) { |
251 bmp_ptr->mask_red = 0x7C00; | 252 bmp_ptr->mask_red = 0x7C00; |
252 bmp_ptr->mask_green = 0x03E0; | 253 bmp_ptr->mask_green = 0x03E0; |
253 bmp_ptr->mask_blue = 0x001F; | 254 bmp_ptr->mask_blue = 0x001F; |
254 } | 255 } |
255 #else | 256 #else |
256 if (bmp_ptr->compress_flag == BMP_BITFIELDS || bmp_ptr->bitCounts == 16) { | 257 if (bmp_ptr->compress_flag == BMP_BITFIELDS || bmp_ptr->bitCounts == 16) { |
257 _bmp_error(bmp_ptr, "Unsupported Bitfield Bmp File"); | 258 bmp_error(bmp_ptr, "Unsupported Bitfield Bmp File"); |
258 return 0; | 259 return 0; |
259 } | 260 } |
260 #endif | 261 #endif |
261 bmp_ptr->pal_num = 0; | 262 bmp_ptr->pal_num = 0; |
262 if (bmp_ptr->bitCounts < 16) { | 263 if (bmp_ptr->bitCounts < 16) { |
263 bmp_ptr->pal_num = 1 << bmp_ptr->bitCounts; | 264 bmp_ptr->pal_num = 1 << bmp_ptr->bitCounts; |
264 if (bmp_ptr->color_used != 0) { | 265 if (bmp_ptr->color_used != 0) { |
265 bmp_ptr->pal_num = bmp_ptr->color_used; | 266 bmp_ptr->pal_num = bmp_ptr->color_used; |
266 } | 267 } |
267 uint8_t* src_pal_ptr = NULL; | 268 uint8_t* src_pal_ptr = NULL; |
268 FX_DWORD src_pal_size = bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4); | 269 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) == | 270 if (bmp_read_data(bmp_ptr, (uint8_t**)&src_pal_ptr, src_pal_size) == |
270 NULL) { | 271 NULL) { |
271 bmp_ptr->skip_size = skip_size_org; | 272 bmp_ptr->skip_size = skip_size_org; |
272 return 2; | 273 return 2; |
273 } | 274 } |
274 FX_Free(bmp_ptr->pal_ptr); | 275 FX_Free(bmp_ptr->pal_ptr); |
275 bmp_ptr->pal_ptr = FX_Alloc(FX_DWORD, bmp_ptr->pal_num); | 276 bmp_ptr->pal_ptr = FX_Alloc(FX_DWORD, bmp_ptr->pal_num); |
276 int32_t src_pal_index = 0; | 277 int32_t src_pal_index = 0; |
277 if (bmp_ptr->pal_type == BMP_PAL_OLD) { | 278 if (bmp_ptr->pal_type == BMP_PAL_OLD) { |
278 while (src_pal_index < bmp_ptr->pal_num) { | 279 while (src_pal_index < bmp_ptr->pal_num) { |
279 bmp_ptr->pal_ptr[src_pal_index++] = BMP_PAL_ENCODE( | 280 bmp_ptr->pal_ptr[src_pal_index++] = BMP_PAL_ENCODE( |
280 0x00, src_pal_ptr[2], src_pal_ptr[1], src_pal_ptr[0]); | 281 0x00, src_pal_ptr[2], src_pal_ptr[1], src_pal_ptr[0]); |
281 src_pal_ptr += 3; | 282 src_pal_ptr += 3; |
282 } | 283 } |
283 } else { | 284 } else { |
284 while (src_pal_index < bmp_ptr->pal_num) { | 285 while (src_pal_index < bmp_ptr->pal_num) { |
285 bmp_ptr->pal_ptr[src_pal_index++] = BMP_PAL_ENCODE( | 286 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]); | 287 src_pal_ptr[3], src_pal_ptr[2], src_pal_ptr[1], src_pal_ptr[0]); |
287 src_pal_ptr += 4; | 288 src_pal_ptr += 4; |
288 } | 289 } |
289 } | 290 } |
290 } | 291 } |
291 if (bmp_ptr->bmp_header_ptr->bfOffBits < | 292 if (bmp_ptr->bmp_header_ptr->bfOffBits < |
292 14 + bmp_ptr->img_ifh_size + | 293 14 + bmp_ptr->img_ifh_size + |
293 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4)) { | 294 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4)) { |
294 bmp_ptr->bmp_header_ptr->bfOffBits = | 295 bmp_ptr->bmp_header_ptr->bfOffBits = |
295 14 + bmp_ptr->img_ifh_size + | 296 14 + bmp_ptr->img_ifh_size + |
296 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4); | 297 bmp_ptr->pal_num * (bmp_ptr->pal_type ? 3 : 4); |
297 } | 298 } |
298 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); | 299 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA_PRE); |
299 } | 300 } |
300 return 1; | 301 return 1; |
301 } | 302 } |
302 int32_t _bmp_decode_image(bmp_decompress_struct_p bmp_ptr) { | 303 int32_t bmp_decode_image(bmp_decompress_struct_p bmp_ptr) { |
303 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA_PRE) { | 304 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA_PRE) { |
304 bmp_ptr->avail_in = 0; | 305 bmp_ptr->avail_in = 0; |
305 if (!bmp_ptr->_bmp_get_data_position_fn( | 306 if (!bmp_ptr->bmp_get_data_position_fn( |
306 bmp_ptr, bmp_ptr->bmp_header_ptr->bfOffBits)) { | 307 bmp_ptr, bmp_ptr->bmp_header_ptr->bfOffBits)) { |
307 bmp_ptr->decode_status = BMP_D_STATUS_TAIL; | 308 bmp_ptr->decode_status = BMP_D_STATUS_TAIL; |
308 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt, Unexpected Stream Offset"); | 309 bmp_error(bmp_ptr, "The Bmp File Is Corrupt, Unexpected Stream Offset"); |
309 return 0; | 310 return 0; |
310 } | 311 } |
311 bmp_ptr->row_num = 0; | 312 bmp_ptr->row_num = 0; |
312 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 313 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
313 } | 314 } |
314 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA) { | 315 if (bmp_ptr->decode_status == BMP_D_STATUS_DATA) { |
315 switch (bmp_ptr->compress_flag) { | 316 switch (bmp_ptr->compress_flag) { |
316 case BMP_RGB: | 317 case BMP_RGB: |
317 case BMP_BITFIELDS: | 318 case BMP_BITFIELDS: |
318 return _bmp_decode_rgb(bmp_ptr); | 319 return bmp_decode_rgb(bmp_ptr); |
319 case BMP_RLE8: | 320 case BMP_RLE8: |
320 return _bmp_decode_rle8(bmp_ptr); | 321 return bmp_decode_rle8(bmp_ptr); |
321 case BMP_RLE4: | 322 case BMP_RLE4: |
322 return _bmp_decode_rle4(bmp_ptr); | 323 return bmp_decode_rle4(bmp_ptr); |
323 } | 324 } |
324 } | 325 } |
325 _bmp_error(bmp_ptr, "Any Uncontrol Error"); | 326 bmp_error(bmp_ptr, "Any Uncontrol Error"); |
326 return 0; | 327 return 0; |
327 } | 328 } |
328 int32_t _bmp_decode_rgb(bmp_decompress_struct_p bmp_ptr) { | 329 int32_t bmp_decode_rgb(bmp_decompress_struct_p bmp_ptr) { |
329 uint8_t* row_buf = bmp_ptr->out_row_buffer; | 330 uint8_t* row_buf = bmp_ptr->out_row_buffer; |
330 uint8_t* des_buf = NULL; | 331 uint8_t* des_buf = NULL; |
331 while (bmp_ptr->row_num < bmp_ptr->height) { | 332 while (bmp_ptr->row_num < bmp_ptr->height) { |
332 if (_bmp_read_data(bmp_ptr, &des_buf, bmp_ptr->src_row_bytes) == NULL) { | 333 if (bmp_read_data(bmp_ptr, &des_buf, bmp_ptr->src_row_bytes) == NULL) { |
333 return 2; | 334 return 2; |
334 } | 335 } |
335 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 336 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
336 switch (bmp_ptr->bitCounts) { | 337 switch (bmp_ptr->bitCounts) { |
337 case 1: { | 338 case 1: { |
338 for (int32_t col = 0; col < bmp_ptr->width; col++) { | 339 for (int32_t col = 0; col < bmp_ptr->width; col++) { |
339 *row_buf++ = des_buf[col >> 3] & (0x80 >> (col % 8)) ? 0x01 : 0x00; | 340 *row_buf++ = des_buf[col >> 3] & (0x80 >> (col % 8)) ? 0x01 : 0x00; |
340 } | 341 } |
341 } break; | 342 } break; |
342 case 4: { | 343 case 4: { |
343 for (int32_t col = 0; col < bmp_ptr->width; col++) { | 344 for (int32_t col = 0; col < bmp_ptr->width; col++) { |
344 *row_buf++ = (col & 0x01) ? (des_buf[col >> 1] & 0x0F) | 345 *row_buf++ = (col & 0x01) ? (des_buf[col >> 1] & 0x0F) |
345 : ((des_buf[col >> 1] & 0xF0) >> 4); | 346 : ((des_buf[col >> 1] & 0xF0) >> 4); |
(...skipping 15 matching lines...) Expand all Loading... | |
361 if ((bmp_ptr->mask_red >> i) & 0x01) { | 362 if ((bmp_ptr->mask_red >> i) & 0x01) { |
362 red_bits++; | 363 red_bits++; |
363 } | 364 } |
364 } | 365 } |
365 green_bits += blue_bits; | 366 green_bits += blue_bits; |
366 red_bits += green_bits; | 367 red_bits += green_bits; |
367 blue_bits = 8 - blue_bits; | 368 blue_bits = 8 - blue_bits; |
368 green_bits -= 8; | 369 green_bits -= 8; |
369 red_bits -= 8; | 370 red_bits -= 8; |
370 for (int32_t col = 0; col < bmp_ptr->width; col++) { | 371 for (int32_t col = 0; col < bmp_ptr->width; col++) { |
371 *buf = _GetWord_LSBFirst((uint8_t*)buf); | 372 *buf = GetWord_LSBFirst((uint8_t*)buf); |
372 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_blue) << blue_bits); | 373 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_blue) << blue_bits); |
373 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_green) >> green_bits); | 374 *row_buf++ = (uint8_t)((*buf & bmp_ptr->mask_green) >> green_bits); |
374 *row_buf++ = (uint8_t)((*buf++ & bmp_ptr->mask_red) >> red_bits); | 375 *row_buf++ = (uint8_t)((*buf++ & bmp_ptr->mask_red) >> red_bits); |
375 } | 376 } |
376 } break; | 377 } break; |
377 #endif | 378 #endif |
378 case 8: | 379 case 8: |
379 case 24: | 380 case 24: |
380 case 32: | 381 case 32: |
381 FXSYS_memcpy(bmp_ptr->out_row_buffer, des_buf, bmp_ptr->src_row_bytes); | 382 FXSYS_memcpy(bmp_ptr->out_row_buffer, des_buf, bmp_ptr->src_row_bytes); |
382 break; | 383 break; |
383 } | 384 } |
384 row_buf = bmp_ptr->out_row_buffer; | 385 row_buf = bmp_ptr->out_row_buffer; |
385 bmp_ptr->_bmp_get_row_fn(bmp_ptr, | 386 bmp_ptr->bmp_get_row_fn(bmp_ptr, |
386 bmp_ptr->imgTB_flag | 387 bmp_ptr->imgTB_flag |
387 ? bmp_ptr->row_num++ | 388 ? bmp_ptr->row_num++ |
388 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 389 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
389 bmp_ptr->out_row_buffer); | 390 bmp_ptr->out_row_buffer); |
390 } | 391 } |
391 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 392 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
392 return 1; | 393 return 1; |
393 } | 394 } |
394 int32_t _bmp_decode_rle8(bmp_decompress_struct_p bmp_ptr) { | 395 int32_t bmp_decode_rle8(bmp_decompress_struct_p bmp_ptr) { |
395 uint8_t* first_byte_ptr = NULL; | 396 uint8_t* first_byte_ptr = NULL; |
396 uint8_t* second_byte_ptr = NULL; | 397 uint8_t* second_byte_ptr = NULL; |
397 bmp_ptr->col_num = 0; | 398 bmp_ptr->col_num = 0; |
398 while (TRUE) { | 399 while (TRUE) { |
399 FX_DWORD skip_size_org = bmp_ptr->skip_size; | 400 FX_DWORD skip_size_org = bmp_ptr->skip_size; |
400 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 401 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
401 return 2; | 402 return 2; |
402 } | 403 } |
403 switch (*first_byte_ptr) { | 404 switch (*first_byte_ptr) { |
404 case RLE_MARKER: { | 405 case RLE_MARKER: { |
405 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 406 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
406 bmp_ptr->skip_size = skip_size_org; | 407 bmp_ptr->skip_size = skip_size_org; |
407 return 2; | 408 return 2; |
408 } | 409 } |
409 switch (*first_byte_ptr) { | 410 switch (*first_byte_ptr) { |
410 case RLE_EOL: { | 411 case RLE_EOL: { |
411 if (bmp_ptr->row_num >= bmp_ptr->height) { | 412 if (bmp_ptr->row_num >= bmp_ptr->height) { |
412 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 413 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
413 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 414 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
414 return 0; | 415 return 0; |
415 } | 416 } |
416 bmp_ptr->_bmp_get_row_fn( | 417 bmp_ptr->bmp_get_row_fn( |
417 bmp_ptr, bmp_ptr->imgTB_flag | 418 bmp_ptr, bmp_ptr->imgTB_flag |
418 ? bmp_ptr->row_num++ | 419 ? bmp_ptr->row_num++ |
419 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 420 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
420 bmp_ptr->out_row_buffer); | 421 bmp_ptr->out_row_buffer); |
421 bmp_ptr->col_num = 0; | 422 bmp_ptr->col_num = 0; |
422 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 423 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
423 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 424 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
424 continue; | 425 continue; |
425 } | 426 } |
426 case RLE_EOI: { | 427 case RLE_EOI: { |
427 if (bmp_ptr->row_num < bmp_ptr->height) { | 428 if (bmp_ptr->row_num < bmp_ptr->height) { |
428 bmp_ptr->_bmp_get_row_fn( | 429 bmp_ptr->bmp_get_row_fn( |
429 bmp_ptr, bmp_ptr->imgTB_flag | 430 bmp_ptr, bmp_ptr->imgTB_flag |
430 ? bmp_ptr->row_num++ | 431 ? bmp_ptr->row_num++ |
431 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 432 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
432 bmp_ptr->out_row_buffer); | 433 bmp_ptr->out_row_buffer); |
433 } | 434 } |
434 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 435 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
435 return 1; | 436 return 1; |
436 } | 437 } |
437 case RLE_DELTA: { | 438 case RLE_DELTA: { |
438 uint8_t* delta_ptr; | 439 uint8_t* delta_ptr; |
439 if (_bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { | 440 if (bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { |
440 bmp_ptr->skip_size = skip_size_org; | 441 bmp_ptr->skip_size = skip_size_org; |
441 return 2; | 442 return 2; |
442 } | 443 } |
443 bmp_ptr->col_num += (int32_t)delta_ptr[0]; | 444 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]; | 445 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 || | 446 if (bmp_ptr->col_num >= bmp_ptr->out_row_bytes || |
446 bmp_row_num_next >= bmp_ptr->height) { | 447 bmp_row_num_next >= bmp_ptr->height) { |
447 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); | 448 bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); |
448 return 0; | 449 return 0; |
449 } | 450 } |
450 while (bmp_ptr->row_num < bmp_row_num_next) { | 451 while (bmp_ptr->row_num < bmp_row_num_next) { |
451 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 452 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
452 bmp_ptr->_bmp_get_row_fn( | 453 bmp_ptr->bmp_get_row_fn( |
453 bmp_ptr, bmp_ptr->imgTB_flag | 454 bmp_ptr, bmp_ptr->imgTB_flag |
454 ? bmp_ptr->row_num++ | 455 ? bmp_ptr->row_num++ |
455 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 456 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
456 bmp_ptr->out_row_buffer); | 457 bmp_ptr->out_row_buffer); |
457 } | 458 } |
458 } break; | 459 } break; |
459 default: { | 460 default: { |
460 if ((int32_t)(*first_byte_ptr) > | 461 if ((int32_t)(*first_byte_ptr) > |
461 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { | 462 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { |
462 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 463 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
463 return 0; | 464 return 0; |
464 } | 465 } |
465 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, | 466 if (bmp_read_data(bmp_ptr, &second_byte_ptr, |
466 *first_byte_ptr & 1 ? *first_byte_ptr + 1 | 467 *first_byte_ptr & 1 ? *first_byte_ptr + 1 |
467 : *first_byte_ptr) == NULL) { | 468 : *first_byte_ptr) == NULL) { |
468 bmp_ptr->skip_size = skip_size_org; | 469 bmp_ptr->skip_size = skip_size_org; |
469 return 2; | 470 return 2; |
470 } | 471 } |
471 FXSYS_memcpy(bmp_ptr->out_row_buffer + bmp_ptr->col_num, | 472 FXSYS_memcpy(bmp_ptr->out_row_buffer + bmp_ptr->col_num, |
472 second_byte_ptr, *first_byte_ptr); | 473 second_byte_ptr, *first_byte_ptr); |
473 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); | 474 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); |
474 } | 475 } |
475 } | 476 } |
476 } break; | 477 } break; |
477 default: { | 478 default: { |
478 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { | 479 if (bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { |
479 bmp_ptr->skip_size = skip_size_org; | 480 bmp_ptr->skip_size = skip_size_org; |
480 return 2; | 481 return 2; |
481 } | 482 } |
482 if ((int32_t)(*first_byte_ptr) > | 483 if ((int32_t)(*first_byte_ptr) > |
483 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { | 484 bmp_ptr->src_row_bytes - bmp_ptr->col_num) { |
484 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 485 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
485 return 0; | 486 return 0; |
486 } | 487 } |
487 FXSYS_memset(bmp_ptr->out_row_buffer + bmp_ptr->col_num, | 488 FXSYS_memset(bmp_ptr->out_row_buffer + bmp_ptr->col_num, |
488 *second_byte_ptr, *first_byte_ptr); | 489 *second_byte_ptr, *first_byte_ptr); |
489 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); | 490 bmp_ptr->col_num += (int32_t)(*first_byte_ptr); |
490 } | 491 } |
491 } | 492 } |
492 } | 493 } |
493 _bmp_error(bmp_ptr, "Any Uncontrol Error"); | 494 bmp_error(bmp_ptr, "Any Uncontrol Error"); |
494 return 0; | 495 return 0; |
495 } | 496 } |
496 int32_t _bmp_decode_rle4(bmp_decompress_struct_p bmp_ptr) { | 497 int32_t bmp_decode_rle4(bmp_decompress_struct_p bmp_ptr) { |
497 uint8_t* first_byte_ptr = NULL; | 498 uint8_t* first_byte_ptr = NULL; |
498 uint8_t* second_byte_ptr = NULL; | 499 uint8_t* second_byte_ptr = NULL; |
499 bmp_ptr->col_num = 0; | 500 bmp_ptr->col_num = 0; |
500 while (TRUE) { | 501 while (TRUE) { |
501 FX_DWORD skip_size_org = bmp_ptr->skip_size; | 502 FX_DWORD skip_size_org = bmp_ptr->skip_size; |
502 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 503 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
503 return 2; | 504 return 2; |
504 } | 505 } |
505 switch (*first_byte_ptr) { | 506 switch (*first_byte_ptr) { |
506 case RLE_MARKER: { | 507 case RLE_MARKER: { |
507 if (_bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { | 508 if (bmp_read_data(bmp_ptr, &first_byte_ptr, 1) == NULL) { |
508 bmp_ptr->skip_size = skip_size_org; | 509 bmp_ptr->skip_size = skip_size_org; |
509 return 2; | 510 return 2; |
510 } | 511 } |
511 switch (*first_byte_ptr) { | 512 switch (*first_byte_ptr) { |
512 case RLE_EOL: { | 513 case RLE_EOL: { |
513 if (bmp_ptr->row_num >= bmp_ptr->height) { | 514 if (bmp_ptr->row_num >= bmp_ptr->height) { |
514 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 515 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
515 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 516 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
516 return 0; | 517 return 0; |
517 } | 518 } |
518 bmp_ptr->_bmp_get_row_fn( | 519 bmp_ptr->bmp_get_row_fn( |
519 bmp_ptr, bmp_ptr->imgTB_flag | 520 bmp_ptr, bmp_ptr->imgTB_flag |
520 ? bmp_ptr->row_num++ | 521 ? bmp_ptr->row_num++ |
521 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 522 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
522 bmp_ptr->out_row_buffer); | 523 bmp_ptr->out_row_buffer); |
523 bmp_ptr->col_num = 0; | 524 bmp_ptr->col_num = 0; |
524 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 525 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
525 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); | 526 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_DATA); |
526 continue; | 527 continue; |
527 } | 528 } |
528 case RLE_EOI: { | 529 case RLE_EOI: { |
529 if (bmp_ptr->row_num < bmp_ptr->height) { | 530 if (bmp_ptr->row_num < bmp_ptr->height) { |
530 bmp_ptr->_bmp_get_row_fn( | 531 bmp_ptr->bmp_get_row_fn( |
531 bmp_ptr, bmp_ptr->imgTB_flag | 532 bmp_ptr, bmp_ptr->imgTB_flag |
532 ? bmp_ptr->row_num++ | 533 ? bmp_ptr->row_num++ |
533 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 534 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
534 bmp_ptr->out_row_buffer); | 535 bmp_ptr->out_row_buffer); |
535 } | 536 } |
536 _bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); | 537 bmp_save_decoding_status(bmp_ptr, BMP_D_STATUS_TAIL); |
537 return 1; | 538 return 1; |
538 } | 539 } |
539 case RLE_DELTA: { | 540 case RLE_DELTA: { |
540 uint8_t* delta_ptr; | 541 uint8_t* delta_ptr; |
541 if (_bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { | 542 if (bmp_read_data(bmp_ptr, &delta_ptr, 2) == NULL) { |
542 bmp_ptr->skip_size = skip_size_org; | 543 bmp_ptr->skip_size = skip_size_org; |
543 return 2; | 544 return 2; |
544 } | 545 } |
545 bmp_ptr->col_num += (int32_t)delta_ptr[0]; | 546 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]; | 547 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 || | 548 if (bmp_ptr->col_num >= bmp_ptr->out_row_bytes || |
548 bmp_row_num_next >= bmp_ptr->height) { | 549 bmp_row_num_next >= bmp_ptr->height) { |
549 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); | 550 bmp_error(bmp_ptr, "The Bmp File Is Corrupt Or Not Supported"); |
550 return 0; | 551 return 0; |
551 } | 552 } |
552 while (bmp_ptr->row_num < bmp_row_num_next) { | 553 while (bmp_ptr->row_num < bmp_row_num_next) { |
553 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); | 554 FXSYS_memset(bmp_ptr->out_row_buffer, 0, bmp_ptr->out_row_bytes); |
554 bmp_ptr->_bmp_get_row_fn( | 555 bmp_ptr->bmp_get_row_fn( |
555 bmp_ptr, bmp_ptr->imgTB_flag | 556 bmp_ptr, bmp_ptr->imgTB_flag |
556 ? bmp_ptr->row_num++ | 557 ? bmp_ptr->row_num++ |
557 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), | 558 : (bmp_ptr->height - 1 - bmp_ptr->row_num++), |
558 bmp_ptr->out_row_buffer); | 559 bmp_ptr->out_row_buffer); |
559 } | 560 } |
560 } break; | 561 } break; |
561 default: { | 562 default: { |
562 uint8_t size = (uint8_t)(((FX_WORD)(*first_byte_ptr) + 1) >> 1); | 563 uint8_t size = (uint8_t)(((FX_WORD)(*first_byte_ptr) + 1) >> 1); |
563 if ((int32_t)*first_byte_ptr >= | 564 if ((int32_t)*first_byte_ptr >= |
564 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { | 565 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { |
565 if (size + (bmp_ptr->col_num >> 1) > bmp_ptr->src_row_bytes) { | 566 if (size + (bmp_ptr->col_num >> 1) > bmp_ptr->src_row_bytes) { |
566 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 567 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
567 return 0; | 568 return 0; |
568 } | 569 } |
569 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; | 570 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; |
570 } | 571 } |
571 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, | 572 if (bmp_read_data(bmp_ptr, &second_byte_ptr, |
572 size & 1 ? size + 1 : size) == NULL) { | 573 size & 1 ? size + 1 : size) == NULL) { |
573 bmp_ptr->skip_size = skip_size_org; | 574 bmp_ptr->skip_size = skip_size_org; |
574 return 2; | 575 return 2; |
575 } | 576 } |
576 for (uint8_t i = 0; i < *first_byte_ptr; i++) { | 577 for (uint8_t i = 0; i < *first_byte_ptr; i++) { |
577 if (i & 0x01) { | 578 if (i & 0x01) { |
578 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 579 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
579 (*second_byte_ptr++ & 0x0F); | 580 (*second_byte_ptr++ & 0x0F); |
580 } else { | 581 } else { |
581 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 582 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
582 ((*second_byte_ptr & 0xF0) >> 4); | 583 ((*second_byte_ptr & 0xF0) >> 4); |
583 } | 584 } |
584 } | 585 } |
585 } | 586 } |
586 } | 587 } |
587 } break; | 588 } break; |
588 default: { | 589 default: { |
589 if (_bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { | 590 if (bmp_read_data(bmp_ptr, &second_byte_ptr, 1) == NULL) { |
590 bmp_ptr->skip_size = skip_size_org; | 591 bmp_ptr->skip_size = skip_size_org; |
591 return 2; | 592 return 2; |
592 } | 593 } |
593 if ((int32_t)*first_byte_ptr > | 594 if ((int32_t)*first_byte_ptr > |
594 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { | 595 bmp_ptr->out_row_bytes - bmp_ptr->col_num) { |
595 uint8_t size = (uint8_t)(((FX_WORD)(*first_byte_ptr) + 1) >> 1); | 596 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) { | 597 if (size + (bmp_ptr->col_num >> 1) > bmp_ptr->src_row_bytes) { |
597 _bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); | 598 bmp_error(bmp_ptr, "The Bmp File Is Corrupt"); |
598 return 0; | 599 return 0; |
599 } | 600 } |
600 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; | 601 *first_byte_ptr = bmp_ptr->out_row_bytes - bmp_ptr->col_num - 1; |
601 } | 602 } |
602 for (uint8_t i = 0; i < *first_byte_ptr; i++) { | 603 for (uint8_t i = 0; i < *first_byte_ptr; i++) { |
603 if (i & 0x01) { | 604 if (i & 0x01) { |
604 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 605 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
605 (*second_byte_ptr & 0x0F); | 606 (*second_byte_ptr & 0x0F); |
606 } else { | 607 } else { |
607 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = | 608 *(bmp_ptr->out_row_buffer + bmp_ptr->col_num++) = |
608 ((*second_byte_ptr & 0xF0) >> 4); | 609 ((*second_byte_ptr & 0xF0) >> 4); |
609 } | 610 } |
610 } | 611 } |
611 } | 612 } |
612 } | 613 } |
613 } | 614 } |
614 _bmp_error(bmp_ptr, "Any Uncontrol Error"); | 615 bmp_error(bmp_ptr, "Any Uncontrol Error"); |
615 return 0; | 616 return 0; |
616 } | 617 } |
617 uint8_t* _bmp_read_data(bmp_decompress_struct_p bmp_ptr, | 618 uint8_t* bmp_read_data(bmp_decompress_struct_p bmp_ptr, |
618 uint8_t** des_buf_pp, | 619 uint8_t** des_buf_pp, |
619 FX_DWORD data_size) { | 620 FX_DWORD data_size) { |
620 if (bmp_ptr == NULL || bmp_ptr->avail_in < bmp_ptr->skip_size + data_size) { | 621 if (bmp_ptr == NULL || bmp_ptr->avail_in < bmp_ptr->skip_size + data_size) { |
621 return NULL; | 622 return NULL; |
622 } | 623 } |
623 *des_buf_pp = bmp_ptr->next_in + bmp_ptr->skip_size; | 624 *des_buf_pp = bmp_ptr->next_in + bmp_ptr->skip_size; |
624 bmp_ptr->skip_size += data_size; | 625 bmp_ptr->skip_size += data_size; |
625 return *des_buf_pp; | 626 return *des_buf_pp; |
626 } | 627 } |
627 void _bmp_save_decoding_status(bmp_decompress_struct_p bmp_ptr, | 628 void bmp_save_decoding_status(bmp_decompress_struct_p bmp_ptr, int32_t status) { |
628 int32_t status) { | |
629 bmp_ptr->decode_status = status; | 629 bmp_ptr->decode_status = status; |
630 bmp_ptr->next_in += bmp_ptr->skip_size; | 630 bmp_ptr->next_in += bmp_ptr->skip_size; |
631 bmp_ptr->avail_in -= bmp_ptr->skip_size; | 631 bmp_ptr->avail_in -= bmp_ptr->skip_size; |
632 bmp_ptr->skip_size = 0; | 632 bmp_ptr->skip_size = 0; |
633 } | 633 } |
634 void _bmp_input_buffer(bmp_decompress_struct_p bmp_ptr, | 634 void bmp_input_buffer(bmp_decompress_struct_p bmp_ptr, |
635 uint8_t* src_buf, | 635 uint8_t* src_buf, |
636 FX_DWORD src_size) { | 636 FX_DWORD src_size) { |
637 bmp_ptr->next_in = src_buf; | 637 bmp_ptr->next_in = src_buf; |
638 bmp_ptr->avail_in = src_size; | 638 bmp_ptr->avail_in = src_size; |
639 bmp_ptr->skip_size = 0; | 639 bmp_ptr->skip_size = 0; |
640 } | 640 } |
641 FX_DWORD _bmp_get_avail_input(bmp_decompress_struct_p bmp_ptr, | 641 FX_DWORD bmp_get_avail_input(bmp_decompress_struct_p bmp_ptr, |
642 uint8_t** avial_buf_ptr) { | 642 uint8_t** avial_buf_ptr) { |
643 if (avial_buf_ptr) { | 643 if (avial_buf_ptr) { |
644 *avial_buf_ptr = NULL; | 644 *avial_buf_ptr = NULL; |
645 if (bmp_ptr->avail_in > 0) { | 645 if (bmp_ptr->avail_in > 0) { |
646 *avial_buf_ptr = bmp_ptr->next_in; | 646 *avial_buf_ptr = bmp_ptr->next_in; |
647 } | 647 } |
648 } | 648 } |
649 return bmp_ptr->avail_in; | 649 return bmp_ptr->avail_in; |
650 } | 650 } |
651 bmp_compress_struct_p _bmp_create_compress() { | 651 bmp_compress_struct_p bmp_create_compress() { |
652 bmp_compress_struct_p bmp_ptr; | 652 bmp_compress_struct_p bmp_ptr; |
653 bmp_ptr = FX_Alloc(bmp_compress_struct, 1); | 653 bmp_ptr = FX_Alloc(bmp_compress_struct, 1); |
654 if (bmp_ptr) { | 654 if (bmp_ptr) { |
655 FXSYS_memset(bmp_ptr, 0, sizeof(bmp_compress_struct)); | 655 FXSYS_memset(bmp_ptr, 0, sizeof(bmp_compress_struct)); |
656 } | 656 } |
657 return bmp_ptr; | 657 return bmp_ptr; |
658 } | 658 } |
659 void _bmp_destroy_compress(bmp_compress_struct_p bmp_ptr) { | 659 void bmp_destroy_compress(bmp_compress_struct_p bmp_ptr) { |
660 if (bmp_ptr) { | 660 if (bmp_ptr) { |
661 if (bmp_ptr->src_free && bmp_ptr->src_buf) { | 661 if (bmp_ptr->src_free && bmp_ptr->src_buf) { |
662 FX_Free(bmp_ptr->src_buf); | 662 FX_Free(bmp_ptr->src_buf); |
663 } | 663 } |
664 FX_Free(bmp_ptr); | 664 FX_Free(bmp_ptr); |
665 } | 665 } |
666 } | 666 } |
667 static void WriteFileHeader(BmpFileHeaderPtr head_ptr, uint8_t* dst_buf) { | 667 static void WriteFileHeader(BmpFileHeaderPtr head_ptr, uint8_t* dst_buf) { |
668 FX_DWORD offset; | 668 FX_DWORD offset; |
669 offset = 0; | 669 offset = 0; |
670 _SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfType); | 670 SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfType); |
671 offset += 2; | 671 offset += 2; |
672 _SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfSize); | 672 SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfSize); |
673 offset += 4; | 673 offset += 4; |
674 _SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved1); | 674 SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved1); |
675 offset += 2; | 675 offset += 2; |
676 _SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved2); | 676 SetWord_LSBFirst(&dst_buf[offset], head_ptr->bfReserved2); |
677 offset += 2; | 677 offset += 2; |
678 _SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfOffBits); | 678 SetDWord_LSBFirst(&dst_buf[offset], head_ptr->bfOffBits); |
679 offset += 4; | 679 offset += 4; |
680 } | 680 } |
681 static void WriteInfoHeader(BmpInfoHeaderPtr info_head_ptr, uint8_t* dst_buf) { | 681 static void WriteInfoHeader(BmpInfoHeaderPtr info_head_ptr, uint8_t* dst_buf) { |
682 FX_DWORD offset; | 682 FX_DWORD offset; |
683 offset = sizeof(BmpFileHeader); | 683 offset = sizeof(BmpFileHeader); |
684 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSize); | 684 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSize); |
685 offset += 4; | 685 offset += 4; |
686 _SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biWidth); | 686 SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biWidth); |
Tom Sepez
2016/02/25 19:00:39
nit: Do we need the casts here,too?
Lei Zhang
2016/02/25 20:38:37
Done.
| |
687 offset += 4; | 687 offset += 4; |
688 _SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biHeight); | 688 SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biHeight); |
689 offset += 4; | 689 offset += 4; |
690 _SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biPlanes); | 690 SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biPlanes); |
691 offset += 2; | 691 offset += 2; |
692 _SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biBitCount); | 692 SetWord_LSBFirst(&dst_buf[offset], info_head_ptr->biBitCount); |
693 offset += 2; | 693 offset += 2; |
694 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biCompression); | 694 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biCompression); |
695 offset += 4; | 695 offset += 4; |
696 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSizeImage); | 696 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biSizeImage); |
697 offset += 4; | 697 offset += 4; |
698 _SetDWord_LSBFirst(&dst_buf[offset], | 698 SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biXPelsPerMeter); |
699 (FX_DWORD)info_head_ptr->biXPelsPerMeter); | |
700 offset += 4; | 699 offset += 4; |
701 _SetDWord_LSBFirst(&dst_buf[offset], | 700 SetDWord_LSBFirst(&dst_buf[offset], (FX_DWORD)info_head_ptr->biYPelsPerMeter); |
702 (FX_DWORD)info_head_ptr->biYPelsPerMeter); | |
703 offset += 4; | 701 offset += 4; |
704 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrUsed); | 702 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrUsed); |
705 offset += 4; | 703 offset += 4; |
706 _SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrImportant); | 704 SetDWord_LSBFirst(&dst_buf[offset], info_head_ptr->biClrImportant); |
707 offset += 4; | 705 offset += 4; |
708 } | 706 } |
709 #ifdef BMP_SUPPORT_BITFIELD | 707 #ifdef BMP_SUPPORT_BITFIELD |
710 static void _bmp_encode_bitfields(bmp_compress_struct_p bmp_ptr, | 708 static void bmp_encode_bitfields(bmp_compress_struct_p bmp_ptr, |
711 uint8_t*& dst_buf, | 709 uint8_t*& dst_buf, |
712 FX_DWORD& dst_size) { | 710 FX_DWORD& dst_size) { |
713 if (bmp_ptr->info_header.biBitCount != 16 && | 711 if (bmp_ptr->info_header.biBitCount != 16 && |
714 bmp_ptr->info_header.biBitCount != 32) { | 712 bmp_ptr->info_header.biBitCount != 32) { |
715 return; | 713 return; |
716 } | 714 } |
717 FX_DWORD size, dst_pos, i; | 715 FX_DWORD size, dst_pos, i; |
718 size = bmp_ptr->src_pitch * bmp_ptr->src_row * | 716 size = bmp_ptr->src_pitch * bmp_ptr->src_row * |
719 bmp_ptr->info_header.biBitCount / 16; | 717 bmp_ptr->info_header.biBitCount / 16; |
720 dst_pos = bmp_ptr->file_header.bfOffBits; | 718 dst_pos = bmp_ptr->file_header.bfOffBits; |
721 dst_size += size; | 719 dst_size += size; |
722 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 720 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) { | 732 if (bmp_ptr->bit_type == BMP_BIT_565) { |
735 mask_red = 0xF800; | 733 mask_red = 0xF800; |
736 mask_green = 0x07E0; | 734 mask_green = 0x07E0; |
737 mask_blue = 0x001F; | 735 mask_blue = 0x001F; |
738 } | 736 } |
739 if (bmp_ptr->info_header.biBitCount == 32) { | 737 if (bmp_ptr->info_header.biBitCount == 32) { |
740 mask_red = 0xFF0000; | 738 mask_red = 0xFF0000; |
741 mask_green = 0x00FF00; | 739 mask_green = 0x00FF00; |
742 mask_blue = 0x0000FF; | 740 mask_blue = 0x0000FF; |
743 } | 741 } |
744 _SetDWord_LSBFirst(&dst_buf[dst_pos], mask_red); | 742 SetDWord_LSBFirst(&dst_buf[dst_pos], mask_red); |
745 dst_pos += 4; | 743 dst_pos += 4; |
746 _SetDWord_LSBFirst(&dst_buf[dst_pos], mask_green); | 744 SetDWord_LSBFirst(&dst_buf[dst_pos], mask_green); |
747 dst_pos += 4; | 745 dst_pos += 4; |
748 _SetDWord_LSBFirst(&dst_buf[dst_pos], mask_blue); | 746 SetDWord_LSBFirst(&dst_buf[dst_pos], mask_blue); |
749 dst_pos += 4; | 747 dst_pos += 4; |
750 bmp_ptr->file_header.bfOffBits = dst_pos; | 748 bmp_ptr->file_header.bfOffBits = dst_pos; |
751 } | 749 } |
752 uint8_t blue_bits = 0; | 750 uint8_t blue_bits = 0; |
753 uint8_t green_bits = 0; | 751 uint8_t green_bits = 0; |
754 uint8_t red_bits = 0; | 752 uint8_t red_bits = 0; |
755 for (i = 0; i < bmp_ptr->info_header.biBitCount; i++) { | 753 for (i = 0; i < bmp_ptr->info_header.biBitCount; i++) { |
756 if ((mask_blue >> i) & 0x01) { | 754 if ((mask_blue >> i) & 0x01) { |
757 blue_bits++; | 755 blue_bits++; |
758 } | 756 } |
(...skipping 16 matching lines...) Expand all Loading... | |
775 uint8_t g = bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch + i++]; | 773 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++]; | 774 uint8_t r = bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch + i++]; |
777 if (bmp_ptr->src_bpp == 32) { | 775 if (bmp_ptr->src_bpp == 32) { |
778 i++; | 776 i++; |
779 } | 777 } |
780 FX_DWORD pix_val = 0; | 778 FX_DWORD pix_val = 0; |
781 pix_val |= (b >> blue_bits) & mask_blue; | 779 pix_val |= (b >> blue_bits) & mask_blue; |
782 pix_val |= (g << green_bits) & mask_green; | 780 pix_val |= (g << green_bits) & mask_green; |
783 pix_val |= (r << red_bits) & mask_red; | 781 pix_val |= (r << red_bits) & mask_red; |
784 if (bmp_ptr->info_header.biBitCount == 16) { | 782 if (bmp_ptr->info_header.biBitCount == 16) { |
785 _SetWord_LSBFirst(&dst_buf[dst_pos], (FX_WORD)pix_val); | 783 SetWord_LSBFirst(&dst_buf[dst_pos], (FX_WORD)pix_val); |
Tom Sepez
2016/02/25 19:00:39
nit: ditto
Lei Zhang
2016/02/25 20:38:36
Done.
| |
786 dst_pos += 2; | 784 dst_pos += 2; |
787 } else { | 785 } else { |
788 _SetDWord_LSBFirst(&dst_buf[dst_pos], pix_val); | 786 SetDWord_LSBFirst(&dst_buf[dst_pos], pix_val); |
789 dst_pos += 4; | 787 dst_pos += 4; |
790 } | 788 } |
791 } | 789 } |
792 } | 790 } |
793 dst_size = dst_pos; | 791 dst_size = dst_pos; |
794 } | 792 } |
795 #endif | 793 #endif |
796 static void _bmp_encode_rgb(bmp_compress_struct_p bmp_ptr, | 794 static void bmp_encode_rgb(bmp_compress_struct_p bmp_ptr, |
797 uint8_t*& dst_buf, | 795 uint8_t*& dst_buf, |
798 FX_DWORD& dst_size) { | 796 FX_DWORD& dst_size) { |
799 if (bmp_ptr->info_header.biBitCount == 16) { | 797 if (bmp_ptr->info_header.biBitCount == 16) { |
800 #ifdef BMP_SUPPORT_BITFIELD | 798 #ifdef BMP_SUPPORT_BITFIELD |
Tom Sepez
2016/02/25 19:00:39
nit: always true?
Lei Zhang
2016/02/25 20:38:36
Done.
| |
801 _bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); | 799 bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); |
802 #endif | 800 #endif |
803 return; | 801 return; |
804 } | 802 } |
805 FX_DWORD size, dst_pos; | 803 FX_DWORD size, dst_pos; |
806 FX_DWORD dst_pitch = | 804 FX_DWORD dst_pitch = |
807 (bmp_ptr->src_width * bmp_ptr->info_header.biBitCount + 31) / 32 * 4; | 805 (bmp_ptr->src_width * bmp_ptr->info_header.biBitCount + 31) / 32 * 4; |
808 size = dst_pitch * bmp_ptr->src_row; | 806 size = dst_pitch * bmp_ptr->src_row; |
809 dst_pos = bmp_ptr->file_header.bfOffBits; | 807 dst_pos = bmp_ptr->file_header.bfOffBits; |
810 dst_size += size; | 808 dst_size += size; |
811 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 809 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); |
812 if (dst_buf == NULL) { | 810 if (dst_buf == NULL) { |
813 return; | 811 return; |
814 } | 812 } |
815 FXSYS_memset(&dst_buf[dst_pos], 0, size); | 813 FXSYS_memset(&dst_buf[dst_pos], 0, size); |
816 for (int32_t row_num = bmp_ptr->src_row - 1; row_num > -1; row_num--) { | 814 for (int32_t row_num = bmp_ptr->src_row - 1; row_num > -1; row_num--) { |
817 FXSYS_memcpy(&dst_buf[dst_pos], | 815 FXSYS_memcpy(&dst_buf[dst_pos], |
818 &bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch], | 816 &bmp_ptr->src_buf[row_num * bmp_ptr->src_pitch], |
819 bmp_ptr->src_pitch); | 817 bmp_ptr->src_pitch); |
820 dst_pos += dst_pitch; | 818 dst_pos += dst_pitch; |
821 } | 819 } |
822 dst_size = dst_pos; | 820 dst_size = dst_pos; |
823 } | 821 } |
824 static uint8_t _bmp_rle8_search(const uint8_t* buf, int32_t len) { | 822 static uint8_t bmp_rle8_search(const uint8_t* buf, int32_t len) { |
825 uint8_t num; | 823 uint8_t num; |
826 num = 1; | 824 num = 1; |
827 while (num < len) { | 825 while (num < len) { |
828 if (buf[num - 1] != buf[num] || num == 0xFF) { | 826 if (buf[num - 1] != buf[num] || num == 0xFF) { |
829 break; | 827 break; |
830 } | 828 } |
831 num++; | 829 num++; |
832 } | 830 } |
833 return num; | 831 return num; |
834 } | 832 } |
835 static void _bmp_encode_rle8(bmp_compress_struct_p bmp_ptr, | 833 static void bmp_encode_rle8(bmp_compress_struct_p bmp_ptr, |
836 uint8_t*& dst_buf, | 834 uint8_t*& dst_buf, |
837 FX_DWORD& dst_size) { | 835 FX_DWORD& dst_size) { |
838 FX_DWORD size, dst_pos, index; | 836 FX_DWORD size, dst_pos, index; |
839 uint8_t rle[2] = {0}; | 837 uint8_t rle[2] = {0}; |
840 size = bmp_ptr->src_pitch * bmp_ptr->src_row * 2; | 838 size = bmp_ptr->src_pitch * bmp_ptr->src_row * 2; |
841 dst_pos = bmp_ptr->file_header.bfOffBits; | 839 dst_pos = bmp_ptr->file_header.bfOffBits; |
842 dst_size += size; | 840 dst_size += size; |
843 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 841 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); |
844 if (dst_buf == NULL) { | 842 if (dst_buf == NULL) { |
845 return; | 843 return; |
846 } | 844 } |
847 FXSYS_memset(&dst_buf[dst_pos], 0, size); | 845 FXSYS_memset(&dst_buf[dst_pos], 0, size); |
848 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1;) { | 846 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1;) { |
849 index = row_num * bmp_ptr->src_pitch; | 847 index = row_num * bmp_ptr->src_pitch; |
850 rle[0] = _bmp_rle8_search(&bmp_ptr->src_buf[index + i], size - index - i); | 848 rle[0] = bmp_rle8_search(&bmp_ptr->src_buf[index + i], size - index - i); |
851 rle[1] = bmp_ptr->src_buf[index + i]; | 849 rle[1] = bmp_ptr->src_buf[index + i]; |
852 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { | 850 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { |
853 rle[0] = uint8_t(bmp_ptr->src_pitch - i); | 851 rle[0] = uint8_t(bmp_ptr->src_pitch - i); |
854 if (rle[0]) { | 852 if (rle[0]) { |
855 dst_buf[dst_pos++] = rle[0]; | 853 dst_buf[dst_pos++] = rle[0]; |
856 dst_buf[dst_pos++] = rle[1]; | 854 dst_buf[dst_pos++] = rle[1]; |
857 } | 855 } |
858 dst_buf[dst_pos++] = RLE_MARKER; | 856 dst_buf[dst_pos++] = RLE_MARKER; |
859 dst_buf[dst_pos++] = RLE_EOL; | 857 dst_buf[dst_pos++] = RLE_EOL; |
860 i = 0; | 858 i = 0; |
861 row_num--; | 859 row_num--; |
862 } else { | 860 } else { |
863 i += rle[0]; | 861 i += rle[0]; |
864 dst_buf[dst_pos++] = rle[0]; | 862 dst_buf[dst_pos++] = rle[0]; |
865 dst_buf[dst_pos++] = rle[1]; | 863 dst_buf[dst_pos++] = rle[1]; |
866 } | 864 } |
867 } | 865 } |
868 dst_buf[dst_pos++] = RLE_MARKER; | 866 dst_buf[dst_pos++] = RLE_MARKER; |
869 dst_buf[dst_pos++] = RLE_EOI; | 867 dst_buf[dst_pos++] = RLE_EOI; |
870 dst_size = dst_pos; | 868 dst_size = dst_pos; |
871 } | 869 } |
872 static uint8_t _bmp_rle4_search(const uint8_t* buf, int32_t len) { | 870 static uint8_t bmp_rle4_search(const uint8_t* buf, int32_t len) { |
873 uint8_t num; | 871 uint8_t num; |
874 num = 2; | 872 num = 2; |
875 while (num < len) { | 873 while (num < len) { |
876 if (buf[num - 2] != buf[num] || num == 0xFF) { | 874 if (buf[num - 2] != buf[num] || num == 0xFF) { |
877 break; | 875 break; |
878 } | 876 } |
879 num++; | 877 num++; |
880 } | 878 } |
881 return num; | 879 return num; |
882 } | 880 } |
883 static void _bmp_encode_rle4(bmp_compress_struct_p bmp_ptr, | 881 static void bmp_encode_rle4(bmp_compress_struct_p bmp_ptr, |
884 uint8_t*& dst_buf, | 882 uint8_t*& dst_buf, |
885 FX_DWORD& dst_size) { | 883 FX_DWORD& dst_size) { |
886 FX_DWORD size, dst_pos, index; | 884 FX_DWORD size, dst_pos, index; |
887 uint8_t rle[2] = {0}; | 885 uint8_t rle[2] = {0}; |
888 size = bmp_ptr->src_pitch * bmp_ptr->src_row; | 886 size = bmp_ptr->src_pitch * bmp_ptr->src_row; |
889 dst_pos = bmp_ptr->file_header.bfOffBits; | 887 dst_pos = bmp_ptr->file_header.bfOffBits; |
890 dst_size += size; | 888 dst_size += size; |
891 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); | 889 dst_buf = FX_Realloc(uint8_t, dst_buf, dst_size); |
892 if (dst_buf == NULL) { | 890 if (dst_buf == NULL) { |
893 return; | 891 return; |
894 } | 892 } |
895 FXSYS_memset(&dst_buf[dst_pos], 0, size); | 893 FXSYS_memset(&dst_buf[dst_pos], 0, size); |
896 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1; | 894 for (int32_t row_num = bmp_ptr->src_row - 1, i = 0; row_num > -1; |
897 rle[1] = 0) { | 895 rle[1] = 0) { |
898 index = row_num * bmp_ptr->src_pitch; | 896 index = row_num * bmp_ptr->src_pitch; |
899 rle[0] = _bmp_rle4_search(&bmp_ptr->src_buf[index + i], size - index - i); | 897 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; | 898 rle[1] |= (bmp_ptr->src_buf[index + i] & 0x0f) << 4; |
901 rle[1] |= bmp_ptr->src_buf[index + i + 1] & 0x0f; | 899 rle[1] |= bmp_ptr->src_buf[index + i + 1] & 0x0f; |
902 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { | 900 if (i + rle[0] >= (int32_t)bmp_ptr->src_pitch) { |
903 rle[0] = uint8_t(bmp_ptr->src_pitch - i); | 901 rle[0] = uint8_t(bmp_ptr->src_pitch - i); |
904 if (rle[0]) { | 902 if (rle[0]) { |
905 dst_buf[dst_pos++] = rle[0]; | 903 dst_buf[dst_pos++] = rle[0]; |
906 dst_buf[dst_pos++] = rle[1]; | 904 dst_buf[dst_pos++] = rle[1]; |
907 } | 905 } |
908 dst_buf[dst_pos++] = RLE_MARKER; | 906 dst_buf[dst_pos++] = RLE_MARKER; |
909 dst_buf[dst_pos++] = RLE_EOL; | 907 dst_buf[dst_pos++] = RLE_EOL; |
910 i = 0; | 908 i = 0; |
911 row_num--; | 909 row_num--; |
912 } else { | 910 } else { |
913 i += rle[0]; | 911 i += rle[0]; |
914 dst_buf[dst_pos++] = rle[0]; | 912 dst_buf[dst_pos++] = rle[0]; |
915 dst_buf[dst_pos++] = rle[1]; | 913 dst_buf[dst_pos++] = rle[1]; |
916 } | 914 } |
917 } | 915 } |
918 dst_buf[dst_pos++] = RLE_MARKER; | 916 dst_buf[dst_pos++] = RLE_MARKER; |
919 dst_buf[dst_pos++] = RLE_EOI; | 917 dst_buf[dst_pos++] = RLE_EOI; |
920 dst_size = dst_pos; | 918 dst_size = dst_pos; |
921 } | 919 } |
922 FX_BOOL _bmp_encode_image(bmp_compress_struct_p bmp_ptr, | 920 FX_BOOL bmp_encode_image(bmp_compress_struct_p bmp_ptr, |
923 uint8_t*& dst_buf, | 921 uint8_t*& dst_buf, |
924 FX_DWORD& dst_size) { | 922 FX_DWORD& dst_size) { |
925 FX_DWORD head_size = sizeof(BmpFileHeader) + sizeof(BmpInfoHeader); | 923 FX_DWORD head_size = sizeof(BmpFileHeader) + sizeof(BmpInfoHeader); |
926 FX_DWORD pal_size = sizeof(FX_DWORD) * bmp_ptr->pal_num; | 924 FX_DWORD pal_size = sizeof(FX_DWORD) * bmp_ptr->pal_num; |
927 if (bmp_ptr->info_header.biClrUsed > 0 && | 925 if (bmp_ptr->info_header.biClrUsed > 0 && |
928 bmp_ptr->info_header.biClrUsed < bmp_ptr->pal_num) { | 926 bmp_ptr->info_header.biClrUsed < bmp_ptr->pal_num) { |
929 pal_size = sizeof(FX_DWORD) * bmp_ptr->info_header.biClrUsed; | 927 pal_size = sizeof(FX_DWORD) * bmp_ptr->info_header.biClrUsed; |
930 } | 928 } |
931 dst_size = head_size + sizeof(FX_DWORD) * bmp_ptr->pal_num; | 929 dst_size = head_size + sizeof(FX_DWORD) * bmp_ptr->pal_num; |
932 dst_buf = FX_TryAlloc(uint8_t, dst_size); | 930 dst_buf = FX_TryAlloc(uint8_t, dst_size); |
933 if (dst_buf == NULL) { | 931 if (dst_buf == NULL) { |
934 return FALSE; | 932 return FALSE; |
935 } | 933 } |
936 FXSYS_memset(dst_buf, 0, dst_size); | 934 FXSYS_memset(dst_buf, 0, dst_size); |
937 bmp_ptr->file_header.bfOffBits = head_size; | 935 bmp_ptr->file_header.bfOffBits = head_size; |
938 if (bmp_ptr->pal_ptr && pal_size) { | 936 if (bmp_ptr->pal_ptr && pal_size) { |
939 FXSYS_memcpy(&dst_buf[head_size], bmp_ptr->pal_ptr, pal_size); | 937 FXSYS_memcpy(&dst_buf[head_size], bmp_ptr->pal_ptr, pal_size); |
940 bmp_ptr->file_header.bfOffBits += pal_size; | 938 bmp_ptr->file_header.bfOffBits += pal_size; |
941 } | 939 } |
942 WriteInfoHeader(&bmp_ptr->info_header, dst_buf); | 940 WriteInfoHeader(&bmp_ptr->info_header, dst_buf); |
943 switch (bmp_ptr->info_header.biCompression) { | 941 switch (bmp_ptr->info_header.biCompression) { |
944 case BMP_RGB: | 942 case BMP_RGB: |
945 _bmp_encode_rgb(bmp_ptr, dst_buf, dst_size); | 943 bmp_encode_rgb(bmp_ptr, dst_buf, dst_size); |
946 break; | 944 break; |
947 case BMP_BITFIELDS: | 945 case BMP_BITFIELDS: |
948 #ifdef BMP_SUPPORT_BITFIELD | 946 #ifdef BMP_SUPPORT_BITFIELD |
949 _bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); | 947 bmp_encode_bitfields(bmp_ptr, dst_buf, dst_size); |
950 #endif | 948 #endif |
951 break; | 949 break; |
952 case BMP_RLE8: | 950 case BMP_RLE8: |
953 _bmp_encode_rle8(bmp_ptr, dst_buf, dst_size); | 951 bmp_encode_rle8(bmp_ptr, dst_buf, dst_size); |
954 break; | 952 break; |
955 case BMP_RLE4: | 953 case BMP_RLE4: |
956 _bmp_encode_rle4(bmp_ptr, dst_buf, dst_size); | 954 bmp_encode_rle4(bmp_ptr, dst_buf, dst_size); |
957 break; | 955 break; |
958 default: | 956 default: |
959 break; | 957 break; |
960 } | 958 } |
961 bmp_ptr->file_header.bfSize = dst_size; | 959 bmp_ptr->file_header.bfSize = dst_size; |
962 WriteFileHeader(&bmp_ptr->file_header, dst_buf); | 960 WriteFileHeader(&bmp_ptr->file_header, dst_buf); |
963 return TRUE; | 961 return TRUE; |
964 } | 962 } |
OLD | NEW |