blob: 0a10bccb4ee20047c392a762add4769e3d647d07 [file] [log] [blame]
Aaron Gablefeec46f2015-08-06 09:54:48 -07001/*
2 * jdmrg565.c
3 *
4 * This file was part of the Independent JPEG Group's software:
5 * Copyright (C) 1994-1996, Thomas G. Lane.
6 * libjpeg-turbo Modifications:
7 * Copyright (C) 2013, Linaro Limited.
8 * Copyright (C) 2014, D. R. Commander.
9 * For conditions of distribution and use, see the accompanying README file.
10 *
11 * This file contains code for merged upsampling/color conversion.
12 */
13
14
15INLINE
16LOCAL(void)
17h2v1_merged_upsample_565_internal (j_decompress_ptr cinfo,
18 JSAMPIMAGE input_buf,
19 JDIMENSION in_row_group_ctr,
20 JSAMPARRAY output_buf)
21{
22 my_upsample_ptr upsample = (my_upsample_ptr) cinfo->upsample;
23 register int y, cred, cgreen, cblue;
24 int cb, cr;
25 register JSAMPROW outptr;
26 JSAMPROW inptr0, inptr1, inptr2;
27 JDIMENSION col;
28 /* copy these pointers into registers if possible */
29 register JSAMPLE * range_limit = cinfo->sample_range_limit;
30 int * Crrtab = upsample->Cr_r_tab;
31 int * Cbbtab = upsample->Cb_b_tab;
32 INT32 * Crgtab = upsample->Cr_g_tab;
33 INT32 * Cbgtab = upsample->Cb_g_tab;
34 unsigned int r, g, b;
35 INT32 rgb;
36 SHIFT_TEMPS
37
38 inptr0 = input_buf[0][in_row_group_ctr];
39 inptr1 = input_buf[1][in_row_group_ctr];
40 inptr2 = input_buf[2][in_row_group_ctr];
41 outptr = output_buf[0];
42
43 /* Loop for each pair of output pixels */
44 for (col = cinfo->output_width >> 1; col > 0; col--) {
45 /* Do the chroma part of the calculation */
46 cb = GETJSAMPLE(*inptr1++);
47 cr = GETJSAMPLE(*inptr2++);
48 cred = Crrtab[cr];
49 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
50 cblue = Cbbtab[cb];
51
52 /* Fetch 2 Y values and emit 2 pixels */
53 y = GETJSAMPLE(*inptr0++);
54 r = range_limit[y + cred];
55 g = range_limit[y + cgreen];
56 b = range_limit[y + cblue];
57 rgb = PACK_SHORT_565(r, g, b);
58
59 y = GETJSAMPLE(*inptr0++);
60 r = range_limit[y + cred];
61 g = range_limit[y + cgreen];
62 b = range_limit[y + cblue];
63 rgb = PACK_TWO_PIXELS(rgb, PACK_SHORT_565(r, g, b));
64
65 WRITE_TWO_PIXELS(outptr, rgb);
66 outptr += 4;
67 }
68
69 /* If image width is odd, do the last output column separately */
70 if (cinfo->output_width & 1) {
71 cb = GETJSAMPLE(*inptr1);
72 cr = GETJSAMPLE(*inptr2);
73 cred = Crrtab[cr];
74 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
75 cblue = Cbbtab[cb];
76 y = GETJSAMPLE(*inptr0);
77 r = range_limit[y + cred];
78 g = range_limit[y + cgreen];
79 b = range_limit[y + cblue];
80 rgb = PACK_SHORT_565(r, g, b);
81 *(INT16*)outptr = rgb;
82 }
83 }
84
85
86INLINE
87LOCAL(void)
88h2v1_merged_upsample_565D_internal (j_decompress_ptr cinfo,
89 JSAMPIMAGE input_buf,
90 JDIMENSION in_row_group_ctr,
91 JSAMPARRAY output_buf)
92{
93 my_upsample_ptr upsample = (my_upsample_ptr) cinfo->upsample;
94 register int y, cred, cgreen, cblue;
95 int cb, cr;
96 register JSAMPROW outptr;
97 JSAMPROW inptr0, inptr1, inptr2;
98 JDIMENSION col;
99 /* copy these pointers into registers if possible */
100 register JSAMPLE * range_limit = cinfo->sample_range_limit;
101 int * Crrtab = upsample->Cr_r_tab;
102 int * Cbbtab = upsample->Cb_b_tab;
103 INT32 * Crgtab = upsample->Cr_g_tab;
104 INT32 * Cbgtab = upsample->Cb_g_tab;
105 INT32 d0 = dither_matrix[cinfo->output_scanline & DITHER_MASK];
106 unsigned int r, g, b;
107 INT32 rgb;
108 SHIFT_TEMPS
109
110 inptr0 = input_buf[0][in_row_group_ctr];
111 inptr1 = input_buf[1][in_row_group_ctr];
112 inptr2 = input_buf[2][in_row_group_ctr];
113 outptr = output_buf[0];
114
115 /* Loop for each pair of output pixels */
116 for (col = cinfo->output_width >> 1; col > 0; col--) {
117 /* Do the chroma part of the calculation */
118 cb = GETJSAMPLE(*inptr1++);
119 cr = GETJSAMPLE(*inptr2++);
120 cred = Crrtab[cr];
121 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
122 cblue = Cbbtab[cb];
123
124 /* Fetch 2 Y values and emit 2 pixels */
125 y = GETJSAMPLE(*inptr0++);
126 r = range_limit[DITHER_565_R(y + cred, d0)];
127 g = range_limit[DITHER_565_G(y + cgreen, d0)];
128 b = range_limit[DITHER_565_B(y + cblue, d0)];
129 d0 = DITHER_ROTATE(d0);
130 rgb = PACK_SHORT_565(r, g, b);
131
132 y = GETJSAMPLE(*inptr0++);
133 r = range_limit[DITHER_565_R(y + cred, d0)];
134 g = range_limit[DITHER_565_G(y + cgreen, d0)];
135 b = range_limit[DITHER_565_B(y + cblue, d0)];
136 d0 = DITHER_ROTATE(d0);
137 rgb = PACK_TWO_PIXELS(rgb, PACK_SHORT_565(r, g, b));
138
139 WRITE_TWO_PIXELS(outptr, rgb);
140 outptr += 4;
141 }
142
143 /* If image width is odd, do the last output column separately */
144 if (cinfo->output_width & 1) {
145 cb = GETJSAMPLE(*inptr1);
146 cr = GETJSAMPLE(*inptr2);
147 cred = Crrtab[cr];
148 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
149 cblue = Cbbtab[cb];
150 y = GETJSAMPLE(*inptr0);
151 r = range_limit[DITHER_565_R(y + cred, d0)];
152 g = range_limit[DITHER_565_G(y + cgreen, d0)];
153 b = range_limit[DITHER_565_B(y + cblue, d0)];
154 rgb = PACK_SHORT_565(r, g, b);
155 *(INT16*)outptr = rgb;
156 }
157}
158
159
160INLINE
161LOCAL(void)
162h2v2_merged_upsample_565_internal (j_decompress_ptr cinfo,
163 JSAMPIMAGE input_buf,
164 JDIMENSION in_row_group_ctr,
165 JSAMPARRAY output_buf)
166{
167 my_upsample_ptr upsample = (my_upsample_ptr) cinfo->upsample;
168 register int y, cred, cgreen, cblue;
169 int cb, cr;
170 register JSAMPROW outptr0, outptr1;
171 JSAMPROW inptr00, inptr01, inptr1, inptr2;
172 JDIMENSION col;
173 /* copy these pointers into registers if possible */
174 register JSAMPLE * range_limit = cinfo->sample_range_limit;
175 int * Crrtab = upsample->Cr_r_tab;
176 int * Cbbtab = upsample->Cb_b_tab;
177 INT32 * Crgtab = upsample->Cr_g_tab;
178 INT32 * Cbgtab = upsample->Cb_g_tab;
179 unsigned int r, g, b;
180 INT32 rgb;
181 SHIFT_TEMPS
182
183 inptr00 = input_buf[0][in_row_group_ctr * 2];
184 inptr01 = input_buf[0][in_row_group_ctr * 2 + 1];
185 inptr1 = input_buf[1][in_row_group_ctr];
186 inptr2 = input_buf[2][in_row_group_ctr];
187 outptr0 = output_buf[0];
188 outptr1 = output_buf[1];
189
190 /* Loop for each group of output pixels */
191 for (col = cinfo->output_width >> 1; col > 0; col--) {
192 /* Do the chroma part of the calculation */
193 cb = GETJSAMPLE(*inptr1++);
194 cr = GETJSAMPLE(*inptr2++);
195 cred = Crrtab[cr];
196 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
197 cblue = Cbbtab[cb];
198
199 /* Fetch 4 Y values and emit 4 pixels */
200 y = GETJSAMPLE(*inptr00++);
201 r = range_limit[y + cred];
202 g = range_limit[y + cgreen];
203 b = range_limit[y + cblue];
204 rgb = PACK_SHORT_565(r, g, b);
205
206 y = GETJSAMPLE(*inptr00++);
207 r = range_limit[y + cred];
208 g = range_limit[y + cgreen];
209 b = range_limit[y + cblue];
210 rgb = PACK_TWO_PIXELS(rgb, PACK_SHORT_565(r, g, b));
211
212 WRITE_TWO_PIXELS(outptr0, rgb);
213 outptr0 += 4;
214
215 y = GETJSAMPLE(*inptr01++);
216 r = range_limit[y + cred];
217 g = range_limit[y + cgreen];
218 b = range_limit[y + cblue];
219 rgb = PACK_SHORT_565(r, g, b);
220
221 y = GETJSAMPLE(*inptr01++);
222 r = range_limit[y + cred];
223 g = range_limit[y + cgreen];
224 b = range_limit[y + cblue];
225 rgb = PACK_TWO_PIXELS(rgb, PACK_SHORT_565(r, g, b));
226
227 WRITE_TWO_PIXELS(outptr1, rgb);
228 outptr1 += 4;
229 }
230
231 /* If image width is odd, do the last output column separately */
232 if (cinfo->output_width & 1) {
233 cb = GETJSAMPLE(*inptr1);
234 cr = GETJSAMPLE(*inptr2);
235 cred = Crrtab[cr];
236 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
237 cblue = Cbbtab[cb];
238
239 y = GETJSAMPLE(*inptr00);
240 r = range_limit[y + cred];
241 g = range_limit[y + cgreen];
242 b = range_limit[y + cblue];
243 rgb = PACK_SHORT_565(r, g, b);
244 *(INT16*)outptr0 = rgb;
245
246 y = GETJSAMPLE(*inptr01);
247 r = range_limit[y + cred];
248 g = range_limit[y + cgreen];
249 b = range_limit[y + cblue];
250 rgb = PACK_SHORT_565(r, g, b);
251 *(INT16*)outptr1 = rgb;
252 }
253}
254
255
256INLINE
257LOCAL(void)
258h2v2_merged_upsample_565D_internal (j_decompress_ptr cinfo,
259 JSAMPIMAGE input_buf,
260 JDIMENSION in_row_group_ctr,
261 JSAMPARRAY output_buf)
262{
263 my_upsample_ptr upsample = (my_upsample_ptr) cinfo->upsample;
264 register int y, cred, cgreen, cblue;
265 int cb, cr;
266 register JSAMPROW outptr0, outptr1;
267 JSAMPROW inptr00, inptr01, inptr1, inptr2;
268 JDIMENSION col;
269 /* copy these pointers into registers if possible */
270 register JSAMPLE * range_limit = cinfo->sample_range_limit;
271 int * Crrtab = upsample->Cr_r_tab;
272 int * Cbbtab = upsample->Cb_b_tab;
273 INT32 * Crgtab = upsample->Cr_g_tab;
274 INT32 * Cbgtab = upsample->Cb_g_tab;
275 INT32 d0 = dither_matrix[cinfo->output_scanline & DITHER_MASK];
276 INT32 d1 = dither_matrix[(cinfo->output_scanline+1) & DITHER_MASK];
277 unsigned int r, g, b;
278 INT32 rgb;
279 SHIFT_TEMPS
280
281 inptr00 = input_buf[0][in_row_group_ctr*2];
282 inptr01 = input_buf[0][in_row_group_ctr*2 + 1];
283 inptr1 = input_buf[1][in_row_group_ctr];
284 inptr2 = input_buf[2][in_row_group_ctr];
285 outptr0 = output_buf[0];
286 outptr1 = output_buf[1];
287
288 /* Loop for each group of output pixels */
289 for (col = cinfo->output_width >> 1; col > 0; col--) {
290 /* Do the chroma part of the calculation */
291 cb = GETJSAMPLE(*inptr1++);
292 cr = GETJSAMPLE(*inptr2++);
293 cred = Crrtab[cr];
294 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
295 cblue = Cbbtab[cb];
296
297 /* Fetch 4 Y values and emit 4 pixels */
298 y = GETJSAMPLE(*inptr00++);
299 r = range_limit[DITHER_565_R(y + cred, d0)];
300 g = range_limit[DITHER_565_G(y + cgreen, d0)];
301 b = range_limit[DITHER_565_B(y + cblue, d0)];
302 d0 = DITHER_ROTATE(d0);
303 rgb = PACK_SHORT_565(r, g, b);
304
305 y = GETJSAMPLE(*inptr00++);
306 r = range_limit[DITHER_565_R(y + cred, d1)];
307 g = range_limit[DITHER_565_G(y + cgreen, d1)];
308 b = range_limit[DITHER_565_B(y + cblue, d1)];
309 d1 = DITHER_ROTATE(d1);
310 rgb = PACK_TWO_PIXELS(rgb, PACK_SHORT_565(r, g, b));
311
312 WRITE_TWO_PIXELS(outptr0, rgb);
313 outptr0 += 4;
314
315 y = GETJSAMPLE(*inptr01++);
316 r = range_limit[DITHER_565_R(y + cred, d0)];
317 g = range_limit[DITHER_565_G(y + cgreen, d0)];
318 b = range_limit[DITHER_565_B(y + cblue, d0)];
319 d0 = DITHER_ROTATE(d0);
320 rgb = PACK_SHORT_565(r, g, b);
321
322 y = GETJSAMPLE(*inptr01++);
323 r = range_limit[DITHER_565_R(y + cred, d1)];
324 g = range_limit[DITHER_565_G(y + cgreen, d1)];
325 b = range_limit[DITHER_565_B(y + cblue, d1)];
326 d1 = DITHER_ROTATE(d1);
327 rgb = PACK_TWO_PIXELS(rgb, PACK_SHORT_565(r, g, b));
328
329 WRITE_TWO_PIXELS(outptr1, rgb);
330 outptr1 += 4;
331 }
332
333 /* If image width is odd, do the last output column separately */
334 if (cinfo->output_width & 1) {
335 cb = GETJSAMPLE(*inptr1);
336 cr = GETJSAMPLE(*inptr2);
337 cred = Crrtab[cr];
338 cgreen = (int) RIGHT_SHIFT(Cbgtab[cb] + Crgtab[cr], SCALEBITS);
339 cblue = Cbbtab[cb];
340
341 y = GETJSAMPLE(*inptr00);
342 r = range_limit[DITHER_565_R(y + cred, d0)];
343 g = range_limit[DITHER_565_G(y + cgreen, d0)];
344 b = range_limit[DITHER_565_B(y + cblue, d0)];
345 rgb = PACK_SHORT_565(r, g, b);
346 *(INT16*)outptr0 = rgb;
347
348 y = GETJSAMPLE(*inptr01);
349 r = range_limit[DITHER_565_R(y + cred, d1)];
350 g = range_limit[DITHER_565_G(y + cgreen, d1)];
351 b = range_limit[DITHER_565_B(y + cblue, d1)];
352 rgb = PACK_SHORT_565(r, g, b);
353 *(INT16*)outptr1 = rgb;
354 }
355}