[deb_ffmpeg.git] / ffmpeg / libavcodec / ppc / vp8dsp_altivec.c

/*
 * VP8 compatible video decoder
 *
 * Copyright (C) 2010 David Conrad
 *
 * This file is part of FFmpeg.
 *
 * FFmpeg 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.
 *
 * FFmpeg 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 FFmpeg; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 */

#include "config.h"
#include "libavutil/cpu.h"
#include "libavutil/mem.h"
#include "libavutil/ppc/cpu.h"
#include "libavutil/ppc/types_altivec.h"
#include "libavutil/ppc/util_altivec.h"
#include "libavcodec/vp8dsp.h"
#include "hpeldsp_altivec.h"

#if HAVE_ALTIVEC
#define REPT4(...) { __VA_ARGS__, __VA_ARGS__, __VA_ARGS__, __VA_ARGS__ }

// h subpel filter uses msum to multiply+add 4 pixel taps at once
static const vec_s8 h_subpel_filters_inner[7] =
{
    REPT4( -6, 123,  12,  -1),
    REPT4(-11, 108,  36,  -8),
    REPT4( -9,  93,  50,  -6),
    REPT4(-16,  77,  77, -16),
    REPT4( -6,  50,  93,  -9),
    REPT4( -8,  36, 108, -11),
    REPT4( -1,  12, 123,  -6),
};

// for 6tap filters, these are the outer two taps
// The zeros mask off pixels 4-7 when filtering 0-3
// and vice-versa
static const vec_s8 h_subpel_filters_outer[3] =
{
    REPT4(0, 0, 2, 1),
    REPT4(0, 0, 3, 3),
    REPT4(0, 0, 1, 2),
};

#define LOAD_H_SUBPEL_FILTER(i) \
    vec_s8 filter_inner  = h_subpel_filters_inner[i]; \
    vec_s8 filter_outerh = h_subpel_filters_outer[(i)>>1]; \
    vec_s8 filter_outerl = vec_sld(filter_outerh, filter_outerh, 2)

#define FILTER_H(dstv, off) \
    a = vec_ld((off)-is6tap-1,    src); \
    b = vec_ld((off)-is6tap-1+15, src); \
