openmv/lib/imlib/yuv.c
iabdalkader daf2bb30da misc: Restructure repo.
Signed-off-by: iabdalkader <i.abdalkader@gmail.com>
2025-04-13 08:28:34 +02:00

149 lines
5.2 KiB
C

/*
* SPDX-License-Identifier: MIT
*
* Copyright (C) 2013-2024 OpenMV, LLC.
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*
* Deyuv Functions
*/
#include "imlib.h"
pixformat_t imlib_yuv_shift(pixformat_t pixfmt, int x) {
if (x % 2) {
return (pixfmt == PIXFORMAT_YUV422) ? PIXFORMAT_YVU422 : PIXFORMAT_YUV422;
}
return pixfmt;
}
void imlib_deyuv_line(int x_start, int x_end, int y_row, void *dst_row_ptr, pixformat_t pixfmt, image_t *src) {
int shift = (src->pixfmt == PIXFORMAT_YUV422) ? 16 : 0;
int src_w = src->w, w_limit = src_w - 1;
uint16_t *rowptr_yuv = ((uint16_t *) src->data) + (y_row * src_w);
// If the image is an odd width this will go for the last loop and we drop the last column.
for (int x = x_start; x < x_end; x += 2) {
int32_t row_yuv; // signed
// keep pixels in bounds
if (x >= w_limit) {
if (src_w >= 2) {
uint32_t temp = *((uint32_t *) (rowptr_yuv + x - 1));
row_yuv = ((temp & 0xff00) << 16) | (temp & 0xff0000) | (temp >> 16);
} else {
row_yuv = *((uint16_t *) (rowptr_yuv + x));
row_yuv = ((row_yuv & 0xff) << 16) | 0x80000000;
}
} else {
row_yuv = *((uint32_t *) (rowptr_yuv + x));
}
int y0 = row_yuv & 0xff, y1 = (row_yuv >> 16) & 0xff;
switch (pixfmt) {
case PIXFORMAT_BINARY: {
uint32_t *row_ptr_32 = (uint32_t *) dst_row_ptr;
IMAGE_PUT_BINARY_PIXEL_FAST(row_ptr_32, x, (y0 >> 7));
if (x != w_limit) {
IMAGE_PUT_BINARY_PIXEL_FAST(row_ptr_32, x + 1, (y1 >> 7));
}
break;
}
case PIXFORMAT_GRAYSCALE: {
uint8_t *row_ptr_8 = (uint8_t *) dst_row_ptr;
IMAGE_PUT_GRAYSCALE_PIXEL_FAST(row_ptr_8, x, y0);
if (x != w_limit) {
IMAGE_PUT_GRAYSCALE_PIXEL_FAST(row_ptr_8, x + 1, y1);
}
break;
}
case PIXFORMAT_RGB565: {
uint16_t *row_ptr_16 = (uint16_t *) dst_row_ptr;
// R = Y + (1.40200 * U)
// G = Y - (0.34414 * V) - (0.71414 * U)
// B = Y + (1.77200 * V)
// R = Y + ((179 * U) >> 7)
// G = Y - (((44 * V) - (91 * U)) >> 7)
// B = Y + ((227 * V) >> 7)
row_yuv ^= 0x80008000;
int u = (row_yuv << shift) >> 24; // signed bit extraction
int v = (row_yuv << (16 - shift)) >> 24; // signed bit extraction
int ry = (179 * u) >> 7;
int gy = ((44 * v) + (91 * u)) >> 7;
int by = (227 * v) >> 7;
int r0 = y0 + ry, g0 = y0 - gy, b0 = y0 + by;
r0 = __USAT(r0, 8);
g0 = __USAT(g0, 8);
b0 = __USAT(b0, 8);
int rgb565_0 = COLOR_R8_G8_B8_TO_RGB565(r0, g0, b0);
IMAGE_PUT_RGB565_PIXEL_FAST(row_ptr_16, x, rgb565_0);
if (x != w_limit) {
int r1 = y1 + ry, g1 = y1 - gy, b1 = y1 + by;
r1 = __USAT(r1, 8);
g1 = __USAT(g1, 8);
b1 = __USAT(b1, 8);
int rgb565_1 = COLOR_R8_G8_B8_TO_RGB565(r1, g1, b1);
IMAGE_PUT_RGB565_PIXEL_FAST(row_ptr_16, x + 1, rgb565_1);
}
break;
}
default: {
break;
}
}
}
}
void imlib_deyuv_image(image_t *dst, image_t *src) {
for (int y = 0, src_w = src->w, src_h = src->h; y < src_h; y++) {
void *row_ptr = NULL;
switch (dst->pixfmt) {
case PIXFORMAT_BINARY: {
row_ptr = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(dst, y);
break;
}
case PIXFORMAT_GRAYSCALE: {
row_ptr = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(dst, y);
break;
}
case PIXFORMAT_RGB565: {
row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(dst, y);
break;
}
}
imlib_deyuv_line(0, src_w, y, row_ptr, dst->pixfmt, src);
}
}