1 // Copyright 2014 Google Inc. All Rights Reserved.
2 //
3 // Use of this source code is governed by a BSD-style license
4 // that can be found in the COPYING file in the root of the source
5 // tree. An additional intellectual property rights grant can be found
6 // in the file PATENTS. All contributing project authors may
7 // be found in the AUTHORS file in the root of the source tree.
8 // -----------------------------------------------------------------------------
9 //
10 // YUV to RGB upsampling functions.
11 //
12 // Author(s): Branimir Vasic (branimir.vasic@imgtec.com)
13 //            Djordje Pesut  (djordje.pesut@imgtec.com)
14 
15 #include "src/dsp/dsp.h"
16 
17 #if defined(WEBP_USE_MIPS_DSP_R2)
18 
19 #include <assert.h>
20 #include "src/dsp/yuv.h"
21 
22 #define YUV_TO_RGB(Y, U, V, R, G, B) do {                                      \
23     const int t1 = MultHi(Y, 19077);                                           \
24     const int t2 = MultHi(V, 13320);                                           \
25     R = MultHi(V, 26149);                                                      \
26     G = MultHi(U, 6419);                                                       \
27     B = MultHi(U, 33050);                                                      \
28     R = t1 + R;                                                                \
29     G = t1 - G;                                                                \
30     B = t1 + B;                                                                \
31     R = R - 14234;                                                             \
32     G = G - t2 + 8708;                                                         \
33     B = B - 17685;                                                             \
34     __asm__ volatile (                                                         \
35       "shll_s.w         %[" #R "],      %[" #R "],        17         \n\t"     \
36       "shll_s.w         %[" #G "],      %[" #G "],        17         \n\t"     \
37       "shll_s.w         %[" #B "],      %[" #B "],        17         \n\t"     \
38       "precrqu_s.qb.ph  %[" #R "],      %[" #R "],        $zero      \n\t"     \
39       "precrqu_s.qb.ph  %[" #G "],      %[" #G "],        $zero      \n\t"     \
40       "precrqu_s.qb.ph  %[" #B "],      %[" #B "],        $zero      \n\t"     \
41       "srl              %[" #R "],      %[" #R "],        24         \n\t"     \
42       "srl              %[" #G "],      %[" #G "],        24         \n\t"     \
43       "srl              %[" #B "],      %[" #B "],        24         \n\t"     \
44       : [R]"+r"(R), [G]"+r"(G), [B]"+r"(B)                                     \
45       :                                                                        \
46     );                                                                         \
47   } while (0)
48 
49 #if !defined(WEBP_REDUCE_CSP)
YuvToRgb(int y,int u,int v,uint8_t * const rgb)50 static WEBP_INLINE void YuvToRgb(int y, int u, int v, uint8_t* const rgb) {
51   int r, g, b;
52   YUV_TO_RGB(y, u, v, r, g, b);
53   rgb[0] = r;
54   rgb[1] = g;
55   rgb[2] = b;
56 }
YuvToBgr(int y,int u,int v,uint8_t * const bgr)57 static WEBP_INLINE void YuvToBgr(int y, int u, int v, uint8_t* const bgr) {
58   int r, g, b;
59   YUV_TO_RGB(y, u, v, r, g, b);
60   bgr[0] = b;
61   bgr[1] = g;
62   bgr[2] = r;
63 }
YuvToRgb565(int y,int u,int v,uint8_t * const rgb)64 static WEBP_INLINE void YuvToRgb565(int y, int u, int v, uint8_t* const rgb) {
65   int r, g, b;
66   YUV_TO_RGB(y, u, v, r, g, b);
67   {
68     const int rg = (r & 0xf8) | (g >> 5);
69     const int gb = ((g << 3) & 0xe0) | (b >> 3);
70 #if (WEBP_SWAP_16BIT_CSP == 1)
71     rgb[0] = gb;
72     rgb[1] = rg;
73 #else
74     rgb[0] = rg;
75     rgb[1] = gb;
76 #endif
77   }
78 }
YuvToRgba4444(int y,int u,int v,uint8_t * const argb)79 static WEBP_INLINE void YuvToRgba4444(int y, int u, int v,
80                                       uint8_t* const argb) {
81   int r, g, b;
82   YUV_TO_RGB(y, u, v, r, g, b);
83   {
84     const int rg = (r & 0xf0) | (g >> 4);
85     const int ba = (b & 0xf0) | 0x0f;     // overwrite the lower 4 bits
86 #if (WEBP_SWAP_16BIT_CSP == 1)
87     argb[0] = ba;
88     argb[1] = rg;
89 #else
90     argb[0] = rg;
91     argb[1] = ba;
92 #endif
93    }
94 }
95 #endif   // WEBP_REDUCE_CSP
96 
97 //-----------------------------------------------------------------------------
98 // Alpha handling variants
99 
100 #if !defined(WEBP_REDUCE_CSP)
YuvToArgb(uint8_t y,uint8_t u,uint8_t v,uint8_t * const argb)101 static WEBP_INLINE void YuvToArgb(uint8_t y, uint8_t u, uint8_t v,
102                                   uint8_t* const argb) {
103   int r, g, b;
104   YUV_TO_RGB(y, u, v, r, g, b);
105   argb[0] = 0xff;
106   argb[1] = r;
107   argb[2] = g;
108   argb[3] = b;
109 }
110 #endif   // WEBP_REDUCE_CSP
YuvToBgra(uint8_t y,uint8_t u,uint8_t v,uint8_t * const bgra)111 static WEBP_INLINE void YuvToBgra(uint8_t y, uint8_t u, uint8_t v,
112                                   uint8_t* const bgra) {
113   int r, g, b;
114   YUV_TO_RGB(y, u, v, r, g, b);
115   bgra[0] = b;
116   bgra[1] = g;
117   bgra[2] = r;
118   bgra[3] = 0xff;
119 }
YuvToRgba(uint8_t y,uint8_t u,uint8_t v,uint8_t * const rgba)120 static WEBP_INLINE void YuvToRgba(uint8_t y, uint8_t u, uint8_t v,
121                                   uint8_t* const rgba) {
122   int r, g, b;
123   YUV_TO_RGB(y, u, v, r, g, b);
124   rgba[0] = r;
125   rgba[1] = g;
126   rgba[2] = b;
127   rgba[3] = 0xff;
128 }
129 
130 //------------------------------------------------------------------------------
131 // Fancy upsampler
132 
133 #ifdef FANCY_UPSAMPLING
134 
135 // Given samples laid out in a square as:
136 //  [a b]
137 //  [c d]
138 // we interpolate u/v as:
139 //  ([9*a + 3*b + 3*c +   d    3*a + 9*b + 3*c +   d] + [8 8]) / 16
140 //  ([3*a +   b + 9*c + 3*d      a + 3*b + 3*c + 9*d]   [8 8]) / 16
141 
142 // We process u and v together stashed into 32bit (16bit each).
143 #define LOAD_UV(u, v) ((u) | ((v) << 16))
144 
145 #define UPSAMPLE_FUNC(FUNC_NAME, FUNC, XSTEP)                                  \
146 static void FUNC_NAME(const uint8_t* top_y, const uint8_t* bottom_y,           \
147                       const uint8_t* top_u, const uint8_t* top_v,              \
148                       const uint8_t* cur_u, const uint8_t* cur_v,              \
149                       uint8_t* top_dst, uint8_t* bottom_dst, int len) {        \
150   int x;                                                                       \
151   const int last_pixel_pair = (len - 1) >> 1;                                  \
152   uint32_t tl_uv = LOAD_UV(top_u[0], top_v[0]);   /* top-left sample */        \
153   uint32_t l_uv  = LOAD_UV(cur_u[0], cur_v[0]);   /* left-sample */            \
154   assert(top_y != NULL);                                                       \
155   {                                                                            \
156     const uint32_t uv0 = (3 * tl_uv + l_uv + 0x00020002u) >> 2;                \
157     FUNC(top_y[0], uv0 & 0xff, (uv0 >> 16), top_dst);                          \
158   }                                                                            \
159   if (bottom_y != NULL) {                                                      \
160     const uint32_t uv0 = (3 * l_uv + tl_uv + 0x00020002u) >> 2;                \
161     FUNC(bottom_y[0], uv0 & 0xff, (uv0 >> 16), bottom_dst);                    \
162   }                                                                            \
163   for (x = 1; x <= last_pixel_pair; ++x) {                                     \
164     const uint32_t t_uv = LOAD_UV(top_u[x], top_v[x]);  /* top sample */       \
165     const uint32_t uv   = LOAD_UV(cur_u[x], cur_v[x]);  /* sample */           \
166     /* precompute invariant values associated with first and second diagonals*/\
167     const uint32_t avg = tl_uv + t_uv + l_uv + uv + 0x00080008u;               \
168     const uint32_t diag_12 = (avg + 2 * (t_uv + l_uv)) >> 3;                   \
169     const uint32_t diag_03 = (avg + 2 * (tl_uv + uv)) >> 3;                    \
170     {                                                                          \
171       const uint32_t uv0 = (diag_12 + tl_uv) >> 1;                             \
172       const uint32_t uv1 = (diag_03 + t_uv) >> 1;                              \
173       FUNC(top_y[2 * x - 1], uv0 & 0xff, (uv0 >> 16),                          \
174            top_dst + (2 * x - 1) * XSTEP);                                     \
175       FUNC(top_y[2 * x - 0], uv1 & 0xff, (uv1 >> 16),                          \
176            top_dst + (2 * x - 0) * XSTEP);                                     \
177     }                                                                          \
178     if (bottom_y != NULL) {                                                    \
179       const uint32_t uv0 = (diag_03 + l_uv) >> 1;                              \
180       const uint32_t uv1 = (diag_12 + uv) >> 1;                                \
181       FUNC(bottom_y[2 * x - 1], uv0 & 0xff, (uv0 >> 16),                       \
182            bottom_dst + (2 * x - 1) * XSTEP);                                  \
183       FUNC(bottom_y[2 * x + 0], uv1 & 0xff, (uv1 >> 16),                       \
184            bottom_dst + (2 * x + 0) * XSTEP);                                  \
185     }                                                                          \
186     tl_uv = t_uv;                                                              \
187     l_uv = uv;                                                                 \
188   }                                                                            \
189   if (!(len & 1)) {                                                            \
190     {                                                                          \
191       const uint32_t uv0 = (3 * tl_uv + l_uv + 0x00020002u) >> 2;              \
192       FUNC(top_y[len - 1], uv0 & 0xff, (uv0 >> 16),                            \
193            top_dst + (len - 1) * XSTEP);                                       \
194     }                                                                          \
195     if (bottom_y != NULL) {                                                    \
196       const uint32_t uv0 = (3 * l_uv + tl_uv + 0x00020002u) >> 2;              \
197       FUNC(bottom_y[len - 1], uv0 & 0xff, (uv0 >> 16),                         \
198            bottom_dst + (len - 1) * XSTEP);                                    \
199     }                                                                          \
200   }                                                                            \
201 }
202 
203 // All variants implemented.
204 UPSAMPLE_FUNC(UpsampleRgbaLinePair,     YuvToRgba,     4)
205 UPSAMPLE_FUNC(UpsampleBgraLinePair,     YuvToBgra,     4)
206 #if !defined(WEBP_REDUCE_CSP)
207 UPSAMPLE_FUNC(UpsampleRgbLinePair,      YuvToRgb,      3)
208 UPSAMPLE_FUNC(UpsampleBgrLinePair,      YuvToBgr,      3)
209 UPSAMPLE_FUNC(UpsampleArgbLinePair,     YuvToArgb,     4)
210 UPSAMPLE_FUNC(UpsampleRgba4444LinePair, YuvToRgba4444, 2)
211 UPSAMPLE_FUNC(UpsampleRgb565LinePair,   YuvToRgb565,   2)
212 #endif   // WEBP_REDUCE_CSP
213 
214 #undef LOAD_UV
215 #undef UPSAMPLE_FUNC
216 
217 //------------------------------------------------------------------------------
218 // Entry point
219 
220 extern void WebPInitUpsamplersMIPSdspR2(void);
221 
WebPInitUpsamplersMIPSdspR2(void)222 WEBP_TSAN_IGNORE_FUNCTION void WebPInitUpsamplersMIPSdspR2(void) {
223   WebPUpsamplers[MODE_RGBA]      = UpsampleRgbaLinePair;
224   WebPUpsamplers[MODE_BGRA]      = UpsampleBgraLinePair;
225   WebPUpsamplers[MODE_rgbA]      = UpsampleRgbaLinePair;
226   WebPUpsamplers[MODE_bgrA]      = UpsampleBgraLinePair;
227 #if !defined(WEBP_REDUCE_CSP)
228   WebPUpsamplers[MODE_RGB]       = UpsampleRgbLinePair;
229   WebPUpsamplers[MODE_BGR]       = UpsampleBgrLinePair;
230   WebPUpsamplers[MODE_ARGB]      = UpsampleArgbLinePair;
231   WebPUpsamplers[MODE_RGBA_4444] = UpsampleRgba4444LinePair;
232   WebPUpsamplers[MODE_RGB_565]   = UpsampleRgb565LinePair;
233   WebPUpsamplers[MODE_Argb]      = UpsampleArgbLinePair;
234   WebPUpsamplers[MODE_rgbA_4444] = UpsampleRgba4444LinePair;
235 #endif   // WEBP_REDUCE_CSP
236 }
237 
238 #endif  // FANCY_UPSAMPLING
239 
240 //------------------------------------------------------------------------------
241 // YUV444 converter
242 
243 #define YUV444_FUNC(FUNC_NAME, FUNC, XSTEP)                                    \
244 static void FUNC_NAME(const uint8_t* y, const uint8_t* u, const uint8_t* v,    \
245                       uint8_t* dst, int len) {                                 \
246   int i;                                                                       \
247   for (i = 0; i < len; ++i) FUNC(y[i], u[i], v[i], &dst[i * XSTEP]);           \
248 }
249 
250 YUV444_FUNC(Yuv444ToRgba,     YuvToRgba,     4)
251 YUV444_FUNC(Yuv444ToBgra,     YuvToBgra,     4)
252 #if !defined(WEBP_REDUCE_CSP)
253 YUV444_FUNC(Yuv444ToRgb,      YuvToRgb,      3)
254 YUV444_FUNC(Yuv444ToBgr,      YuvToBgr,      3)
255 YUV444_FUNC(Yuv444ToArgb,     YuvToArgb,     4)
256 YUV444_FUNC(Yuv444ToRgba4444, YuvToRgba4444, 2)
257 YUV444_FUNC(Yuv444ToRgb565,   YuvToRgb565,   2)
258 #endif   // WEBP_REDUCE_CSP
259 
260 #undef YUV444_FUNC
261 
262 //------------------------------------------------------------------------------
263 // Entry point
264 
265 extern void WebPInitYUV444ConvertersMIPSdspR2(void);
266 
WebPInitYUV444ConvertersMIPSdspR2(void)267 WEBP_TSAN_IGNORE_FUNCTION void WebPInitYUV444ConvertersMIPSdspR2(void) {
268   WebPYUV444Converters[MODE_RGBA]      = Yuv444ToRgba;
269   WebPYUV444Converters[MODE_BGRA]      = Yuv444ToBgra;
270   WebPYUV444Converters[MODE_rgbA]      = Yuv444ToRgba;
271   WebPYUV444Converters[MODE_bgrA]      = Yuv444ToBgra;
272 #if !defined(WEBP_REDUCE_CSP)
273   WebPYUV444Converters[MODE_RGB]       = Yuv444ToRgb;
274   WebPYUV444Converters[MODE_BGR]       = Yuv444ToBgr;
275   WebPYUV444Converters[MODE_ARGB]      = Yuv444ToArgb;
276   WebPYUV444Converters[MODE_RGBA_4444] = Yuv444ToRgba4444;
277   WebPYUV444Converters[MODE_RGB_565]   = Yuv444ToRgb565;
278   WebPYUV444Converters[MODE_Argb]      = Yuv444ToArgb;
279   WebPYUV444Converters[MODE_rgbA_4444] = Yuv444ToRgba4444;
280 #endif   // WEBP_REDUCE_CSP
281 }
282 
283 #else  // !WEBP_USE_MIPS_DSP_R2
284 
285 WEBP_DSP_INIT_STUB(WebPInitYUV444ConvertersMIPSdspR2)
286 
287 #endif  // WEBP_USE_MIPS_DSP_R2
288 
289 #if !(defined(FANCY_UPSAMPLING) && defined(WEBP_USE_MIPS_DSP_R2))
290 WEBP_DSP_INIT_STUB(WebPInitUpsamplersMIPSdspR2)
291 #endif
292