mirror of
https://github.com/openmv/openmv.git
synced 2025-09-26 23:09:13 +08:00
149 lines
5.2 KiB
C
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);
|
|
}
|
|
}
|