\
    pixh  = vec_perm(a, b, permh##off); \
    pixl  = vec_perm(a, b, perml##off); \
    filth = vec_msum(filter_inner, pixh, c64); \
    filtl = vec_msum(filter_inner, pixl, c64); \
\
    if (is6tap) { \
        outer = vec_perm(a, b, perm_6tap##off); \
        filth = vec_msum(filter_outerh, outer, filth); \
        filtl = vec_msum(filter_outerl, outer, filtl); \
    } \
    if (w == 4) \
        filtl = filth; /* discard pixels 4-7 */ \
    dstv = vec_packs(filth, filtl); \
    dstv = vec_sra(dstv, c7)

static av_always_inline
void put_vp8_epel_h_altivec_core(uint8_t *dst, ptrdiff_t dst_stride,
                                 uint8_t *src, ptrdiff_t src_stride,
                                 int h, int mx, int w, int is6tap)
{
    LOAD_H_SUBPEL_FILTER(mx-1);
    vec_u8 align_vec0, align_vec8, permh0, permh8, filt;
    vec_u8 perm_6tap0, perm_6tap8, perml0, perml8;
    vec_u8 a, b, pixh, pixl, outer;
    vec_s16 f16h, f16l;
    vec_s32 filth, filtl;

    vec_u8 perm_inner6 = { 1,2,3,4, 2,3,4,5, 3,4,5,6, 4,5,6,7 };
    vec_u8 perm_inner4 = { 0,1,2,3, 1,2,3,4, 2,3,4,5, 3,4,5,6 };
    vec_u8 perm_inner  = is6tap ? perm_inner6 : perm_inner4;
    vec_u8 perm_outer = { 4,9, 0,5, 5,10, 1,6, 6,11, 2,7, 7,12, 3,8 };
    vec_s32 c64 = vec_sl(vec_splat_s32(1), vec_splat_u32(6));
    vec_u16 c7  = vec_splat_u16(7);

    align_vec0 = vec_lvsl( -is6tap-1, src);
    align_vec8 = vec_lvsl(8-is6tap-1, src);

    permh0     = vec_perm(align_vec0, align_vec0, perm_inner);
    permh8     = vec_perm(align_vec8, align_vec8, perm_inner);
    perm_inner = vec_add(perm_inner, vec_splat_u8(4));
    perml0     = vec_perm(align_vec0, align_vec0, perm_inner);
    perml8     = vec_perm(align_vec8, align_vec8, perm_inner);
    perm_6tap0 = vec_perm(align_vec0, align_vec0, perm_outer);
    perm_6tap8 = vec_perm(align_vec8, align_vec8, perm_outer);

    while (h --> 0) {
        FILTER_H(f16h, 0);

        if (w == 16) {
            FILTER_H(f16l, 8);
            filt = vec_packsu(f16h, f16l);
            vec_st(filt, 0, dst);
        } else {
            filt = vec_packsu(f16h, f16h);
            vec_ste((vec_u32)filt, 0, (uint32_t*)dst);
            if (w == 8)
                vec_ste((vec_u32)filt, 4, (uint32_t*)dst);
        }
        src += src_stride;
        dst += dst_stride;
    }
}

// v subpel filter does a simple vertical multiply + add
static const vec_u8 v_subpel_filters[7] =
{
    { 0,   6, 123,  12,   1,   0 },
    { 2,  11, 108,  36,   8,   1 },
    { 0,   9,  93,  50,   6,   0 },
    { 3,  16,  77,  77,  16,   3 },
    { 0,   6,  50,  93,   9,   0 },
    { 1,   8,  36, 108,  11,   2 },
    { 0,   1,  12, 123,   6,   0 },
};

#define LOAD_V_SUBPEL_FILTER(i) \
    vec_u8 subpel_filter = v_subpel_filters[i]; \
    vec_u8 f0 = vec_splat(subpel_filter, 0); \
    vec_u8 f1 = vec_splat(subpel_filter, 1); \
    vec_u8 f2 = vec_splat(subpel_filter, 2); \
    vec_u8 f3 = vec_splat(subpel_filter, 3); \
    vec_u8 f4 = vec_splat(subpel_filter, 4); \
    vec_u8 f5 = vec_splat(subpel_filter, 5)

#define FILTER_V(dstv, vec_mul) \
    s1f = (vec_s16)vec_mul(s1, f1); \
    s2f = (vec_s16)vec_mul(s2, f2); \
    s3f = (vec_s16)vec_mul(s3, f3); \
    s4f = (vec_s16)vec_mul(s4, f4); \
    s2f = vec_subs(s2f, s1f); \
    s3f = vec_subs(s3f, s4f); \
    if (is6tap) { \
        s0f = (vec_s16)vec_mul(s0, f0); \
        s5f = (vec_s16)vec_mul(s5, f5); \
        s2f = vec_adds(s2f, s0f); \
        s3f = vec_adds(s3f, s5f); \
    } \
    dstv = vec_adds(s2f, s3f); \
    dstv = vec_adds(dstv, c64); \
    dstv = vec_sra(dstv, c7)

static av_always_inline
void put_vp8_epel_v_altivec_core(uint8_t *dst, ptrdiff_t dst_stride,
                                 uint8_t *src, ptrdiff_t src_stride,
                                 int h, int my, int w, int is6tap)
{
    LOAD_V_SUBPEL_FILTER(my-1);
    vec_u8 s0, s1, s2, s3, s4, s5, filt, align_vech, perm_vec, align_vecl;
    vec_s16 s0f, s1f, s2f, s3f, s4f, s5f, f16h, f16l;
    vec_s16 c64 = vec_sl(vec_splat_s16(1), vec_splat_u16(6));
    vec_u16 c7  = vec_splat_u16(7);

    // we want pixels 0-7 to be in the even positions and 8-15 in the odd,
    // so combine this permute with the alignment permute vector
    align_vech = vec_lvsl(0, src);
    align_vecl = vec_sld(align_vech, align_vech, 8);
    if (w ==16)
        perm_vec = vec_mergeh(align_vech, align_vecl);
    else
        perm_vec = vec_mergeh(align_vech, align_vech);

    if (is6tap)
        s0 = load_with_perm_vec(-2*src_stride, src, perm_vec);
    s1 = load_with_perm_vec(-1*src_stride, src, perm_vec);
    s2 = load_with_perm_vec( 0*src_stride, src, perm_vec);
    s3 = load_with_perm_vec( 1*src_stride, src, perm_vec);
    if (is6tap)
        s4 = load_with_perm_vec( 2*src_stride, src, perm_vec);

    src += (2+is6tap)*src_stride;

    while (h --> 0) {
        if (is6tap)
            s5 = load_with_perm_vec(0, src, perm_vec);
        else
            s4 = load_with_perm_vec(0, src, perm_vec);

        FILTER_V(f16h, vec_mule);

        if (w == 16) {
            FILTER_V(f16l, vec_mulo);
            filt = vec_packsu(f16h, f16l);
            vec_st(filt, 0, dst);
        } else {
            filt = vec_packsu(f16h, f16h);
            if (w == 4)
                filt = (vec_u8)vec_splat((vec_u32)filt, 0);
            else
                vec_ste((vec_u32)filt, 4, (uint32_t*)dst);
            vec_ste((vec_u32)filt, 0, (uint32_t*)dst);
        }

        if (is6tap)
            s0 = s1;
        s1 = s2;
        s2 = s3;
        s3 = s4;
        if (is6tap)
            s4 = s5;

        dst += dst_stride;
        src += src_stride;
    }
}

#define EPEL_FUNCS(WIDTH, TAPS) \
static av_noinline \
void put_vp8_epel ## WIDTH ## _h ## TAPS ## _altivec(uint8_t *dst, ptrdiff_t dst_stride, uint8_t *src, ptrdiff_t src_stride, int h, int mx, int my) \
{ \
    put_vp8_epel_h_altivec_core(dst, dst_stride, src, src_stride, h, mx, WIDTH, TAPS == 6); \
} \
\
static av_noinline \
void put_vp8_epel ## WIDTH ## _v ## TAPS ## _altivec(uint8_t *dst, ptrdiff_t dst_stride, uint8_t *src, ptrdiff_t src_stride, int h, int mx, int my) \
{ \
    put_vp8_epel_v_altivec_core(dst, dst_stride, src, src_stride, h, my, WIDTH, TAPS == 6); \
}

#define EPEL_HV(WIDTH, HTAPS, VTAPS) \
static void put_vp8_epel ## WIDTH ## _h ## HTAPS ## v ## VTAPS ## _altivec(uint8_t *dst, ptrdiff_t dstride, uint8_t *src, ptrdiff_t sstride, int h, int mx, int my) \
{ \
    DECLARE_ALIGNED(16, uint8_t, tmp)[(2*WIDTH+5)*16]; \
    if (VTAPS == 6) { \
        put_vp8_epel ## WIDTH ## _h ## HTAPS ## _altivec(tmp, 16,      src-2*sstride, sstride, h+5, mx, my); \
        put_vp8_epel ## WIDTH ## _v ## VTAPS ## _altivec(dst, dstride, tmp+2*16,      16,      h,   mx, my); \
    } else { \
        put_vp8_epel ## WIDTH ## _h ## HTAPS ## _altivec(tmp, 16,      src-sstride, sstride, h+4, mx, my); \
        put_vp8_epel ## WIDTH ## _v ## VTAPS ## _altivec(dst, dstride, tmp+16,      16,      h,   mx, my); \
    } \
}

EPEL_FUNCS(16,6)
EPEL_FUNCS(8, 6)
EPEL_FUNCS(8, 4)
EPEL_FUNCS(4, 6)
EPEL_FUNCS(4, 4)

EPEL_HV(16, 6,6)
EPEL_HV(8,  6,6)
EPEL_HV(8,  4,6)
EPEL_HV(8,  6,4)
EPEL_HV(8,  4,4)
EPEL_HV(4,  6,6)
EPEL_HV(4,  4,6)
EPEL_HV(4,  6,4)
EPEL_HV(4,  4,4)

static void put_vp8_pixels16_altivec(uint8_t *dst, ptrdiff_t dstride, uint8_t *src, ptrdiff_t sstride, int h, int mx, int my)
{
    register vector unsigned char pixelsv1, pixelsv2;
    register vector unsigned char pixelsv1B, pixelsv2B;
    register vector unsigned char pixelsv1C, pixelsv2C;
    register vector unsigned char pixelsv1D, pixelsv2D;

    register vector unsigned char perm = vec_lvsl(0, src);
    int i;
    register ptrdiff_t dstride2 = dstride << 1, sstride2 = sstride << 1;
    register ptrdiff_t dstride3 = dstride2 + dstride, sstride3 = sstride + sstride2;
    register ptrdiff_t dstride4 = dstride << 2, sstride4 = sstride << 2;

// hand-unrolling the loop by 4 gains about 15%
// mininum execution time goes from 74 to 60 cycles
// it's faster than -funroll-loops, but using
// -funroll-loops w/ this is bad - 74 cycles again.
// all this is on a 7450, tuning for the 7450
    for (i = 0; i < h; i += 4) {
        pixelsv1  = vec_ld( 0, src);
        pixelsv2  = vec_ld(15, src);
        pixelsv1B = vec_ld(sstride, src);
        pixelsv2B = vec_ld(15 + sstride, src);
        pixelsv1C = vec_ld(sstride2, src);
        pixelsv2C = vec_ld(15 + sstride2, src);
        pixelsv1D = vec_ld(sstride3, src);
        pixelsv2D = vec_ld(15 + sstride3, src);
        vec_st(vec_perm(pixelsv1, pixelsv2, perm),
               0, (unsigned char*)dst);
        vec_st(vec_perm(pixelsv1B, pixelsv2B, perm),
               dstride, (unsigned char*)dst);
        vec_st(vec_perm(pixelsv1C, pixelsv2C, perm),
               dstride2, (unsigned char*)dst);
        vec_st(vec_perm(pixelsv1D, pixelsv2D, perm),
               dstride3, (unsigned char*)dst);
        src += sstride4;
        dst += dstride4;
    }
}

#endif /* HAVE_ALTIVEC */


av_cold void ff_vp78dsp_init_ppc(VP8DSPContext *c)
{
#if HAVE_ALTIVEC
    if (!PPC_ALTIVEC(av_get_cpu_flags()))
        return;

    c->put_vp8_epel_pixels_tab[0][0][0] = put_vp8_pixels16_altivec;
    c->put_vp8_epel_pixels_tab[0][0][2] = put_vp8_epel16_h6_altivec;
    c->put_vp8_epel_pixels_tab[0][2][0] = put_vp8_epel16_v6_altivec;
    c->put_vp8_epel_pixels_tab[0][2][2] = put_vp8_epel16_h6v6_altivec;

    c->put_vp8_epel_pixels_tab[1][0][2] = put_vp8_epel8_h6_altivec;
    c->put_vp8_epel_pixels_tab[1][2][0] = put_vp8_epel8_v6_altivec;
    c->put_vp8_epel_pixels_tab[1][0][1] = put_vp8_epel8_h4_altivec;
    c->put_vp8_epel_pixels_tab[1][1][0] = put_vp8_epel8_v4_altivec;

    c->put_vp8_epel_pixels_tab[1][2][2] = put_vp8_epel8_h6v6_altivec;
    c->put_vp8_epel_pixels_tab[1][1][1] = put_vp8_epel8_h4v4_altivec;
    c->put_vp8_epel_pixels_tab[1][1][2] = put_vp8_epel8_h6v4_altivec;
    c->put_vp8_epel_pixels_tab[1][2][1] = put_vp8_epel8_h4v6_altivec;

    c->put_vp8_epel_pixels_tab[2][0][2] = put_vp8_epel4_h6_altivec;
    c->put_vp8_epel_pixels_tab[2][2][0] = put_vp8_epel4_v6_altivec;
    c->put_vp8_epel_pixels_tab[2][0][1] = put_vp8_epel4_h4_altivec;
    c->put_vp8_epel_pixels_tab[2][1][0] = put_vp8_epel4_v4_altivec;

    c->put_vp8_epel_pixels_tab[2][2][2] = put_vp8_epel4_h6v6_altivec;
    c->put_vp8_epel_pixels_tab[2][1][1] = put_vp8_epel4_h4v4_altivec;
    c->put_vp8_epel_pixels_tab[2][1][2] = put_vp8_epel4_h6v4_altivec;
    c->put_vp8_epel_pixels_tab[2][2][1] = put_vp8_epel4_h4v6_altivec;
#endif /* HAVE_ALTIVEC */
}
Commit	Line	Data
2ba45a60 DM	1	/*
	2	* VP8 compatible video decoder
	3	*
	4	* Copyright (C) 2010 David Conrad
	5	*
	6	* This file is part of FFmpeg.
	7	*
	8	* FFmpeg is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU Lesser General Public
	10	* License as published by the Free Software Foundation; either
	11	* version 2.1 of the License, or (at your option) any later version.
	12	*
	13	* FFmpeg is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	16	* Lesser General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU Lesser General Public
	19	* License along with FFmpeg; if not, write to the Free Software
	20	* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
	21	*/
	22
	23	#include "config.h"
	24	#include "libavutil/cpu.h"
	25	#include "libavutil/mem.h"
	26	#include "libavutil/ppc/cpu.h"
	27	#include "libavutil/ppc/types_altivec.h"
	28	#include "libavutil/ppc/util_altivec.h"
	29	#include "libavcodec/vp8dsp.h"
	30	#include "hpeldsp_altivec.h"
	31
	32	#if HAVE_ALTIVEC
	33	#define REPT4(...) { __VA_ARGS__, __VA_ARGS__, __VA_ARGS__, __VA_ARGS__ }
	34
	35	// h subpel filter uses msum to multiply+add 4 pixel taps at once
	36	static const vec_s8 h_subpel_filters_inner[7] =
	37	{
	38	REPT4( -6, 123, 12, -1),
	39	REPT4(-11, 108, 36, -8),
	40	REPT4( -9, 93, 50, -6),
	41	REPT4(-16, 77, 77, -16),
	42	REPT4( -6, 50, 93, -9),
	43	REPT4( -8, 36, 108, -11),
	44	REPT4( -1, 12, 123, -6),
	45	};
	46
	47	// for 6tap filters, these are the outer two taps
	48	// The zeros mask off pixels 4-7 when filtering 0-3
	49	// and vice-versa
	50	static const vec_s8 h_subpel_filters_outer[3] =
	51	{
	52	REPT4(0, 0, 2, 1),
	53	REPT4(0, 0, 3, 3),
	54	REPT4(0, 0, 1, 2),
	55	};
	56
	57	#define LOAD_H_SUBPEL_FILTER(i) \
	58	vec_s8 filter_inner = h_subpel_filters_inner[i]; \
	59	vec_s8 filter_outerh = h_subpel_filters_outer[(i)>>1]; \
	60	vec_s8 filter_outerl = vec_sld(filter_outerh, filter_outerh, 2)
	61
	62	#define FILTER_H(dstv, off) \
	63	a = vec_ld((off)-is6tap-1, src); \
	64	b = vec_ld((off)-is6tap-1+15, src); \
65	\
66	pixh = vec_perm(a, b, permh##off); \
67	pixl = vec_perm(a, b, perml##off); \
68	filth = vec_msum(filter_inner, pixh, c64); \
69	filtl = vec_msum(filter_inner, pixl, c64); \
70	\
71	if (is6tap) { \
72	outer = vec_perm(a, b, perm_6tap##off); \
73	filth = vec_msum(filter_outerh, outer, filth); \
74	filtl = vec_msum(filter_outerl, outer, filtl); \
75	} \
76	if (w == 4) \
77	filtl = filth; /* discard pixels 4-7 */ \
78	dstv = vec_packs(filth, filtl); \
79	dstv = vec_sra(dstv, c7)
80
81	static av_always_inline
82	void put_vp8_epel_h_altivec_core(uint8_t *dst, ptrdiff_t dst_stride,
83	uint8_t *src, ptrdiff_t src_stride,
84	int h, int mx, int w, int is6tap)
85	{
86	LOAD_H_SUBPEL_FILTER(mx-1);
87	vec_u8 align_vec0, align_vec8, permh0, permh8, filt;
88	vec_u8 perm_6tap0, perm_6tap8, perml0, perml8;
89	vec_u8 a, b, pixh, pixl, outer;
90	vec_s16 f16h, f16l;
91	vec_s32 filth, filtl;
92
93	vec_u8 perm_inner6 = { 1,2,3,4, 2,3,4,5, 3,4,5,6, 4,5,6,7 };
94	vec_u8 perm_inner4 = { 0,1,2,3, 1,2,3,4, 2,3,4,5, 3,4,5,6 };
95	vec_u8 perm_inner = is6tap ? perm_inner6 : perm_inner4;
96	vec_u8 perm_outer = { 4,9, 0,5, 5,10, 1,6, 6,11, 2,7, 7,12, 3,8 };
97	vec_s32 c64 = vec_sl(vec_splat_s32(1), vec_splat_u32(6));
98	vec_u16 c7 = vec_splat_u16(7);
99
100	align_vec0 = vec_lvsl( -is6tap-1, src);
101	align_vec8 = vec_lvsl(8-is6tap-1, src);
102
103	permh0 = vec_perm(align_vec0, align_vec0, perm_inner);
104	permh8 = vec_perm(align_vec8, align_vec8, perm_inner);
105	perm_inner = vec_add(perm_inner, vec_splat_u8(4));
106	perml0 = vec_perm(align_vec0, align_vec0, perm_inner);
107	perml8 = vec_perm(align_vec8, align_vec8, perm_inner);
108	perm_6tap0 = vec_perm(align_vec0, align_vec0, perm_outer);
109	perm_6tap8 = vec_perm(align_vec8, align_vec8, perm_outer);
110
111	while (h --> 0) {
112	FILTER_H(f16h, 0);
113
114	if (w == 16) {
115	FILTER_H(f16l, 8);
116	filt = vec_packsu(f16h, f16l);
117	vec_st(filt, 0, dst);
118	} else {
119	filt = vec_packsu(f16h, f16h);
120	vec_ste((vec_u32)filt, 0, (uint32_t*)dst);
121	if (w == 8)
122	vec_ste((vec_u32)filt, 4, (uint32_t*)dst);
123	}
124	src += src_stride;
125	dst += dst_stride;
126	}
127	}
128
129	// v subpel filter does a simple vertical multiply + add
130	static const vec_u8 v_subpel_filters[7] =
131	{
132	{ 0, 6, 123, 12, 1, 0 },
133	{ 2, 11, 108, 36, 8, 1 },
134	{ 0, 9, 93, 50, 6, 0 },
135	{ 3, 16, 77, 77, 16, 3 },
136	{ 0, 6, 50, 93, 9, 0 },
137	{ 1, 8, 36, 108, 11, 2 },
138	{ 0, 1, 12, 123, 6, 0 },
139	};
140
141	#define LOAD_V_SUBPEL_FILTER(i) \
142	vec_u8 subpel_filter = v_subpel_filters[i]; \
143	vec_u8 f0 = vec_splat(subpel_filter, 0); \
144	vec_u8 f1 = vec_splat(subpel_filter, 1); \
145	vec_u8 f2 = vec_splat(subpel_filter, 2); \
146	vec_u8 f3 = vec_splat(subpel_filter, 3); \
147	vec_u8 f4 = vec_splat(subpel_filter, 4); \
148	vec_u8 f5 = vec_splat(subpel_filter, 5)
149
150	#define FILTER_V(dstv, vec_mul) \
151	s1f = (vec_s16)vec_mul(s1, f1); \
152	s2f = (vec_s16)vec_mul(s2, f2); \
153	s3f = (vec_s16)vec_mul(s3, f3); \
154	s4f = (vec_s16)vec_mul(s4, f4); \
155	s2f = vec_subs(s2f, s1f); \
156	s3f = vec_subs(s3f, s4f); \
157	if (is6tap) { \
158	s0f = (vec_s16)vec_mul(s0, f0); \
159	s5f = (vec_s16)vec_mul(s5, f5); \
160	s2f = vec_adds(s2f, s0f); \
161	s3f = vec_adds(s3f, s5f); \
162	} \
163	dstv = vec_adds(s2f, s3f); \
164	dstv = vec_adds(dstv, c64); \
165	dstv = vec_sra(dstv, c7)
166
167	static av_always_inline
168	void put_vp8_epel_v_altivec_core(uint8_t *dst, ptrdiff_t dst_stride,
169	uint8_t *src, ptrdiff_t src_stride,
170	int h, int my, int w, int is6tap)
171	{
172	LOAD_V_SUBPEL_FILTER(my-1);
173	vec_u8 s0, s1, s2, s3, s4, s5, filt, align_vech, perm_vec, align_vecl;
174	vec_s16 s0f, s1f, s2f, s3f, s4f, s5f, f16h, f16l;
175	vec_s16 c64 = vec_sl(vec_splat_s16(1), vec_splat_u16(6));
176	vec_u16 c7 = vec_splat_u16(7);
177
178	// we want pixels 0-7 to be in the even positions and 8-15 in the odd,
179	// so combine this permute with the alignment permute vector
180	align_vech = vec_lvsl(0, src);
181	align_vecl = vec_sld(align_vech, align_vech, 8);
182	if (w ==16)
183	perm_vec = vec_mergeh(align_vech, align_vecl);
184	else
185	perm_vec = vec_mergeh(align_vech, align_vech);
186
187	if (is6tap)
188	s0 = load_with_perm_vec(-2*src_stride, src, perm_vec);
189	s1 = load_with_perm_vec(-1*src_stride, src, perm_vec);
190	s2 = load_with_perm_vec( 0*src_stride, src, perm_vec);
191	s3 = load_with_perm_vec( 1*src_stride, src, perm_vec);
192	if (is6tap)
193	s4 = load_with_perm_vec( 2*src_stride, src, perm_vec);
194
195	src += (2+is6tap)*src_stride;
196
197	while (h --> 0) {
198	if (is6tap)
199	s5 = load_with_perm_vec(0, src, perm_vec);
200	else
201	s4 = load_with_perm_vec(0, src, perm_vec);
202
203	FILTER_V(f16h, vec_mule);
204
205	if (w == 16) {
206	FILTER_V(f16l, vec_mulo);
207	filt = vec_packsu(f16h, f16l);
208	vec_st(filt, 0, dst);
209	} else {
210	filt = vec_packsu(f16h, f16h);
211	if (w == 4)
212	filt = (vec_u8)vec_splat((vec_u32)filt, 0);
213	else
214	vec_ste((vec_u32)filt, 4, (uint32_t*)dst);
215	vec_ste((vec_u32)filt, 0, (uint32_t*)dst);
216	}
217
218	if (is6tap)
219	s0 = s1;
220	s1 = s2;
221	s2 = s3;
222	s3 = s4;
223	if (is6tap)
224	s4 = s5;
225
226	dst += dst_stride;
227	src += src_stride;
228	}
229	}
230
231	#define EPEL_FUNCS(WIDTH, TAPS) \
232	static av_noinline \
233	void put_vp8_epel ## WIDTH ## _h ## TAPS ## _altivec(uint8_t dst, ptrdiff_t dst_stride, uint8_t src, ptrdiff_t src_stride, int h, int mx, int my) \
234	{ \
235	put_vp8_epel_h_altivec_core(dst, dst_stride, src, src_stride, h, mx, WIDTH, TAPS == 6); \
236	} \
237	\
238	static av_noinline \
239	void put_vp8_epel ## WIDTH ## _v ## TAPS ## _altivec(uint8_t dst, ptrdiff_t dst_stride, uint8_t src, ptrdiff_t src_stride, int h, int mx, int my) \
240	{ \
241	put_vp8_epel_v_altivec_core(dst, dst_stride, src, src_stride, h, my, WIDTH, TAPS == 6); \
242	}
243
244	#define EPEL_HV(WIDTH, HTAPS, VTAPS) \
245	static void put_vp8_epel ## WIDTH ## _h ## HTAPS ## v ## VTAPS ## _altivec(uint8_t dst, ptrdiff_t dstride, uint8_t src, ptrdiff_t sstride, int h, int mx, int my) \
246	{ \
247	DECLARE_ALIGNED(16, uint8_t, tmp)[(2WIDTH+5)16]; \
248	if (VTAPS == 6) { \
249	put_vp8_epel ## WIDTH ## _h ## HTAPS ## _altivec(tmp, 16, src-2*sstride, sstride, h+5, mx, my); \
250	put_vp8_epel ## WIDTH ## _v ## VTAPS ## _altivec(dst, dstride, tmp+2*16, 16, h, mx, my); \
251	} else { \
252	put_vp8_epel ## WIDTH ## _h ## HTAPS ## _altivec(tmp, 16, src-sstride, sstride, h+4, mx, my); \
253	put_vp8_epel ## WIDTH ## _v ## VTAPS ## _altivec(dst, dstride, tmp+16, 16, h, mx, my); \
254	} \
255	}
256
257	EPEL_FUNCS(16,6)
258	EPEL_FUNCS(8, 6)
259	EPEL_FUNCS(8, 4)
260	EPEL_FUNCS(4, 6)
261	EPEL_FUNCS(4, 4)
262
263	EPEL_HV(16, 6,6)
264	EPEL_HV(8, 6,6)
265	EPEL_HV(8, 4,6)
266	EPEL_HV(8, 6,4)
267	EPEL_HV(8, 4,4)
268	EPEL_HV(4, 6,6)
269	EPEL_HV(4, 4,6)
270	EPEL_HV(4, 6,4)
271	EPEL_HV(4, 4,4)
272
273	static void put_vp8_pixels16_altivec(uint8_t dst, ptrdiff_t dstride, uint8_t src, ptrdiff_t sstride, int h, int mx, int my)
274	{
275	register vector unsigned char pixelsv1, pixelsv2;
276	register vector unsigned char pixelsv1B, pixelsv2B;
277	register vector unsigned char pixelsv1C, pixelsv2C;
278	register vector unsigned char pixelsv1D, pixelsv2D;
279
280	register vector unsigned char perm = vec_lvsl(0, src);
281	int i;
282	register ptrdiff_t dstride2 = dstride << 1, sstride2 = sstride << 1;
283	register ptrdiff_t dstride3 = dstride2 + dstride, sstride3 = sstride + sstride2;
284	register ptrdiff_t dstride4 = dstride << 2, sstride4 = sstride << 2;
285
286	// hand-unrolling the loop by 4 gains about 15%
287	// mininum execution time goes from 74 to 60 cycles
288	// it's faster than -funroll-loops, but using
289	// -funroll-loops w/ this is bad - 74 cycles again.
290	// all this is on a 7450, tuning for the 7450
291	for (i = 0; i < h; i += 4) {
292	pixelsv1 = vec_ld( 0, src);
293	pixelsv2 = vec_ld(15, src);
294	pixelsv1B = vec_ld(sstride, src);
295	pixelsv2B = vec_ld(15 + sstride, src);
296	pixelsv1C = vec_ld(sstride2, src);
297	pixelsv2C = vec_ld(15 + sstride2, src);
298	pixelsv1D = vec_ld(sstride3, src);
299	pixelsv2D = vec_ld(15 + sstride3, src);
300	vec_st(vec_perm(pixelsv1, pixelsv2, perm),
301	0, (unsigned char*)dst);
302	vec_st(vec_perm(pixelsv1B, pixelsv2B, perm),
303	dstride, (unsigned char*)dst);
304	vec_st(vec_perm(pixelsv1C, pixelsv2C, perm),
305	dstride2, (unsigned char*)dst);
306	vec_st(vec_perm(pixelsv1D, pixelsv2D, perm),
307	dstride3, (unsigned char*)dst);
308	src += sstride4;
309	dst += dstride4;
310	}
311	}
312
313	#endif /* HAVE_ALTIVEC */
314
315
316	av_cold void ff_vp78dsp_init_ppc(VP8DSPContext *c)
317	{
318	#if HAVE_ALTIVEC
319	if (!PPC_ALTIVEC(av_get_cpu_flags()))
320	return;
321
322	c->put_vp8_epel_pixels_tab[0][0][0] = put_vp8_pixels16_altivec;
323	c->put_vp8_epel_pixels_tab[0][0][2] = put_vp8_epel16_h6_altivec;
324	c->put_vp8_epel_pixels_tab[0][2][0] = put_vp8_epel16_v6_altivec;
325	c->put_vp8_epel_pixels_tab[0][2][2] = put_vp8_epel16_h6v6_altivec;
326
327	c->put_vp8_epel_pixels_tab[1][0][2] = put_vp8_epel8_h6_altivec;
328	c->put_vp8_epel_pixels_tab[1][2][0] = put_vp8_epel8_v6_altivec;
329	c->put_vp8_epel_pixels_tab[1][0][1] = put_vp8_epel8_h4_altivec;
330	c->put_vp8_epel_pixels_tab[1][1][0] = put_vp8_epel8_v4_altivec;
331
332	c->put_vp8_epel_pixels_tab[1][2][2] = put_vp8_epel8_h6v6_altivec;
333	c->put_vp8_epel_pixels_tab[1][1][1] = put_vp8_epel8_h4v4_altivec;
334	c->put_vp8_epel_pixels_tab[1][1][2] = put_vp8_epel8_h6v4_altivec;
335	c->put_vp8_epel_pixels_tab[1][2][1] = put_vp8_epel8_h4v6_altivec;
336
337	c->put_vp8_epel_pixels_tab[2][0][2] = put_vp8_epel4_h6_altivec;
338	c->put_vp8_epel_pixels_tab[2][2][0] = put_vp8_epel4_v6_altivec;
339	c->put_vp8_epel_pixels_tab[2][0][1] = put_vp8_epel4_h4_altivec;
340	c->put_vp8_epel_pixels_tab[2][1][0] = put_vp8_epel4_v4_altivec;
341
342	c->put_vp8_epel_pixels_tab[2][2][2] = put_vp8_epel4_h6v6_altivec;
343	c->put_vp8_epel_pixels_tab[2][1][1] = put_vp8_epel4_h4v4_altivec;
344	c->put_vp8_epel_pixels_tab[2][1][2] = put_vp8_epel4_h6v4_altivec;
345	c->put_vp8_epel_pixels_tab[2][2][1] = put_vp8_epel4_h4v6_altivec;
346	#endif /* HAVE_ALTIVEC */
347	}