mirror of
git://nv-tegra.nvidia.com/tegra/v4l2-src/v4l2_libs.git
synced 2025-12-22 17:39:13 +03:00
Updating prebuilts and/or headers
f07563fa1628a75c578152387638b1f217f730be - libv4lconvert/Makefile 6ac3c887c56c7d4345499cb5b7bfac9579a57d16 - libv4lconvert/cpia1.c 2d385802ec3690e78a961ce95431e98eb3f5fc6a - libv4lconvert/rgbyuv.c 43843cbdb81f3efee5873f5ed25ae1eb7745a9e5 - libv4lconvert/libv4lconvert-priv.h 002783c808dc565478c18bd27373792028264bb6 - libv4lconvert/ov518-decomp.c 4d49e6e897046e66e41c3563fec2eb2562abf813 - libv4lconvert/jpeg_memsrcdest.c a38fdb4c79518e972678745c93cd62881d72972b - libv4lconvert/Makefile.dGPU e9f783fb933606224252dfd3093afa36490f6f4c - libv4lconvert/Makefile.in 52900601a24ee9ffea87ca7fe6651e912e20235e - libv4lconvert/libv4lsyscall-priv.h d37f854500cbd759ad93ae89c6aa75c00b000931 - libv4lconvert/bayer.c 2cd1b994bb7999d0c08c19b1a2efd11707250852 - libv4lconvert/helper.c adac14b8826d05ddab33d595a803e92eaf84b797 - libv4lconvert/Makefile.am 6e806290f6e426c881322d362f189fa7b9e2f917 - libv4lconvert/sn9c10x.c ba44b6ac00a643e6df484f3172022e1b2628c0cc - libv4lconvert/jpgl.c fa06343de31dcf6d3d5862cc278396272fa838c4 - libv4lconvert/se401.c 4bd081bf25b63f5463d582ef36f77ba5e3711d0d - libv4lconvert/sq905c.c 940250beb5898bf254e7cd1ef9d7950a8db10af6 - libv4lconvert/mr97310a.c 5e177c3a7c157c25c4afcae031e79830237510f6 - libv4lconvert/libv4lconvert.c 1f362080c319355070cf409cfccf28d8c68d024e - libv4lconvert/sn9c2028-decomp.c 703ce22dc98d834490c7aa23ae73b9113e386221 - libv4lconvert/sn9c20x.c 018e503969b2e06a0ea639fc08f03a7476cc15b5 - libv4lconvert/jpeg_memsrcdest.h fb3344cfa8df97688332ee4fd3b17968437e8ad5 - libv4lconvert/helper-funcs.h d378cbdd377027e7528af47362a94ccb1ae15da3 - libv4lconvert/libv4lconvert.export 61710972d4e9bfcd00490c563d1bb5bde5480c9e - libv4lconvert/tinyjpeg.c 231571db9f8caa6fdc68138102029127a6b93812 - libv4lconvert/crop.c d62448a06539ecf6e3daae7faa299b6da8878054 - libv4lconvert/pac207.c 72b65c9f0f3c87dcae86a2afbea65a76f2c6bafd - libv4lconvert/tinyjpeg-internal.h a016f896e0e9f0cd8af7447b52651ed14c5a5b29 - libv4lconvert/jpeg.c 608a4c341a5df9daea647fbddc415cdaf27b0482 - libv4lconvert/spca561-decompress.c b03b32eae024bf59b6ceaf6b6d342383cd0b0673 - libv4lconvert/jl2005bcd.c 803c4d0b9364050eda163452b8792e62e221ab6d - libv4lconvert/tinyjpeg.h 2df34af8f9d747fb0e5c7c71954c788aff1c483f - libv4lconvert/stv0680.c 3e8e6c1fb85e3c4b58c4e9b2b0a223ddc793edcb - libv4lconvert/libv4lconvert.pc.in 02aa2e7d12b72fe4ce79cdf4009da61f35091e94 - libv4lconvert/flip.c 05038ef9efab175322a12d3d6620dba6298aa2a9 - libv4lconvert/spca501.c b2c19c2eac71d39d3fb883cdc159a69c2afa8fd6 - libv4lconvert/ov511-decomp.c 1d9c446cd8a232da87bd79acebc93e018ec72499 - libv4lconvert/jidctflt.c ed215eca170d07a6838be3796aad933adf89ece2 - libv4lconvert/hm12.c 193e9d2c997e21ce8ca02f25050fb8d2d62b6bfd - libv4lconvert/processing/autogain.c c894d4a9b9e0f95be9e7bade4f7f734ae0c6996c - libv4lconvert/processing/libv4lprocessing.c 4158e9c3d21cf0a064b99bdf8571df4f3ba6d5bb - libv4lconvert/processing/whitebalance.c be34baf0d2ce1374c841494ba27ccc352c444e98 - libv4lconvert/processing/gamma.c b48edcb4036ee5f4e77e9cb49dd1b52b1e7f2427 - libv4lconvert/processing/libv4lprocessing.h 967d27c0e09849338a69dc4b5647d1824f2cd2fb - libv4lconvert/processing/libv4lprocessing-priv.h 9f382ff1f2895b926f3596e0a8ae7637b5e6a2ac - libv4lconvert/control/libv4lcontrol.c 8c523bd3838004a4fa00430a38cbc6dbaa47286f - libv4lconvert/control/libv4lcontrol.h 4ce5e891af7857a3504d1350ef13015997dde62a - libv4lconvert/control/libv4lcontrol-priv.h bda0c1296aad2b3b178a76f38e26c20ce3b81233 - include/libv4l1.h a95818658d95c1602f2422e5f1fb54b9ca70536e - include/libv4l2rds.h 2d1932763a064ef1176450b1bb4dd242aa3c77bb - include/libv4lconvert.h 3517bc15e30852ad01ad9966ec7111a16a2263df - include/libv4l2.h 944cd9bc32420e73da3a7d3cb1d0ce707263c9f0 - include/libv4l1-videodev.h 7d9d199f4e6f4ba6f0d669ee5decd74355507137 - include/libv4l-plugin.h cfeaf0c16571e0c64bce50bcb8a6cd8d8c976187 - include/config.h d7d4fd219e36edadc17837bff78eb8323e2a115e - include/libdvbv5/libdvb-version.h 33071176eda60242f39927e572ac6b1c1bab32e2 - include/libdvbv5/desc_event_extended.h 29c2cd2554e4f4285ab8709e6eace38046d8ecdc - include/libdvbv5/desc_t2_delivery.h b42819db457bc6a23324faf259c0db1104741d99 - include/libdvbv5/dvb-scan.h bae10c2fa28bb522e9fc0bb5e4b0128ab6f90e65 - include/libdvbv5/desc_partial_reception.h f797ddac8e1adc6b29750f076df0f3a23cf630eb - include/libdvbv5/dvb-v5-std.h 48079dcae511070a8eeb55b004bd8ac06735ecc7 - include/libdvbv5/desc_ca.h f4eb8b615b7c5a245c76e3f448e6cd848d8cf765 - include/libdvbv5/desc_cable_delivery.h 170a50b570691975e0ff22faffeb0131fc47c7c8 - include/libdvbv5/desc_logical_channel.h c8f11e89456fc078c607d424e887babe72cd3684 - include/libdvbv5/nit.h d39a24d0d0a0fbe732881dd2734b10d842d88de9 - include/libdvbv5/header.h badc03677ddbcfa1d1188ddaaa4c272fccfe4a21 - include/libdvbv5/desc_atsc_service_location.h d3bad046037cad4a95778555021a1a1a6b3040d9 - include/libdvbv5/cat.h a614739513f62affb1059df81c064203d9fe2fcd - include/libdvbv5/desc_ca_identifier.h 6d70f699eb912c974dc06a19f9bdcb7dd0c27932 - include/libdvbv5/desc_service.h 0eda1161b34ca39b8528bc53d05fb0fc7d457f80 - include/libdvbv5/desc_frequency_list.h 22f6b663d50de467539201ecfdb363e9252c88bd - include/libdvbv5/atsc_eit.h 1c1292f060664abf6c12273a41b2bf6f704dd19b - include/libdvbv5/desc_sat.h 22de6de5e65530aa1ab38a2373db128e81983a4c - include/libdvbv5/desc_network_name.h 91178a5945e63c81051b57b7b2842139947a3b39 - include/libdvbv5/desc_extension.h 9ca776ad159cf84b2f68101bf279472741829047 - include/libdvbv5/descriptors.h fa7e8d5e996310e1dd47d5467780d533c8a93ad8 - include/libdvbv5/dvb-dev.h fed6115825c5b23e1e31ff80aab997f0a7b6c3fc - include/libdvbv5/sdt.h 4b892acd2ce77c060b50cf67f5faf9dc9b76edbb - include/libdvbv5/dvb-frontend.h 8b9f9e00f7bcdce58aef1d8d7234567af82e49b8 - include/libdvbv5/dvb-file.h b8a077b8e3c6e337223fc37685d217a81df112f1 - include/libdvbv5/dvb-demux.h 01a0afbe1a4f41cf58f9ce47d65b31e3df7c8680 - include/libdvbv5/pat.h 4a49c8b46947be16356d6355aa36d72d7baa946c - include/libdvbv5/vct.h c83200debc98ff8fa82030d36371a2caa230281a - include/libdvbv5/desc_language.h 21cea15c5d4faff2726f18bdf5b83e2210d472c4 - include/libdvbv5/mpeg_pes.h 825f75350da9fb148acc7d36af513da977105169 - include/libdvbv5/desc_isdbt_delivery.h 8f60bf43907b1eac3c1c2f031cf68a9bdebb3662 - include/libdvbv5/desc_ts_info.h 89cbb75f3e0952e4dfb145fdea776b45e05b7e76 - include/libdvbv5/desc_hierarchy.h 5c80a7ee23d1da2c91f60e79f7292248694b4f65 - include/libdvbv5/crc32.h 93b7b27ccc89e1ad4279eb12560e1dfc3d2ff1eb - include/libdvbv5/dvb-fe.h aeeb75989de4b2ecafa1b2fc5ed30787999eec1b - include/libdvbv5/mpeg_es.h dc684983365ffef353993faad0b105bcb87f4218 - include/libdvbv5/desc_event_short.h 5e3be50d1292109d59c80f920ba1b7a4bcbbdf56 - include/libdvbv5/eit.h f95a0206952db4cce561455accad66a37f9a4104 - include/libdvbv5/mgt.h 88f8c78bbaf22b345e2ccb68e9b787e649dac2c1 - include/libdvbv5/libdvb-version.h.in 74a66644980a66adeba21ecc40ebefa2b4480e25 - include/libdvbv5/pmt.h 7671f125c6f61eef85f55eb314097435b3772431 - include/libdvbv5/dvb-sat.h 26fd40a10548cdb9bd4aafdda4486f9d39fd5c9e - include/libdvbv5/countries.h 65db3beaf2ec19a43a870b2759e6aecb15a95c7b - include/libdvbv5/atsc_header.h 149f7eb3c71b8f65127d3c4f2143080b115697e5 - include/libdvbv5/desc_terrestrial_delivery.h 708af2b77b2c94ee9cf593b31e20471c80ea556b - include/libdvbv5/mpeg_ts.h ba205468e43ca16edf1ebec59dce9822044c1064 - include/libdvbv5/desc_registration_id.h e70b24d8d1f3a248735c2d724d3b92c49b7aaba5 - include/libdvbv5/dvb-log.h 2d0557eadd4cff02ab52e26778d35b6c34f09158 - libv4l2/libv4l2-priv.h 487af43db163be6d3604371b9a504c1df2a9bf6c - libv4l2/v4l2-plugin-android.c 0ac38b46fa1659db4c05660205f212389295e7ff - libv4l2/Makefile 8ac3789333a6cd18e7f35d3b66a8a4d0293feb78 - libv4l2/Makefile.dGPU fdd6e5e27aa8b41d5da77cb3b9be3fc3b8a44763 - libv4l2/libv4l2.export 1d37e5ea9231e7e0eea7d1a02938c6d1ae8ba791 - libv4l2/Makefile.in 51892a60925c37c865fe6eb9c923a552df180ebf - libv4l2/v4l2-plugin.c d4c7daee644a35244ac8a5e1009a3aeb1d4fd3da - libv4l2/Makefile.am 87856c7113d150dceb254b5d548f942e7fcaf8f1 - libv4l2/libv4l2.c d11ec5b8ce8390a72fd61457d7b8667378311191 - libv4l2/log.c cbcee4426c19c168c6f49d04af3a0b2e30c0b681 - libv4l2/libv4l2.pc.in 55bb16d05817a3ecf076174175b2ca5b56e729d8 - libv4l2/v4l2convert.c Change-Id: I92b00c7d65c1689c9d6ff337a6f2ae790e88a7cb
This commit is contained in:
svcmobrel-release
906
libv4lconvert/rgbyuv.c
Normal file
906
libv4lconvert/rgbyuv.c
Normal file
@@ -0,0 +1,906 @@
|
||||
/*
|
||||
|
||||
# RGB <-> YUV conversion routines
|
||||
# (C) 2008 Hans de Goede <hdegoede@redhat.com>
|
||||
|
||||
# RGB565 conversion routines
|
||||
# (C) 2009 Mauro Carvalho Chehab
|
||||
|
||||
# SPDX-FileCopyrightText: Copyright (c) 2024 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
|
||||
# SPDX-License-Identifier: LGPL-2.1-or-later
|
||||
#
|
||||
# This program is free software; you can redistribute it and/or modify
|
||||
# it under the terms of the GNU Lesser General Public License as published by
|
||||
# the Free Software Foundation; either version 2.1 of the License, or
|
||||
# (at your option) any later version.
|
||||
#
|
||||
# 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_nv16_to_yuyv(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height)
|
||||
{
|
||||
const unsigned char *y, *cbcr;
|
||||
int count = 0;
|
||||
|
||||
y = src;
|
||||
cbcr = src + width*height;
|
||||
|
||||
while (count++ < width*height) {
|
||||
*dest++ = *y++;
|
||||
*dest++ = *cbcr++;
|
||||
}
|
||||
}
|
||||
|
||||
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;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void hsvtorgb(const unsigned char *hsv, unsigned char *rgb,
|
||||
unsigned char hsv_enc)
|
||||
{
|
||||
/* From http://stackoverflow.com/questions/3018313/ */
|
||||
uint8_t region;
|
||||
uint8_t remain;
|
||||
uint8_t p, q, t;
|
||||
|
||||
if (!hsv[1]) {
|
||||
rgb[0] = rgb[1] = rgb[2] = hsv[2];
|
||||
return;
|
||||
}
|
||||
|
||||
if (hsv_enc == V4L2_HSV_ENC_256) {
|
||||
region = hsv[0] / 43;
|
||||
remain = (hsv[0] - (region * 43)) * 6;
|
||||
|
||||
} else {
|
||||
int aux;
|
||||
|
||||
region = hsv[0] / (180/6);
|
||||
|
||||
/* Remain must be scaled to 0..255 */
|
||||
aux = (hsv[0] % (180/6)) * 6 * 256;
|
||||
aux /= 180;
|
||||
remain = aux;
|
||||
}
|
||||
|
||||
p = (hsv[2] * (255 - hsv[1])) >> 8;
|
||||
q = (hsv[2] * (255 - ((hsv[1] * remain) >> 8))) >> 8;
|
||||
t = (hsv[2] * (255 - ((hsv[1] * (255 - remain)) >> 8))) >> 8;
|
||||
|
||||
switch (region) {
|
||||
case 0:
|
||||
rgb[0] = hsv[2]; rgb[1] = t; rgb[2] = p;
|
||||
break;
|
||||
case 1:
|
||||
rgb[0] = q; rgb[1] = hsv[2]; rgb[2] = p;
|
||||
break;
|
||||
case 2:
|
||||
rgb[0] = p; rgb[1] = hsv[2]; rgb[2] = t;
|
||||
break;
|
||||
case 3:
|
||||
rgb[0] = p; rgb[1] = q; rgb[2] = hsv[2];
|
||||
break;
|
||||
case 4:
|
||||
rgb[0] = t; rgb[1] = p; rgb[2] = hsv[2];
|
||||
break;
|
||||
default:
|
||||
rgb[0] = hsv[2]; rgb[1] = p; rgb[2] = q;
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void v4lconvert_hsv_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int bgr, int Xin, unsigned char hsv_enc){
|
||||
int j, k;
|
||||
int bppIN = Xin / 8;
|
||||
unsigned char rgb[3];
|
||||
|
||||
src += bppIN - 3;
|
||||
|
||||
while (--height >= 0)
|
||||
for (j = 0; j < width; j++) {
|
||||
hsvtorgb(src, rgb, hsv_enc);
|
||||
for (k = 0; k < 3; k++)
|
||||
if (bgr && k < 3)
|
||||
*dest++ = rgb[2-k];
|
||||
else
|
||||
*dest++ = rgb[k];
|
||||
src += bppIN;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_nv12_to_rgb24(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int bgr)
|
||||
{
|
||||
int i, j;
|
||||
const unsigned char *ysrc = src;
|
||||
const unsigned char *uvsrc = src + width * height;
|
||||
|
||||
for (i = 0; i < height; i++) {
|
||||
for (j = 0; j < width; j ++) {
|
||||
if (bgr) {
|
||||
*dest++ = YUV2B(*ysrc, *uvsrc, *(uvsrc + 1));
|
||||
*dest++ = YUV2G(*ysrc, *uvsrc, *(uvsrc + 1));
|
||||
*dest++ = YUV2R(*ysrc, *uvsrc, *(uvsrc + 1));
|
||||
} else {
|
||||
*dest++ = YUV2R(*ysrc, *uvsrc, *(uvsrc + 1));
|
||||
*dest++ = YUV2G(*ysrc, *uvsrc, *(uvsrc + 1));
|
||||
*dest++ = YUV2B(*ysrc, *uvsrc, *(uvsrc + 1));
|
||||
}
|
||||
ysrc++;
|
||||
if (j&1)
|
||||
uvsrc += 2;
|
||||
}
|
||||
|
||||
/* Rewind u and v for next line */
|
||||
if (!(i&1))
|
||||
uvsrc -= width;
|
||||
}
|
||||
}
|
||||
|
||||
void v4lconvert_nv12_to_yuv420(const unsigned char *src, unsigned char *dest,
|
||||
int width, int height, int yvu)
|
||||
{
|
||||
int i, j;
|
||||
const unsigned char *ysrc = src;
|
||||
const unsigned char *uvsrc = src + width * height;
|
||||
unsigned char *ydst = dest;
|
||||
unsigned char *udst, *vdst;
|
||||
|
||||
if (yvu) {
|
||||
vdst = ydst + width * height;
|
||||
udst = vdst + ((width / 2) * (height / 2));
|
||||
} else {
|
||||
udst = ydst + width * height;
|
||||
vdst = udst + ((width / 2) * (height / 2));
|
||||
}
|
||||
|
||||
for (i = 0; i < height; i++)
|
||||
for (j = 0; j < width; j++) {
|
||||
*ydst++ = *ysrc++;
|
||||
if (((i % 2) == 0) && ((j % 2) == 0)) {
|
||||
*udst++ = *uvsrc++;
|
||||
*vdst++ = *uvsrc++;
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user