mirror of
				https://github.com/Ryujinx/SDL.git
				synced 2025-11-04 15:14:56 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			299 lines
		
	
	
		
			8.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			299 lines
		
	
	
		
			8.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
  Copyright (C) 1997-2023 Sam Lantinga <slouken@libsdl.org>
 | 
						|
 | 
						|
  This software is provided 'as-is', without any express or implied
 | 
						|
  warranty.  In no event will the authors be held liable for any damages
 | 
						|
  arising from the use of this software.
 | 
						|
 | 
						|
  Permission is granted to anyone to use this software for any purpose,
 | 
						|
  including commercial applications, and to alter it and redistribute it
 | 
						|
  freely.
 | 
						|
*/
 | 
						|
 | 
						|
#include "SDL.h"
 | 
						|
 | 
						|
#include "testyuv_cvt.h"
 | 
						|
 | 
						|
static float clip3(float x, float y, float z)
 | 
						|
{
 | 
						|
    return (z < x) ? x : ((z > y) ? y : z);
 | 
						|
}
 | 
						|
 | 
						|
static void RGBtoYUV(const Uint8 *rgb, int *yuv, SDL_YUV_CONVERSION_MODE mode, int monochrome, int luminance)
 | 
						|
{
 | 
						|
    if (mode == SDL_YUV_CONVERSION_JPEG) {
 | 
						|
        /* Full range YUV */
 | 
						|
        yuv[0] = (int)(0.299 * rgb[0] + 0.587 * rgb[1] + 0.114 * rgb[2]);
 | 
						|
        yuv[1] = (int)((rgb[2] - yuv[0]) * 0.565 + 128);
 | 
						|
        yuv[2] = (int)((rgb[0] - yuv[0]) * 0.713 + 128);
 | 
						|
    } else {
 | 
						|
        // This formula is from Microsoft's documentation:
 | 
						|
        // https://msdn.microsoft.com/en-us/library/windows/desktop/dd206750(v=vs.85).aspx
 | 
						|
        // L = Kr * R + Kb * B + (1 - Kr - Kb) * G
 | 
						|
        // Y =                   SDL_floor(2^(M-8) * (219*(L-Z)/S + 16) + 0.5);
 | 
						|
        // U = clip3(0, (2^M)-1, SDL_floor(2^(M-8) * (112*(B-L) / ((1-Kb)*S) + 128) + 0.5));
 | 
						|
        // V = clip3(0, (2^M)-1, SDL_floor(2^(M-8) * (112*(R-L) / ((1-Kr)*S) + 128) + 0.5));
 | 
						|
        float S, Z, R, G, B, L, Kr, Kb, Y, U, V;
 | 
						|
 | 
						|
        if (mode == SDL_YUV_CONVERSION_BT709) {
 | 
						|
            /* BT.709 */
 | 
						|
            Kr = 0.2126f;
 | 
						|
            Kb = 0.0722f;
 | 
						|
        } else {
 | 
						|
            /* BT.601 */
 | 
						|
            Kr = 0.299f;
 | 
						|
            Kb = 0.114f;
 | 
						|
        }
 | 
						|
 | 
						|
        S = 255.0f;
 | 
						|
        Z = 0.0f;
 | 
						|
        R = rgb[0];
 | 
						|
        G = rgb[1];
 | 
						|
        B = rgb[2];
 | 
						|
        L = Kr * R + Kb * B + (1 - Kr - Kb) * G;
 | 
						|
        Y = (Uint8)SDL_floorf((219 * (L - Z) / S + 16) + 0.5f);
 | 
						|
        U = (Uint8)clip3(0, 255, SDL_floorf((112.0f * (B - L) / ((1.0f - Kb) * S) + 128) + 0.5f));
 | 
						|
        V = (Uint8)clip3(0, 255, SDL_floorf((112.0f * (R - L) / ((1.0f - Kr) * S) + 128) + 0.5f));
 | 
						|
 | 
						|
        yuv[0] = (Uint8)Y;
 | 
						|
        yuv[1] = (Uint8)U;
 | 
						|
        yuv[2] = (Uint8)V;
 | 
						|
    }
 | 
						|
 | 
						|
    if (monochrome) {
 | 
						|
        yuv[1] = 128;
 | 
						|
        yuv[2] = 128;
 | 
						|
    }
 | 
						|
 | 
						|
    if (luminance != 100) {
 | 
						|
        yuv[0] = yuv[0] * luminance / 100;
 | 
						|
        if (yuv[0] > 255) {
 | 
						|
            yuv[0] = 255;
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void ConvertRGBtoPlanar2x2(Uint32 format, Uint8 *src, int pitch, Uint8 *out, int w, int h, SDL_YUV_CONVERSION_MODE mode, int monochrome, int luminance)
 | 
						|
{
 | 
						|
    int x, y;
 | 
						|
    int yuv[4][3];
 | 
						|
    Uint8 *Y1, *Y2, *U, *V;
 | 
						|
    Uint8 *rgb1, *rgb2;
 | 
						|
    int rgb_row_advance = (pitch - w * 3) + pitch;
 | 
						|
    int UV_advance;
 | 
						|
 | 
						|
    rgb1 = src;
 | 
						|
    rgb2 = src + pitch;
 | 
						|
 | 
						|
    Y1 = out;
 | 
						|
    Y2 = Y1 + w;
 | 
						|
    switch (format) {
 | 
						|
    case SDL_PIXELFORMAT_YV12:
 | 
						|
        V = (Y1 + h * w);
 | 
						|
        U = V + ((h + 1) / 2) * ((w + 1) / 2);
 | 
						|
        UV_advance = 1;
 | 
						|
        break;
 | 
						|
    case SDL_PIXELFORMAT_IYUV:
 | 
						|
        U = (Y1 + h * w);
 | 
						|
        V = U + ((h + 1) / 2) * ((w + 1) / 2);
 | 
						|
        UV_advance = 1;
 | 
						|
        break;
 | 
						|
    case SDL_PIXELFORMAT_NV12:
 | 
						|
        U = (Y1 + h * w);
 | 
						|
        V = U + 1;
 | 
						|
        UV_advance = 2;
 | 
						|
        break;
 | 
						|
    case SDL_PIXELFORMAT_NV21:
 | 
						|
        V = (Y1 + h * w);
 | 
						|
        U = V + 1;
 | 
						|
        UV_advance = 2;
 | 
						|
        break;
 | 
						|
    default:
 | 
						|
        SDL_assert(!"Unsupported planar YUV format");
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    for (y = 0; y < (h - 1); y += 2) {
 | 
						|
        for (x = 0; x < (w - 1); x += 2) {
 | 
						|
            RGBtoYUV(rgb1, yuv[0], mode, monochrome, luminance);
 | 
						|
            rgb1 += 3;
 | 
						|
            *Y1++ = (Uint8)yuv[0][0];
 | 
						|
 | 
						|
            RGBtoYUV(rgb1, yuv[1], mode, monochrome, luminance);
 | 
						|
            rgb1 += 3;
 | 
						|
            *Y1++ = (Uint8)yuv[1][0];
 | 
						|
 | 
						|
            RGBtoYUV(rgb2, yuv[2], mode, monochrome, luminance);
 | 
						|
            rgb2 += 3;
 | 
						|
            *Y2++ = (Uint8)yuv[2][0];
 | 
						|
 | 
						|
            RGBtoYUV(rgb2, yuv[3], mode, monochrome, luminance);
 | 
						|
            rgb2 += 3;
 | 
						|
            *Y2++ = (Uint8)yuv[3][0];
 | 
						|
 | 
						|
            *U = (Uint8)SDL_floorf((yuv[0][1] + yuv[1][1] + yuv[2][1] + yuv[3][1]) / 4.0f + 0.5f);
 | 
						|
            U += UV_advance;
 | 
						|
 | 
						|
            *V = (Uint8)SDL_floorf((yuv[0][2] + yuv[1][2] + yuv[2][2] + yuv[3][2]) / 4.0f + 0.5f);
 | 
						|
            V += UV_advance;
 | 
						|
        }
 | 
						|
        /* Last column */
 | 
						|
        if (x == (w - 1)) {
 | 
						|
            RGBtoYUV(rgb1, yuv[0], mode, monochrome, luminance);
 | 
						|
            rgb1 += 3;
 | 
						|
            *Y1++ = (Uint8)yuv[0][0];
 | 
						|
 | 
						|
            RGBtoYUV(rgb2, yuv[2], mode, monochrome, luminance);
 | 
						|
            rgb2 += 3;
 | 
						|
            *Y2++ = (Uint8)yuv[2][0];
 | 
						|
 | 
						|
            *U = (Uint8)SDL_floorf((yuv[0][1] + yuv[2][1]) / 2.0f + 0.5f);
 | 
						|
            U += UV_advance;
 | 
						|
 | 
						|
            *V = (Uint8)SDL_floorf((yuv[0][2] + yuv[2][2]) / 2.0f + 0.5f);
 | 
						|
            V += UV_advance;
 | 
						|
        }
 | 
						|
        Y1 += w;
 | 
						|
        Y2 += w;
 | 
						|
        rgb1 += rgb_row_advance;
 | 
						|
        rgb2 += rgb_row_advance;
 | 
						|
    }
 | 
						|
    /* Last row */
 | 
						|
    if (y == (h - 1)) {
 | 
						|
        for (x = 0; x < (w - 1); x += 2) {
 | 
						|
            RGBtoYUV(rgb1, yuv[0], mode, monochrome, luminance);
 | 
						|
            rgb1 += 3;
 | 
						|
            *Y1++ = (Uint8)yuv[0][0];
 | 
						|
 | 
						|
            RGBtoYUV(rgb1, yuv[1], mode, monochrome, luminance);
 | 
						|
            rgb1 += 3;
 | 
						|
            *Y1++ = (Uint8)yuv[1][0];
 | 
						|
 | 
						|
            *U = (Uint8)SDL_floorf((yuv[0][1] + yuv[1][1]) / 2.0f + 0.5f);
 | 
						|
            U += UV_advance;
 | 
						|
 | 
						|
            *V = (Uint8)SDL_floorf((yuv[0][2] + yuv[1][2]) / 2.0f + 0.5f);
 | 
						|
            V += UV_advance;
 | 
						|
        }
 | 
						|
        /* Last column */
 | 
						|
        if (x == (w - 1)) {
 | 
						|
            RGBtoYUV(rgb1, yuv[0], mode, monochrome, luminance);
 | 
						|
            *Y1++ = (Uint8)yuv[0][0];
 | 
						|
 | 
						|
            *U = (Uint8)yuv[0][1];
 | 
						|
            U += UV_advance;
 | 
						|
 | 
						|
            *V = (Uint8)yuv[0][2];
 | 
						|
            V += UV_advance;
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void ConvertRGBtoPacked4(Uint32 format, Uint8 *src, int pitch, Uint8 *out, int w, int h, SDL_YUV_CONVERSION_MODE mode, int monochrome, int luminance)
 | 
						|
{
 | 
						|
    int x, y;
 | 
						|
    int yuv[2][3];
 | 
						|
    Uint8 *Y1, *Y2, *U, *V;
 | 
						|
    Uint8 *rgb;
 | 
						|
    int rgb_row_advance = (pitch - w * 3);
 | 
						|
 | 
						|
    rgb = src;
 | 
						|
 | 
						|
    switch (format) {
 | 
						|
    case SDL_PIXELFORMAT_YUY2:
 | 
						|
        Y1 = out;
 | 
						|
        U = out + 1;
 | 
						|
        Y2 = out + 2;
 | 
						|
        V = out + 3;
 | 
						|
        break;
 | 
						|
    case SDL_PIXELFORMAT_UYVY:
 | 
						|
        U = out;
 | 
						|
        Y1 = out + 1;
 | 
						|
        V = out + 2;
 | 
						|
        Y2 = out + 3;
 | 
						|
        break;
 | 
						|
    case SDL_PIXELFORMAT_YVYU:
 | 
						|
        Y1 = out;
 | 
						|
        V = out + 1;
 | 
						|
        Y2 = out + 2;
 | 
						|
        U = out + 3;
 | 
						|
        break;
 | 
						|
    default:
 | 
						|
        SDL_assert(!"Unsupported packed YUV format");
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    for (y = 0; y < h; ++y) {
 | 
						|
        for (x = 0; x < (w - 1); x += 2) {
 | 
						|
            RGBtoYUV(rgb, yuv[0], mode, monochrome, luminance);
 | 
						|
            rgb += 3;
 | 
						|
            *Y1 = (Uint8)yuv[0][0];
 | 
						|
            Y1 += 4;
 | 
						|
 | 
						|
            RGBtoYUV(rgb, yuv[1], mode, monochrome, luminance);
 | 
						|
            rgb += 3;
 | 
						|
            *Y2 = (Uint8)yuv[1][0];
 | 
						|
            Y2 += 4;
 | 
						|
 | 
						|
            *U = (Uint8)SDL_floorf((yuv[0][1] + yuv[1][1]) / 2.0f + 0.5f);
 | 
						|
            U += 4;
 | 
						|
 | 
						|
            *V = (Uint8)SDL_floorf((yuv[0][2] + yuv[1][2]) / 2.0f + 0.5f);
 | 
						|
            V += 4;
 | 
						|
        }
 | 
						|
        /* Last column */
 | 
						|
        if (x == (w - 1)) {
 | 
						|
            RGBtoYUV(rgb, yuv[0], mode, monochrome, luminance);
 | 
						|
            rgb += 3;
 | 
						|
            *Y2 = *Y1 = (Uint8)yuv[0][0];
 | 
						|
            Y1 += 4;
 | 
						|
            Y2 += 4;
 | 
						|
 | 
						|
            *U = (Uint8)yuv[0][1];
 | 
						|
            U += 4;
 | 
						|
 | 
						|
            *V = (Uint8)yuv[0][2];
 | 
						|
            V += 4;
 | 
						|
        }
 | 
						|
        rgb += rgb_row_advance;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
SDL_bool ConvertRGBtoYUV(Uint32 format, Uint8 *src, int pitch, Uint8 *out, int w, int h, SDL_YUV_CONVERSION_MODE mode, int monochrome, int luminance)
 | 
						|
{
 | 
						|
    switch (format) {
 | 
						|
    case SDL_PIXELFORMAT_YV12:
 | 
						|
    case SDL_PIXELFORMAT_IYUV:
 | 
						|
    case SDL_PIXELFORMAT_NV12:
 | 
						|
    case SDL_PIXELFORMAT_NV21:
 | 
						|
        ConvertRGBtoPlanar2x2(format, src, pitch, out, w, h, mode, monochrome, luminance);
 | 
						|
        return SDL_TRUE;
 | 
						|
    case SDL_PIXELFORMAT_YUY2:
 | 
						|
    case SDL_PIXELFORMAT_UYVY:
 | 
						|
    case SDL_PIXELFORMAT_YVYU:
 | 
						|
        ConvertRGBtoPacked4(format, src, pitch, out, w, h, mode, monochrome, luminance);
 | 
						|
        return SDL_TRUE;
 | 
						|
    default:
 | 
						|
        return SDL_FALSE;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
int CalculateYUVPitch(Uint32 format, int width)
 | 
						|
{
 | 
						|
    switch (format) {
 | 
						|
    case SDL_PIXELFORMAT_YV12:
 | 
						|
    case SDL_PIXELFORMAT_IYUV:
 | 
						|
    case SDL_PIXELFORMAT_NV12:
 | 
						|
    case SDL_PIXELFORMAT_NV21:
 | 
						|
        return width;
 | 
						|
    case SDL_PIXELFORMAT_YUY2:
 | 
						|
    case SDL_PIXELFORMAT_UYVY:
 | 
						|
    case SDL_PIXELFORMAT_YVYU:
 | 
						|
        return 4 * ((width + 1) / 2);
 | 
						|
    default:
 | 
						|
        return 0;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
/* vi: set ts=4 sw=4 expandtab: */
 |