#include "yuv.h"

void
yuv_sv411_to_cl422dc(int invert, void *data, void *yuv, int width, int height)
{
    struct yuv411 *in = data;
    struct yuv422 *out_even = yuv;
    struct yuv422 *out_odd = out_even + width / 2;
    int i, j;                   /* counters */

    for (i = height / 2; i--; ) {
        for (j = width / 4; j--; ) {
            YUV422_Y0(*out_even) = YUV411_Y00(*in);
            YUV422_U0(*out_even) = YUV411_U00(*in);
            YUV422_V0(*out_even) = YUV411_V00(*in);
            YUV422_Y1(*out_even) = YUV411_Y01(*in);
            out_even++;
            YUV422_Y0(*out_even) = YUV411_Y02(*in);
            YUV422_U0(*out_even) = YUV411_U02(*in);
            YUV422_V0(*out_even) = YUV411_V02(*in);
            YUV422_Y1(*out_even) = YUV411_Y03(*in);
            out_even++;
            YUV422_Y0(*out_odd) = YUV411_Y10(*in);
            YUV422_U0(*out_odd) = YUV411_U10(*in);
            YUV422_V0(*out_odd) = YUV411_V10(*in);
            YUV422_Y1(*out_odd) = YUV411_Y11(*in);
            out_odd++;
            YUV422_Y0(*out_odd) = YUV411_Y12(*in);
            YUV422_U0(*out_odd) = YUV411_U12(*in);
            YUV422_V0(*out_odd) = YUV411_V12(*in);
            YUV422_Y1(*out_odd) = YUV411_Y13(*in);
            out_odd++;
            in++;
        }
        out_even += width / 2;
        out_odd += width / 2;
    }
}

void
yuv_sv411_to_cl422dc_quartersize(int invert, void *data, void *yuv,
                                 int width, int height)
{
    int w4 = width / 4;         /* quarter of width is used often */
    struct yuv411 *in_even = data;
    struct yuv411 *in_odd = in_even + w4;
    struct yuv422 *out_even = yuv;
    struct yuv422 *out_odd = out_even + w4;
    int i, j;                   /* counters */
    int u, v;                   /* U and V values */

    for (i = height / 4; i--; ) {
        for (j = w4; j--; ) {
            u = YUV411_U00(*in_even);
            v = YUV411_V00(*in_even);

            YUV422_Y0(*out_even) = YUV411_Y00(*in_even);
            YUV422_U0(*out_even) = u;
            YUV422_V0(*out_even) = v;
            YUV422_Y1(*out_even) = YUV411_Y02(*in_even);

            YUV422_Y0(*out_odd) = YUV411_Y10(*in_odd);
            YUV422_U0(*out_odd) = u;
            YUV422_V0(*out_odd) = v;
            YUV422_Y1(*out_odd) = YUV411_Y12(*in_odd);

            in_even++;
            in_odd++;
            out_even++;
            out_odd++;
        }
        in_even += w4;
        in_odd += w4;
        out_even += w4;
        out_odd += w4;
    }
}

void
yuv_sv411_to_cl422dc_sixteenthsize(int invert, void *data, void *yuv,
                                   int width, int height)
{
    int w4_3 = 3 * width / 4; /* three quarters of width is used often */
    int w8 = width / 8;         /* and so is one eighth */
    struct yuv411 *in_even = data;
    struct yuv411 *in_odd = in_even + width / 2;
    struct yuv422 *out_even = yuv;
    struct yuv422 *out_odd = out_even + w8;
    int i, j;                   /* counters */
    int u, v;                   /* U and V values */

    for (i = height / 8; i--; ) {
        for (j = w8; j--; ) {
            u = YUV411_U00(in_even[0]);
            v = YUV411_V00(in_even[0]);

            YUV422_Y0(*out_even) = YUV411_Y00(in_even[0]);
            YUV422_U0(*out_even) = u;
            YUV422_V0(*out_even) = v;
            YUV422_Y1(*out_even) = YUV411_Y00(in_even[1]);

            YUV422_Y0(*out_odd) = YUV411_Y00(in_odd[0]);
            YUV422_U0(*out_odd) = u;
            YUV422_V0(*out_odd) = v;
            YUV422_Y1(*out_odd) = YUV411_Y00(in_even[1]);

            in_even += 2;
            in_odd += 2;
            out_even++;
            out_odd++;
        }
        in_even += w4_3;
        in_odd += w4_3;
        out_even += w8;
        out_odd += w8;
    }
}