mirror of
git://nv-tegra.nvidia.com/tegra/v4l2-src/v4l2_libs.git
synced 2025-12-22 09:21:28 +03:00
Updating prebuilts and/or headers
f751b481c4a9203345cdbb6459d0f2882f7cdbd9 - include/libv4lconvert.h 6feb5b2b8c99c99712dd1ea7fe9ab674d58bf86b - include/libv4l1.h f2b73fa5ab10ea7038e58bd9a4461d8e16316249 - include/libv4l1-videodev.h bc44111fd6b2f0374a9fc67b1b23666c5c498b2c - include/libv4l2rds.h 94434b9692371b7d5f54ddef2141d22d90079ce9 - include/libv4l-plugin.h c84a9a115a21d1fd20da0f6ca3df7b46dd23cd2a - include/config.h 1edc439e6c0fc98513fa4a69557eb6221d043be0 - include/libv4l2.h 2f55ba765c689500401111747bb381b5aca77b30 - include/libdvbv5/desc_ca.h 4c412880f0c49cd00cb16e56eed082c4744211a5 - include/libdvbv5/countries.h c1212a9308d96730de547648d3cda2fc144d0e29 - include/libdvbv5/desc_atsc_service_location.h 4fe7def34ff640fc5e327b3596298169fdfe2f1c - include/libdvbv5/mpeg_ts.h ef979f3276cc3cad6e947865a42643fbba860c69 - include/libdvbv5/mgt.h ac87e3306569dae329809f27ef227c5d50f0b60e - include/libdvbv5/desc_event_short.h 98365b48442b9e3abb58101983b5da8c14f78289 - include/libdvbv5/dvb-v5-std.h 9a2b20076d6728b5799096e4149e33a73119e1ef - include/libdvbv5/desc_sat.h c8b4fc511833f0993fa740a529e1f61e0f5a216f - include/libdvbv5/mpeg_es.h 44ab16a8d4eae09690c71a6301927c1da55dda6d - include/libdvbv5/descriptors.h 9d523ee179af955a687662996050ee3cfaacf2ab - include/libdvbv5/crc32.h c18291ff9009bfe71a2c7c6f0fce75331dc95e30 - include/libdvbv5/sdt.h 02168c58e3c772f116f075085579ac4a8422e819 - include/libdvbv5/desc_terrestrial_delivery.h bdf514383ca0afe981cf4fd6af86440db2dc6667 - include/libdvbv5/pat.h 22c83d133e5c1d2648efb3028e0d89c970d0aad4 - include/libdvbv5/desc_partial_reception.h 96db22ef84892a36d5df3cffa0b30d5bad01939c - include/libdvbv5/desc_logical_channel.h 73b7b0cf684de0e8a4eae49a8521f81b411d7b72 - include/libdvbv5/desc_ts_info.h 7fb0966c6a1ccdf1a8844aed4a94d4ae1d02fcd7 - include/libdvbv5/dvb-fe.h 6e6fd4c61c1f61006c63214cbe4868d49428ddb9 - include/libdvbv5/mpeg_pes.h efa3a711499f68ae370d49d98dc1963bf6bafcd8 - include/libdvbv5/desc_extension.h d562371bb8a3b961c4d63a0f5618453bdff4bcd3 - include/libdvbv5/dvb-log.h b72b6d1ffcdd81e3e631c7c20bb30e5c287dc7ff - include/libdvbv5/vct.h 92d4c28148d0b537c8afc289e1a76de68435cba0 - include/libdvbv5/dvb-scan.h 6bd2ed0beaf6aa4838e239198564fd8e1d20a3a1 - include/libdvbv5/desc_t2_delivery.h ad13bfa0b1642fc72cca387e62bc193974c8d5ee - include/libdvbv5/atsc_header.h 450fab787e61210c0c5f527df92c31c90b44a113 - include/libdvbv5/desc_service.h 9b5cfad4a5f41cbf886507da6e79b07314827b32 - include/libdvbv5/desc_language.h e81b7f75c11f175cf365fc7fb535e80828f10e24 - include/libdvbv5/dvb-file.h 30e9a7240938943de2725f2b335b19ad320179a5 - include/libdvbv5/header.h 188fc2cbec97288787a7f66554a4b6288224f980 - include/libdvbv5/desc_isdbt_delivery.h 7645dda247bcd45628afbb74ec2707a47050992e - include/libdvbv5/nit.h 1ba874a7cad36ff31e4af3bfb37b98c05063d6b2 - include/libdvbv5/desc_event_extended.h 146f4f53fc49c66b59905249c0142efffd72fc54 - include/libdvbv5/desc_network_name.h 5b4a5e7fb30a7f28118be012837e73a7151d2619 - include/libdvbv5/cat.h d7a096d51e3050c8f52e0e2111d88b71a5313da1 - include/libdvbv5/dvb-demux.h 40a06b5375dbc0de88a15d26cc6c1e9a505119bc - include/libdvbv5/eit.h 7544b5fb8f621a9c637c40d8f7a2a71f6ab4bd63 - include/libdvbv5/desc_hierarchy.h 2560f18846a535a2c02e1ae449511e731f11c011 - include/libdvbv5/desc_ca_identifier.h 100c02ce3bc364ddff895c75f4fb1f928a748d2d - include/libdvbv5/desc_cable_delivery.h 7a6093b13354d054cac78ea118a96e813cac3395 - include/libdvbv5/atsc_eit.h cabecc6d7c9fdf1c437273bd6a746bf83c156f72 - include/libdvbv5/desc_frequency_list.h b867a2e7941d718aa64b2f6a1402322b616cb2da - include/libdvbv5/pmt.h fb8d640da36b6a156cbe0ef12dc25468de89a2a1 - include/libdvbv5/dvb-sat.h 5e2dfc1d9a71805389e9a7932812695d0309050c - include/libdvbv5/dvb-frontend.h 5430e46abb1ac7039ed0309ca338237533ff29c9 - libv4lconvert/sn9c20x.c f4d73412805f12fa08dd79a43798a7f8d7acece9 - libv4lconvert/pac207.c 3c49d99b9753208a9c1c2a9c738a1e7ad291ca22 - libv4lconvert/jpeg_memsrcdest.h ddd39b2fe0e2a86a6c64031ccc0d36edfd9b0f1a - libv4lconvert/sn9c10x.c 463725aa4dd3fecaf89c0b8bbf4747f8f7577935 - libv4lconvert/jpeg.c fa751ff0f78845f3b4591396710df3b165bc8d11 - libv4lconvert/mr97310a.c 3e8e6c1fb85e3c4b58c4e9b2b0a223ddc793edcb - libv4lconvert/libv4lconvert.pc.in b2c19c2eac71d39d3fb883cdc159a69c2afa8fd6 - libv4lconvert/ov511-decomp.c f08c902ecd48c2739956606b502fc0b8e4007703 - libv4lconvert/crop.c 1949e23fe99ccd0a05dcd084848f6d38b0af7ab6 - libv4lconvert/hm12.c 1d9c446cd8a232da87bd79acebc93e018ec72499 - libv4lconvert/jidctflt.c 8b7644ac3d5c4161cfb6dcc2a34013f4c379c665 - libv4lconvert/libv4lconvert.export 22fd03618c218ae14ba59a5aab5f30b0acd2b6ea - libv4lconvert/Makefile ff7444c48a8da88f8a466cfb138e30e585828cb3 - libv4lconvert/jl2005bcd.c 033894511bd7e8a374a52486889658faa17918c4 - libv4lconvert/flip.c 25130d299463897a09e8b9adf72389dac2e89fa4 - libv4lconvert/tinyjpeg-internal.h cc3f3e94a21795990610e63887c30528bde7b42e - libv4lconvert/bayer.c 1f1d1e05443c4b824cd697c0ce5efa9ea1277964 - libv4lconvert/ov518-decomp.c 3271d74d02e2f33c16e3e50aeb1268eb9c440782 - libv4lconvert/rgbyuv.c 725c9b8d0bfadba566cf200921e602961cb12705 - libv4lconvert/spca561-decompress.c 84c9c3812d4b5f237c8cd616d37fc1161a212acc - libv4lconvert/se401.c b694b6348e035b3da880824c2c2768145c9b5199 - libv4lconvert/jpeg_memsrcdest.c 66dd7958319442bd52ba40ede28fbfe31bb4e074 - libv4lconvert/cpia1.c 6ad4947dca51a7e67e056561cdb445d6c354d23c - libv4lconvert/libv4lconvert.c cc8982bb6f753249181c715fe6430ffefc78c23b - libv4lconvert/stv0680.c 72953a5a3a56b0188d35f49246356b9c8c35756c - libv4lconvert/helper.c db3c69c666e451c5d4ef6d1b5a3117f4b128baa4 - libv4lconvert/libv4lconvert-priv.h 803c4d0b9364050eda163452b8792e62e221ab6d - libv4lconvert/tinyjpeg.h fb3344cfa8df97688332ee4fd3b17968437e8ad5 - libv4lconvert/helper-funcs.h 60e29f95ea52df4407d771330897813cdb38340f - libv4lconvert/libv4lsyscall-priv.h fbbffd8182b4fe2e85289b6e784f70cba7ea7b1d - libv4lconvert/sq905c.c 4eff5c1a5e0b99ce4d6e9aa63645d9628467fdc3 - libv4lconvert/sn9c2028-decomp.c 22a502c238e48f4b939c81de41feccfc7c366766 - libv4lconvert/Makefile.dGPU d6c1aba89bbcb6fef46a6f22b7ea01025435c44d - libv4lconvert/Makefile.am be9e3bf3d7d1086b6eed0c1bf2f574c2b1737c00 - libv4lconvert/tinyjpeg.c f061a4e0e45ca8e0dbab630dd477e19a6c915fda - libv4lconvert/spca501.c 07f8e7c84abfbbe76d49d8bfd1f4eae6ea39a90b - libv4lconvert/jpgl.c 1e08fb01a598d71e3fc69656c4f2291f7dc13105 - libv4lconvert/control/libv4lcontrol.h 70f4992835e964b2698473971904375333e3659b - libv4lconvert/control/libv4lcontrol-priv.h 19a7fd04cdeba61172f281806d030472dee79fcd - libv4lconvert/control/libv4lcontrol.c 0390d660eb130f0e580832bcf8ad5069010d2696 - libv4lconvert/processing/libv4lprocessing.h 7da402829dbff238ca6ac829c037a85476185db6 - libv4lconvert/processing/autogain.c a54c2cb0439e606af01d0b4f02704f411819d98c - libv4lconvert/processing/libv4lprocessing.c dae9c69b7f019d7d4494cd56e2cf757e8510824a - libv4lconvert/processing/whitebalance.c 33ab91b54108e8c24cbb80c5c335d96391d440b2 - libv4lconvert/processing/libv4lprocessing-priv.h ebf12bcf99f35fb9c400b04a1439e68598268249 - libv4lconvert/processing/gamma.c d1f2b6f016cfb90c616d848418feb915e3737fa7 - libv4l2/libv4l2.c 752cb342c44989a8c172e3280e220a6fa2ec86b5 - libv4l2/Makefile 7fa618184ff89737d13164be0b79e227d81f398c - libv4l2/log.c 9d456d1772885d900865a8958c0291e13d509de5 - libv4l2/v4l2convert.c cbcee4426c19c168c6f49d04af3a0b2e30c0b681 - libv4l2/libv4l2.pc.in 766aaca553b0166eb736557e44ad42b69464aa53 - libv4l2/libv4l2.export 2542aabb7fbff4b1a09faaadec6006c4410a6d10 - libv4l2/libv4l2-priv.h 4ba98a607592ed0b8327b387af354544c65c9b67 - libv4l2/v4l2-plugin-android.c ffecae84262f548deac1da0fa51f1aba6b6f96a0 - libv4l2/Makefile.dGPU 8e335567bf404eeb3d180dd384309f687f2ab944 - libv4l2/Makefile.am e6516370c43e4869e05a540d2e4ef584ac64890a - libv4l2/v4l2-plugin.c Change-Id: Ie5623d7d9a7af2fb05dcb8167e9830c3ef710cbe
This commit is contained in:
svcmobrel-release
756
libv4lconvert/rgbyuv.c
Normal file
756
libv4lconvert/rgbyuv.c
Normal file
@@ -0,0 +1,756 @@
|
||||
/*
|
||||
|
||||
# RGB <-> YUV conversion routines
|
||||
# (C) 2008 Hans de Goede <hdegoede@redhat.com>
|
||||
|
||||
# RGB565 conversion routines
|
||||
# (C) 2009 Mauro Carvalho Chehab
|
||||
|
||||
# This program is free software; you can redistribute it and/or modify
|
||||
# it under the terms of the GNU Lesser General Public License, version 2.1,
|
||||
# as published by the Free Software Foundation.
|
||||
#
|
||||
# This program is distributed in the hope that it will be useful,
|
||||
# but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
# GNU Lesser General Public License for more details.
|
||||
#
|
||||
# You should have received a copy of the GNU Lesser General Public License
|
||||
# along with this program; if not, write to the Free Software
|
||||
# Foundation, Inc., 51 Franklin Street, Suite 500, Boston, MA 02110-1335 USA
|
||||
|
||||
*/
|
||||
|
||||
#include <string.h>
|
||||
#include "libv4lconvert-priv.h"
|
||||
|
||||
#define RGB2Y(r, g, b, y) \
|
||||
(y) = ((8453 * (r) + 16594 * (g) + 3223 * (b) + 524288) >> 15)
|
||||
|
||||
#define RGB2UV(r, g, b, u, v) \
|
||||
do { \
|
||||
(u) = ((-4878 * (r) - 9578 * (g) + 14456 * (b) + 4210688) >> 15); \
|
||||
(v) = ((14456 * (r) - 12105 * (g) - 2351 * (b) + 4210688) >> 15); \
|
||||
} while (0)
|
||||
|
||||
void v4lconvert_rgb24_to_yuv420(const unsigned char *src, unsigned char *dest,
|
||||
const struct v4l2_format *src_fmt, int bgr, int yvu, int bpp)
|
||||
{
|
||||
unsigned int x, y;
|
||||
unsigned char *udest, *vdest;
|
||||
|
||||
/* Y */
|
||||
for (y = 0; y < src_fmt->fmt.pix.height; y++) {
|
||||
for (x = 0; x < src_fmt->fmt.pix.width; x++) {
|
||||
if (bgr)
|
||||
RGB2Y(src[2], src[1], src[0], *dest++);
|
||||
else
|
||||
RGB2Y(src[0], src[1], src[2], *dest++);
|
||||
src += bpp;
|
||||
}
|
||||
|
||||
src += src_fmt->fmt.pix.bytesperline - bpp * src_fmt->fmt.pix.width;
|
||||
}
|
||||
src -= src_fmt->fmt.pix.height * src_fmt->fmt.pix.bytesperline;
|
||||
|
||||
/* U + V */
|
||||
if (yvu) {
|
||||
vdest = dest;
|
||||
udest = dest + src_fmt->fmt.pix.width * src_fmt->fmt.pix.height / 4;
|
||||
} else {
|
||||
udest = dest;
|
||||
vdest = dest + src_fmt->fmt.pix.width * src_fmt->fmt.pix.height / 4;
|
||||
}
|
||||
|
||||
for (y = 0; y < src_fmt->fmt.pix.height / 2; y++) {
|
||||
for (x = 0; x < src_fmt->fmt.pix.width / 2; x++) {
|
||||
int avg_src[3];
|
||||
|
||||
avg_src[0] = (src[0] + src[bpp] + src[src_fmt->fmt.pix.bytesperline] +
|
||||
src[src_fmt->fmt.pix.bytesperline + bpp]) / 4;
|
||||
avg_src[1] = (src[1] + src[bpp + 1] + src[src_fmt->fmt.pix.bytesperline + 1] +
|
||||
src[src_fmt->fmt.pix.bytesperline + bpp + 1]) / 4;
|
||||
avg_src[2] = (src[2] + src[bpp + 2] + src[src_fmt->fmt.pix.bytesperline + 2] +
|
||||
src[src_fmt->fmt.pix.bytesperline + bpp + 2]) / 4;
|
||||
if (bgr)
|
||||
RGB2UV(avg_src[2], avg_src[1], avg_src[0], *udest++, *vdest++);
|
||||
else
|
||||
RGB2UV(avg_src[0], avg_src[1], avg_src[2], *udest++, *vdest++);
|
||||
src += 2 * bpp;
|
||||
}
|
||||
src += 2 * src_fmt->fmt.pix.bytesperline - bpp * src_fmt->fmt.pix.width;
|
||||
}
|
||||
}
|
||||
|
||||
#define YUV2R(y, u, v) ({ \
|
||||
int r = (y) + ((((v) - 128) * 1436) >> 10); r > 255 ? 255 : r < 0 ? 0 : r; })
|
||||
#define YUV2G(y, u, v) ({ \
|
||||
int g = (y) - ((((u) - 128) * 352 + ((v) - 128) * 731) >> 10); g > 255 ? 255 : g < 0 ? 0 : g; })
|
||||
#define YUV2B(y, u, v) ({ \
|
||||
int b = (y) + ((((u) - 128) * 1814) >> 10); b > 255 ? 255 : b < 0 ? 0 : b; })
|
||||
|
||||
#define CLIP(color) (unsigned char)(((color) > 0xFF) ? 0xff : (((color) < 0) ? 0 : (color)))
|
||||
|
||||
void v4lconvert_yuv420_to_bgr24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int yvu)
|
||||
{
|
||||
int i, j;
|
||||
|
||||
const unsigned char *ysrc = src;
|
||||
const unsigned char *usrc, *vsrc;
|
||||
|
||||
if (yvu) {
|
||||
vsrc = src + width * height;
|
||||
usrc = vsrc + (width * height) / 4;
|
||||
} else {
|
||||
usrc = src + width * height;
|
||||
vsrc = usrc + (width * height) / 4;
|
||||
}
|
||||
|
||||
for (i = 0; i < height; i++) {
|
||||
for (j = 0; j < width; j += 2) {
|
||||
#if 1 /* fast slightly less accurate multiplication free code */
|
||||
int u1 = (((*usrc - 128) << 7) + (*usrc - 128)) >> 6;
|
||||
int rg = (((*usrc - 128) << 1) + (*usrc - 128) +
|
||||
((*vsrc - 128) << 2) + ((*vsrc - 128) << 1)) >> 3;
|
||||
int v1 = (((*vsrc - 128) << 1) + (*vsrc - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(*ysrc + u1);
|
||||
*dest++ = CLIP(*ysrc - rg);
|
||||
*dest++ = CLIP(*ysrc + v1);
|
||||
ysrc++;
|
||||
|
||||
*dest++ = CLIP(*ysrc + u1);
|
||||
*dest++ = CLIP(*ysrc - rg);
|
||||
*dest++ = CLIP(*ysrc + v1);
|
||||
#else
|
||||
*dest++ = YUV2B(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2G(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2R(*ysrc, *usrc, *vsrc);
|
||||
ysrc++;
|
||||
|
||||
*dest++ = YUV2B(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2G(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2R(*ysrc, *usrc, *vsrc);
|
||||
#endif
|
||||
ysrc++;
|
||||
usrc++;
|
||||
vsrc++;
|
||||
}
|
||||
/* Rewind u and v for next line */
|
||||
if (!(i & 1)) {
|
||||
usrc -= width / 2;
|
||||
vsrc -= width / 2;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_yuv420_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int yvu)
|
||||
{
|
||||
int i, j;
|
||||
|
||||
const unsigned char *ysrc = src;
|
||||
const unsigned char *usrc, *vsrc;
|
||||
|
||||
if (yvu) {
|
||||
vsrc = src + width * height;
|
||||
usrc = vsrc + (width * height) / 4;
|
||||
} else {
|
||||
usrc = src + width * height;
|
||||
vsrc = usrc + (width * height) / 4;
|
||||
}
|
||||
|
||||
for (i = 0; i < height; i++) {
|
||||
for (j = 0; j < width; j += 2) {
|
||||
#if 1 /* fast slightly less accurate multiplication free code */
|
||||
int u1 = (((*usrc - 128) << 7) + (*usrc - 128)) >> 6;
|
||||
int rg = (((*usrc - 128) << 1) + (*usrc - 128) +
|
||||
((*vsrc - 128) << 2) + ((*vsrc - 128) << 1)) >> 3;
|
||||
int v1 = (((*vsrc - 128) << 1) + (*vsrc - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(*ysrc + v1);
|
||||
*dest++ = CLIP(*ysrc - rg);
|
||||
*dest++ = CLIP(*ysrc + u1);
|
||||
ysrc++;
|
||||
|
||||
*dest++ = CLIP(*ysrc + v1);
|
||||
*dest++ = CLIP(*ysrc - rg);
|
||||
*dest++ = CLIP(*ysrc + u1);
|
||||
#else
|
||||
*dest++ = YUV2R(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2G(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2B(*ysrc, *usrc, *vsrc);
|
||||
ysrc++;
|
||||
|
||||
*dest++ = YUV2R(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2G(*ysrc, *usrc, *vsrc);
|
||||
*dest++ = YUV2B(*ysrc, *usrc, *vsrc);
|
||||
#endif
|
||||
ysrc++;
|
||||
usrc++;
|
||||
vsrc++;
|
||||
}
|
||||
/* Rewind u and v for next line */
|
||||
if (!(i&1)) {
|
||||
usrc -= width / 2;
|
||||
vsrc -= width / 2;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_yuyv_to_bgr24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride)
|
||||
{
|
||||
int j;
|
||||
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
int u = src[1];
|
||||
int v = src[3];
|
||||
int u1 = (((u - 128) << 7) + (u - 128)) >> 6;
|
||||
int rg = (((u - 128) << 1) + (u - 128) +
|
||||
((v - 128) << 2) + ((v - 128) << 1)) >> 3;
|
||||
int v1 = (((v - 128) << 1) + (v - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(src[0] + u1);
|
||||
*dest++ = CLIP(src[0] - rg);
|
||||
*dest++ = CLIP(src[0] + v1);
|
||||
|
||||
*dest++ = CLIP(src[2] + u1);
|
||||
*dest++ = CLIP(src[2] - rg);
|
||||
*dest++ = CLIP(src[2] + v1);
|
||||
src += 4;
|
||||
}
|
||||
src += stride - width * 2;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_yuyv_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride)
|
||||
{
|
||||
int j;
|
||||
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
int u = src[1];
|
||||
int v = src[3];
|
||||
int u1 = (((u - 128) << 7) + (u - 128)) >> 6;
|
||||
int rg = (((u - 128) << 1) + (u - 128) +
|
||||
((v - 128) << 2) + ((v - 128) << 1)) >> 3;
|
||||
int v1 = (((v - 128) << 1) + (v - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(src[0] + v1);
|
||||
*dest++ = CLIP(src[0] - rg);
|
||||
*dest++ = CLIP(src[0] + u1);
|
||||
|
||||
*dest++ = CLIP(src[2] + v1);
|
||||
*dest++ = CLIP(src[2] - rg);
|
||||
*dest++ = CLIP(src[2] + u1);
|
||||
src += 4;
|
||||
}
|
||||
src += stride - (width * 2);
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_yuyv_to_yuv420(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride, int yvu)
|
||||
{
|
||||
int i, j;
|
||||
const unsigned char *src1;
|
||||
unsigned char *udest, *vdest;
|
||||
|
||||
/* copy the Y values */
|
||||
src1 = src;
|
||||
for (i = 0; i < height; i++) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
*dest++ = src1[0];
|
||||
*dest++ = src1[2];
|
||||
src1 += 4;
|
||||
}
|
||||
src1 += stride - width * 2;
|
||||
}
|
||||
|
||||
/* copy the U and V values */
|
||||
src++; /* point to V */
|
||||
src1 = src + stride; /* next line */
|
||||
if (yvu) {
|
||||
vdest = dest;
|
||||
udest = dest + width * height / 4;
|
||||
} else {
|
||||
udest = dest;
|
||||
vdest = dest + width * height / 4;
|
||||
}
|
||||
for (i = 0; i < height; i += 2) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
*udest++ = ((int) src[0] + src1[0]) / 2; /* U */
|
||||
*vdest++ = ((int) src[2] + src1[2]) / 2; /* V */
|
||||
src += 4;
|
||||
src1 += 4;
|
||||
}
|
||||
src1 += stride - width * 2;
|
||||
src = src1;
|
||||
src1 += stride;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_yvyu_to_bgr24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride)
|
||||
{
|
||||
int j;
|
||||
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
int u = src[3];
|
||||
int v = src[1];
|
||||
int u1 = (((u - 128) << 7) + (u - 128)) >> 6;
|
||||
int rg = (((u - 128) << 1) + (u - 128) +
|
||||
((v - 128) << 2) + ((v - 128) << 1)) >> 3;
|
||||
int v1 = (((v - 128) << 1) + (v - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(src[0] + u1);
|
||||
*dest++ = CLIP(src[0] - rg);
|
||||
*dest++ = CLIP(src[0] + v1);
|
||||
|
||||
*dest++ = CLIP(src[2] + u1);
|
||||
*dest++ = CLIP(src[2] - rg);
|
||||
*dest++ = CLIP(src[2] + v1);
|
||||
src += 4;
|
||||
}
|
||||
src += stride - (width * 2);
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_yvyu_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride)
|
||||
{
|
||||
int j;
|
||||
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
int u = src[3];
|
||||
int v = src[1];
|
||||
int u1 = (((u - 128) << 7) + (u - 128)) >> 6;
|
||||
int rg = (((u - 128) << 1) + (u - 128) +
|
||||
((v - 128) << 2) + ((v - 128) << 1)) >> 3;
|
||||
int v1 = (((v - 128) << 1) + (v - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(src[0] + v1);
|
||||
*dest++ = CLIP(src[0] - rg);
|
||||
*dest++ = CLIP(src[0] + u1);
|
||||
|
||||
*dest++ = CLIP(src[2] + v1);
|
||||
*dest++ = CLIP(src[2] - rg);
|
||||
*dest++ = CLIP(src[2] + u1);
|
||||
src += 4;
|
||||
}
|
||||
src += stride - (width * 2);
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_uyvy_to_bgr24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride)
|
||||
{
|
||||
int j;
|
||||
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
int u = src[0];
|
||||
int v = src[2];
|
||||
int u1 = (((u - 128) << 7) + (u - 128)) >> 6;
|
||||
int rg = (((u - 128) << 1) + (u - 128) +
|
||||
((v - 128) << 2) + ((v - 128) << 1)) >> 3;
|
||||
int v1 = (((v - 128) << 1) + (v - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(src[1] + u1);
|
||||
*dest++ = CLIP(src[1] - rg);
|
||||
*dest++ = CLIP(src[1] + v1);
|
||||
|
||||
*dest++ = CLIP(src[3] + u1);
|
||||
*dest++ = CLIP(src[3] - rg);
|
||||
*dest++ = CLIP(src[3] + v1);
|
||||
src += 4;
|
||||
}
|
||||
src += stride - width * 2;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_uyvy_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride)
|
||||
{
|
||||
int j;
|
||||
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
int u = src[0];
|
||||
int v = src[2];
|
||||
int u1 = (((u - 128) << 7) + (u - 128)) >> 6;
|
||||
int rg = (((u - 128) << 1) + (u - 128) +
|
||||
((v - 128) << 2) + ((v - 128) << 1)) >> 3;
|
||||
int v1 = (((v - 128) << 1) + (v - 128)) >> 1;
|
||||
|
||||
*dest++ = CLIP(src[1] + v1);
|
||||
*dest++ = CLIP(src[1] - rg);
|
||||
*dest++ = CLIP(src[1] + u1);
|
||||
|
||||
*dest++ = CLIP(src[3] + v1);
|
||||
*dest++ = CLIP(src[3] - rg);
|
||||
*dest++ = CLIP(src[3] + u1);
|
||||
src += 4;
|
||||
}
|
||||
src += stride - width * 2;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_uyvy_to_yuv420(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int stride, int yvu)
|
||||
{
|
||||
int i, j;
|
||||
const unsigned char *src1;
|
||||
unsigned char *udest, *vdest;
|
||||
|
||||
/* copy the Y values */
|
||||
src1 = src;
|
||||
for (i = 0; i < height; i++) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
*dest++ = src1[1];
|
||||
*dest++ = src1[3];
|
||||
src1 += 4;
|
||||
}
|
||||
src1 += stride - width * 2;
|
||||
}
|
||||
|
||||
/* copy the U and V values */
|
||||
src1 = src + stride; /* next line */
|
||||
if (yvu) {
|
||||
vdest = dest;
|
||||
udest = dest + width * height / 4;
|
||||
} else {
|
||||
udest = dest;
|
||||
vdest = dest + width * height / 4;
|
||||
}
|
||||
for (i = 0; i < height; i += 2) {
|
||||
for (j = 0; j + 1 < width; j += 2) {
|
||||
*udest++ = ((int) src[0] + src1[0]) / 2; /* U */
|
||||
*vdest++ = ((int) src[2] + src1[2]) / 2; /* V */
|
||||
src += 4;
|
||||
src1 += 4;
|
||||
}
|
||||
src1 += stride - width * 2;
|
||||
src = src1;
|
||||
src1 += stride;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_swap_rgb(const unsigned char *src, unsigned char *dst,
|
||||
int width, int height)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < (width * height); i++) {
|
||||
unsigned char tmp0, tmp1;
|
||||
tmp0 = *src++;
|
||||
tmp1 = *src++;
|
||||
*dst++ = *src++;
|
||||
*dst++ = tmp1;
|
||||
*dst++ = tmp0;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_swap_uv(const unsigned char *src, unsigned char *dest,
|
||||
const struct v4l2_format *src_fmt)
|
||||
{
|
||||
unsigned int y;
|
||||
|
||||
/* Copy Y */
|
||||
for (y = 0; y < src_fmt->fmt.pix.height; y++) {
|
||||
memcpy(dest, src, src_fmt->fmt.pix.width);
|
||||
dest += src_fmt->fmt.pix.width;
|
||||
src += src_fmt->fmt.pix.bytesperline;
|
||||
}
|
||||
|
||||
/* Copy component 2 */
|
||||
src += src_fmt->fmt.pix.height * src_fmt->fmt.pix.bytesperline / 4;
|
||||
for (y = 0; y < src_fmt->fmt.pix.height / 2; y++) {
|
||||
memcpy(dest, src, src_fmt->fmt.pix.width / 2);
|
||||
dest += src_fmt->fmt.pix.width / 2;
|
||||
src += src_fmt->fmt.pix.bytesperline / 2;
|
||||
}
|
||||
|
||||
/* Copy component 1 */
|
||||
src -= src_fmt->fmt.pix.height * src_fmt->fmt.pix.bytesperline / 2;
|
||||
for (y = 0; y < src_fmt->fmt.pix.height / 2; y++) {
|
||||
memcpy(dest, src, src_fmt->fmt.pix.width / 2);
|
||||
dest += src_fmt->fmt.pix.width / 2;
|
||||
src += src_fmt->fmt.pix.bytesperline / 2;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_rgb565_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height)
|
||||
{
|
||||
int j;
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j < width; j++) {
|
||||
unsigned short tmp = *(unsigned short *)src;
|
||||
|
||||
/* Original format: rrrrrggg gggbbbbb */
|
||||
*dest++ = 0xf8 & (tmp >> 8);
|
||||
*dest++ = 0xfc & (tmp >> 3);
|
||||
*dest++ = 0xf8 & (tmp << 3);
|
||||
|
||||
src += 2;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_rgb565_to_bgr24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height)
|
||||
{
|
||||
int j;
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j < width; j++) {
|
||||
unsigned short tmp = *(unsigned short *)src;
|
||||
|
||||
/* Original format: rrrrrggg gggbbbbb */
|
||||
*dest++ = 0xf8 & (tmp << 3);
|
||||
*dest++ = 0xfc & (tmp >> 3);
|
||||
*dest++ = 0xf8 & (tmp >> 8);
|
||||
|
||||
src += 2;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_rgb565_to_yuv420(const unsigned char *src, unsigned char *dest,
|
||||
const struct v4l2_format *src_fmt, int yvu)
|
||||
{
|
||||
unsigned int x, y;
|
||||
unsigned short tmp;
|
||||
unsigned char *udest, *vdest;
|
||||
unsigned r[4], g[4], b[4];
|
||||
int avg_src[3];
|
||||
|
||||
/* Y */
|
||||
for (y = 0; y < src_fmt->fmt.pix.height; y++) {
|
||||
for (x = 0; x < src_fmt->fmt.pix.width; x++) {
|
||||
tmp = *(unsigned short *)src;
|
||||
r[0] = 0xf8 & (tmp << 3);
|
||||
g[0] = 0xfc & (tmp >> 3);
|
||||
b[0] = 0xf8 & (tmp >> 8);
|
||||
RGB2Y(r[0], g[0], b[0], *dest++);
|
||||
src += 2;
|
||||
}
|
||||
src += src_fmt->fmt.pix.bytesperline - 2 * src_fmt->fmt.pix.width;
|
||||
}
|
||||
src -= src_fmt->fmt.pix.height * src_fmt->fmt.pix.bytesperline;
|
||||
|
||||
/* U + V */
|
||||
if (yvu) {
|
||||
vdest = dest;
|
||||
udest = dest + src_fmt->fmt.pix.width * src_fmt->fmt.pix.height / 4;
|
||||
} else {
|
||||
udest = dest;
|
||||
vdest = dest + src_fmt->fmt.pix.width * src_fmt->fmt.pix.height / 4;
|
||||
}
|
||||
|
||||
for (y = 0; y < src_fmt->fmt.pix.height / 2; y++) {
|
||||
for (x = 0; x < src_fmt->fmt.pix.width / 2; x++) {
|
||||
tmp = *(unsigned short *)src;
|
||||
r[0] = 0xf8 & (tmp << 3);
|
||||
g[0] = 0xfc & (tmp >> 3);
|
||||
b[0] = 0xf8 & (tmp >> 8);
|
||||
|
||||
tmp = *(((unsigned short *)src) + 1);
|
||||
r[1] = 0xf8 & (tmp << 3);
|
||||
g[1] = 0xfc & (tmp >> 3);
|
||||
b[1] = 0xf8 & (tmp >> 8);
|
||||
|
||||
tmp = *(((unsigned short *)src) + src_fmt->fmt.pix.bytesperline);
|
||||
r[2] = 0xf8 & (tmp << 3);
|
||||
g[2] = 0xfc & (tmp >> 3);
|
||||
b[2] = 0xf8 & (tmp >> 8);
|
||||
|
||||
tmp = *(((unsigned short *)src) + src_fmt->fmt.pix.bytesperline + 1);
|
||||
r[3] = 0xf8 & (tmp << 3);
|
||||
g[3] = 0xfc & (tmp >> 3);
|
||||
b[3] = 0xf8 & (tmp >> 8);
|
||||
|
||||
avg_src[0] = (r[0] + r[1] + r[2] + r[3]) / 4;
|
||||
avg_src[1] = (g[0] + g[1] + g[2] + g[3]) / 4;
|
||||
avg_src[2] = (b[0] + b[1] + b[2] + b[3]) / 4;
|
||||
RGB2UV(avg_src[0], avg_src[1], avg_src[2], *udest++, *vdest++);
|
||||
src += 4;
|
||||
}
|
||||
src += 2 * src_fmt->fmt.pix.bytesperline - 2 * src_fmt->fmt.pix.width;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_y16_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int little_endian)
|
||||
{
|
||||
int j;
|
||||
|
||||
if (little_endian)
|
||||
src++;
|
||||
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j < width; j++) {
|
||||
*dest++ = *src;
|
||||
*dest++ = *src;
|
||||
*dest++ = *src;
|
||||
src+=2;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_y16_to_yuv420(const unsigned char *src, unsigned char *dest,
|
||||
const struct v4l2_format *src_fmt, int little_endian)
|
||||
{
|
||||
unsigned int x, y;
|
||||
|
||||
if (little_endian)
|
||||
src++;
|
||||
|
||||
/* Y */
|
||||
for (y = 0; y < src_fmt->fmt.pix.height; y++)
|
||||
for (x = 0; x < src_fmt->fmt.pix.width; x++){
|
||||
*dest++ = *src;
|
||||
src+=2;
|
||||
}
|
||||
|
||||
/* Clear U/V */
|
||||
memset(dest, 0x80, src_fmt->fmt.pix.width * src_fmt->fmt.pix.height / 2);
|
||||
}
|
||||
|
||||
void v4lconvert_grey_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height)
|
||||
{
|
||||
int j;
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j < width; j++) {
|
||||
*dest++ = *src;
|
||||
*dest++ = *src;
|
||||
*dest++ = *src;
|
||||
src++;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_grey_to_yuv420(const unsigned char *src, unsigned char *dest,
|
||||
const struct v4l2_format *src_fmt)
|
||||
{
|
||||
unsigned int x, y;
|
||||
|
||||
/* Y */
|
||||
for (y = 0; y < src_fmt->fmt.pix.height; y++)
|
||||
for (x = 0; x < src_fmt->fmt.pix.width; x++)
|
||||
*dest++ = *src++;
|
||||
|
||||
/* Clear U/V */
|
||||
memset(dest, 0x80, src_fmt->fmt.pix.width * src_fmt->fmt.pix.height / 2);
|
||||
}
|
||||
|
||||
/* Unpack buffer of (vw bit) data into padded 16bit buffer. */
|
||||
static inline void convert_packed_to_16bit(const uint8_t *raw, uint16_t *unpacked,
|
||||
int vw, int unpacked_len)
|
||||
{
|
||||
int mask = (1 << vw) - 1;
|
||||
uint32_t buffer = 0;
|
||||
int bitsIn = 0;
|
||||
while (unpacked_len--) {
|
||||
while (bitsIn < vw) {
|
||||
buffer = (buffer << 8) | *(raw++);
|
||||
bitsIn += 8;
|
||||
}
|
||||
bitsIn -= vw;
|
||||
*(unpacked++) = (buffer >> bitsIn) & mask;
|
||||
}
|
||||
}
|
||||
|
||||
int v4lconvert_y10b_to_rgb24(struct v4lconvert_data *data,
|
||||
const unsigned char *src, unsigned char *dest, int width, int height)
|
||||
{
|
||||
unsigned char *unpacked_buffer;
|
||||
|
||||
unpacked_buffer = v4lconvert_alloc_buffer(width * height * 2,
|
||||
&data->convert_pixfmt_buf,
|
||||
&data->convert_pixfmt_buf_size);
|
||||
if (!unpacked_buffer)
|
||||
return v4lconvert_oom_error(data);
|
||||
|
||||
convert_packed_to_16bit((uint8_t *)src, (uint16_t *)unpacked_buffer,
|
||||
10, width * height);
|
||||
|
||||
int j;
|
||||
unsigned short *tmp = (unsigned short *)unpacked_buffer;
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j < width; j++) {
|
||||
|
||||
/* Only 10 useful bits, so we discard the LSBs */
|
||||
*dest++ = (*tmp & 0x3ff) >> 2;
|
||||
*dest++ = (*tmp & 0x3ff) >> 2;
|
||||
*dest++ = (*tmp & 0x3ff) >> 2;
|
||||
|
||||
/* +1 means two bytes as we are dealing with (unsigned short) */
|
||||
tmp += 1;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
int v4lconvert_y10b_to_yuv420(struct v4lconvert_data *data,
|
||||
const unsigned char *src, unsigned char *dest, int width, int height)
|
||||
{
|
||||
unsigned char *unpacked_buffer;
|
||||
|
||||
unpacked_buffer = v4lconvert_alloc_buffer(width * height * 2,
|
||||
&data->convert_pixfmt_buf,
|
||||
&data->convert_pixfmt_buf_size);
|
||||
if (!unpacked_buffer)
|
||||
return v4lconvert_oom_error(data);
|
||||
|
||||
convert_packed_to_16bit((uint8_t *)src, (uint16_t *)unpacked_buffer,
|
||||
10, width * height);
|
||||
|
||||
int x, y;
|
||||
unsigned short *tmp = (unsigned short *)unpacked_buffer;
|
||||
|
||||
/* Y */
|
||||
for (y = 0; y < height; y++)
|
||||
for (x = 0; x < width; x++) {
|
||||
|
||||
/* Only 10 useful bits, so we discard the LSBs */
|
||||
*dest++ = (*tmp & 0x3ff) >> 2;
|
||||
|
||||
/* +1 means two bytes as we are dealing with (unsigned short) */
|
||||
tmp += 1;
|
||||
}
|
||||
|
||||
/* Clear U/V */
|
||||
memset(dest, 0x80, width * height / 2);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void v4lconvert_rgb32_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height,int bgr)
|
||||
{
|
||||
int j;
|
||||
while (--height >= 0) {
|
||||
for (j = 0; j < width; j++) {
|
||||
if (bgr){
|
||||
*dest++ = src[2];
|
||||
*dest++ = src[1];
|
||||
*dest++ = src[0];
|
||||
src+=4;
|
||||
}
|
||||
else{
|
||||
*dest++ = *src++;
|
||||
*dest++ = *src++;
|
||||
*dest++ = *src++;
|
||||
src+=1;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user