| /***************************************************************************** |
| * pixel.c: h264 encoder |
| ***************************************************************************** |
| * Copyright (C) 2003-2008 x264 project |
| * |
| * Authors: Eric Petit <eric.petit@lapsus.org> |
| * Guillaume Poirier <gpoirier@mplayerhq.hu> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program 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 General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02111, USA. |
| *****************************************************************************/ |
| |
| #ifdef SYS_LINUX |
| #include <altivec.h> |
| #endif |
| |
| #include "common/common.h" |
| #include "ppccommon.h" |
| |
| /*********************************************************************** |
| * SAD routines |
| **********************************************************************/ |
| |
| #define PIXEL_SAD_ALTIVEC( name, lx, ly, a, b ) \ |
| static int name( uint8_t *pix1, int i_pix1, \ |
| uint8_t *pix2, int i_pix2 ) \ |
| { \ |
| int y; \ |
| DECLARE_ALIGNED_16( int sum ); \ |
| \ |
| LOAD_ZERO; \ |
| PREP_LOAD; \ |
| vec_u8_t pix1v, pix2v; \ |
| vec_s32_t sumv = zero_s32v; \ |
| for( y = 0; y < ly; y++ ) \ |
| { \ |
| VEC_LOAD_G( pix1, pix1v, lx, vec_u8_t ); \ |
| VEC_LOAD_G( pix2, pix2v, lx, vec_u8_t ); \ |
| sumv = (vec_s32_t) vec_sum4s( \ |
| vec_sub( vec_max( pix1v, pix2v ), \ |
| vec_min( pix1v, pix2v ) ), \ |
| (vec_u32_t) sumv ); \ |
| pix1 += i_pix1; \ |
| pix2 += i_pix2; \ |
| } \ |
| sumv = vec_sum##a( sumv, zero_s32v ); \ |
| sumv = vec_splat( sumv, b ); \ |
| vec_ste( sumv, 0, &sum ); \ |
| return sum; \ |
| } |
| |
| PIXEL_SAD_ALTIVEC( pixel_sad_16x16_altivec, 16, 16, s, 3 ) |
| PIXEL_SAD_ALTIVEC( pixel_sad_8x16_altivec, 8, 16, 2s, 1 ) |
| PIXEL_SAD_ALTIVEC( pixel_sad_16x8_altivec, 16, 8, s, 3 ) |
| PIXEL_SAD_ALTIVEC( pixel_sad_8x8_altivec, 8, 8, 2s, 1 ) |
| |
| |
| |
| /*********************************************************************** |
| * SATD routines |
| **********************************************************************/ |
| |
| /*********************************************************************** |
| * VEC_HADAMAR |
| *********************************************************************** |
| * b[0] = a[0] + a[1] + a[2] + a[3] |
| * b[1] = a[0] + a[1] - a[2] - a[3] |
| * b[2] = a[0] - a[1] - a[2] + a[3] |
| * b[3] = a[0] - a[1] + a[2] - a[3] |
| **********************************************************************/ |
| #define VEC_HADAMAR(a0,a1,a2,a3,b0,b1,b2,b3) \ |
| b2 = vec_add( a0, a1 ); \ |
| b3 = vec_add( a2, a3 ); \ |
| a0 = vec_sub( a0, a1 ); \ |
| a2 = vec_sub( a2, a3 ); \ |
| b0 = vec_add( b2, b3 ); \ |
| b1 = vec_sub( b2, b3 ); \ |
| b2 = vec_sub( a0, a2 ); \ |
| b3 = vec_add( a0, a2 ) |
| |
| /*********************************************************************** |
| * VEC_ABS |
| *********************************************************************** |
| * a: s16v |
| * |
| * a = abs(a) |
| * |
| * Call vec_sub()/vec_max() instead of vec_abs() because vec_abs() |
| * actually also calls vec_splat(0), but we already have a null vector. |
| **********************************************************************/ |
| #define VEC_ABS(a) \ |
| a = vec_max( a, vec_sub( zero_s16v, a ) ); |
| |
| /*********************************************************************** |
| * VEC_ADD_ABS |
| *********************************************************************** |
| * a: s16v |
| * b, c: s32v |
| * |
| * c[i] = abs(a[2*i]) + abs(a[2*i+1]) + [bi] |
| **********************************************************************/ |
| #define VEC_ADD_ABS(a,b,c) \ |
| VEC_ABS( a ); \ |
| c = vec_sum4s( a, b ) |
| |
| /*********************************************************************** |
| * SATD 4x4 |
| **********************************************************************/ |
| static int pixel_satd_4x4_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| DECLARE_ALIGNED_16( int i_satd ); |
| |
| PREP_DIFF; |
| PREP_LOAD_SRC( pix1 ); |
| vec_s16_t diff0v, diff1v, diff2v, diff3v; |
| vec_s16_t temp0v, temp1v, temp2v, temp3v; |
| vec_s32_t satdv; |
| |
| vec_u8_t _offset1v_ = vec_lvsl(0, pix2); |
| vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2); |
| |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff0v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff1v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff2v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff3v, offset2v ); |
| |
| /* Hadamar H */ |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| |
| VEC_TRANSPOSE_4( temp0v, temp1v, temp2v, temp3v, |
| diff0v, diff1v, diff2v, diff3v ); |
| /* Hadamar V */ |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| |
| VEC_ADD_ABS( temp0v, zero_s32v, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| |
| satdv = vec_sum2s( satdv, zero_s32v ); |
| satdv = vec_splat( satdv, 1 ); |
| vec_ste( satdv, 0, &i_satd ); |
| |
| return i_satd / 2; |
| } |
| |
| /*********************************************************************** |
| * SATD 4x8 |
| **********************************************************************/ |
| static int pixel_satd_4x8_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| DECLARE_ALIGNED_16( int i_satd ); |
| |
| PREP_DIFF; |
| vec_s16_t diff0v, diff1v, diff2v, diff3v; |
| vec_s16_t temp0v, temp1v, temp2v, temp3v; |
| vec_s32_t satdv; |
| |
| PREP_LOAD_SRC( pix1 ); |
| vec_u8_t _offset1v_ = vec_lvsl(0, pix2); |
| vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2); |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff0v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff1v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff2v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff3v, offset2v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_TRANSPOSE_4( temp0v, temp1v, temp2v, temp3v, |
| diff0v, diff1v, diff2v, diff3v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_ADD_ABS( temp0v, zero_s32v, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff0v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff1v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff2v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff3v, offset2v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_TRANSPOSE_4( temp0v, temp1v, temp2v, temp3v, |
| diff0v, diff1v, diff2v, diff3v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_ADD_ABS( temp0v, satdv, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| |
| satdv = vec_sum2s( satdv, zero_s32v ); |
| satdv = vec_splat( satdv, 1 ); |
| vec_ste( satdv, 0, &i_satd ); |
| |
| return i_satd / 2; |
| } |
| |
| /*********************************************************************** |
| * SATD 8x4 |
| **********************************************************************/ |
| static int pixel_satd_8x4_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| DECLARE_ALIGNED_16( int i_satd ); |
| |
| PREP_DIFF; |
| vec_s16_t diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v; |
| vec_s16_t temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v; |
| vec_s32_t satdv; |
| |
| |
| PREP_LOAD_SRC( pix1 ); |
| vec_u8_t _offset1v_ = vec_lvsl(0, pix2); |
| vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2); |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset2v ); |
| |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| /* This causes warnings because temp4v...temp7v haven't be set, |
| but we don't care */ |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| |
| VEC_ADD_ABS( temp0v, zero_s32v, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| satdv = vec_sum2s( satdv, zero_s32v ); |
| satdv = vec_splat( satdv, 1 ); |
| vec_ste( satdv, 0, &i_satd ); |
| |
| return i_satd / 2; |
| } |
| |
| /*********************************************************************** |
| * SATD 8x8 |
| **********************************************************************/ |
| static int pixel_satd_8x8_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| DECLARE_ALIGNED_16( int i_satd ); |
| |
| PREP_DIFF; |
| vec_s16_t diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v; |
| vec_s16_t temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v; |
| vec_s32_t satdv; |
| |
| PREP_LOAD_SRC( pix1 ); |
| vec_u8_t _offset1v_ = vec_lvsl(0, pix2); |
| vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2); |
| |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff4v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff5v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff6v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff7v, offset2v ); |
| |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v ); |
| |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| |
| VEC_ADD_ABS( temp0v, zero_s32v, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| satdv = vec_sums( satdv, zero_s32v ); |
| satdv = vec_splat( satdv, 3 ); |
| vec_ste( satdv, 0, &i_satd ); |
| |
| return i_satd / 2; |
| } |
| |
| /*********************************************************************** |
| * SATD 8x16 |
| **********************************************************************/ |
| static int pixel_satd_8x16_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| DECLARE_ALIGNED_16( int i_satd ); |
| |
| PREP_DIFF; |
| vec_s16_t diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v; |
| vec_s16_t temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v; |
| vec_s32_t satdv; |
| |
| PREP_LOAD_SRC( pix1 ); |
| vec_u8_t _offset1v_ = vec_lvsl(0, pix2); |
| vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2); |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff4v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff5v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff6v , offset1v); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff7v, offset2v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_ADD_ABS( temp0v, zero_s32v, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff4v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff5v, offset2v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff6v, offset1v ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff7v, offset2v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v ); |
| VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_ADD_ABS( temp0v, satdv, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| satdv = vec_sums( satdv, zero_s32v ); |
| satdv = vec_splat( satdv, 3 ); |
| vec_ste( satdv, 0, &i_satd ); |
| |
| return i_satd / 2; |
| } |
| |
| /*********************************************************************** |
| * SATD 16x8 |
| **********************************************************************/ |
| static int pixel_satd_16x8_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| DECLARE_ALIGNED_16( int i_satd ); |
| |
| LOAD_ZERO; |
| PREP_LOAD; |
| PREP_LOAD_SRC( pix2 ); |
| vec_s32_t satdv; |
| vec_s16_t pix1v, pix2v; |
| vec_s16_t diffh0v, diffh1v, diffh2v, diffh3v, |
| diffh4v, diffh5v, diffh6v, diffh7v; |
| vec_s16_t diffl0v, diffl1v, diffl2v, diffl3v, |
| diffl4v, diffl5v, diffl6v, diffl7v; |
| vec_s16_t temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v; |
| |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh0v, diffl0v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh1v, diffl1v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh2v, diffl2v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh3v, diffl3v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh4v, diffl4v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh5v, diffl5v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh6v, diffl6v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh7v, diffl7v ); |
| |
| VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diffh0v, diffh1v, diffh2v, diffh3v, |
| diffh4v, diffh5v, diffh6v, diffh7v ); |
| |
| VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| |
| VEC_ADD_ABS( temp0v, zero_s32v, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diffl0v, diffl1v, diffl2v, diffl3v, |
| diffl4v, diffl5v, diffl6v, diffl7v ); |
| |
| VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| |
| VEC_ADD_ABS( temp0v, satdv, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| satdv = vec_sums( satdv, zero_s32v ); |
| satdv = vec_splat( satdv, 3 ); |
| vec_ste( satdv, 0, &i_satd ); |
| |
| return i_satd / 2; |
| } |
| |
| /*********************************************************************** |
| * SATD 16x16 |
| **********************************************************************/ |
| static int pixel_satd_16x16_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| DECLARE_ALIGNED_16( int i_satd ); |
| |
| LOAD_ZERO; |
| PREP_LOAD; |
| vec_s32_t satdv; |
| vec_s16_t pix1v, pix2v; |
| vec_s16_t diffh0v, diffh1v, diffh2v, diffh3v, |
| diffh4v, diffh5v, diffh6v, diffh7v; |
| vec_s16_t diffl0v, diffl1v, diffl2v, diffl3v, |
| diffl4v, diffl5v, diffl6v, diffl7v; |
| vec_s16_t temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v; |
| PREP_LOAD_SRC( pix2 ); |
| |
| |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh0v, diffl0v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh1v, diffl1v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh2v, diffl2v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh3v, diffl3v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh4v, diffl4v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh5v, diffl5v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh6v, diffl6v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh7v, diffl7v ); |
| VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diffh0v, diffh1v, diffh2v, diffh3v, |
| diffh4v, diffh5v, diffh6v, diffh7v ); |
| VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_ADD_ABS( temp0v, zero_s32v, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diffl0v, diffl1v, diffl2v, diffl3v, |
| diffl4v, diffl5v, diffl6v, diffl7v ); |
| VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_ADD_ABS( temp0v, satdv, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh0v, diffl0v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh1v, diffl1v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh2v, diffl2v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh3v, diffl3v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh4v, diffl4v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh5v, diffl5v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh6v, diffl6v ); |
| VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh7v, diffl7v ); |
| VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diffh0v, diffh1v, diffh2v, diffh3v, |
| diffh4v, diffh5v, diffh6v, diffh7v ); |
| VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_ADD_ABS( temp0v, satdv, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v, |
| temp4v, temp5v, temp6v, temp7v, |
| diffl0v, diffl1v, diffl2v, diffl3v, |
| diffl4v, diffl5v, diffl6v, diffl7v ); |
| VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v, |
| temp0v, temp1v, temp2v, temp3v ); |
| VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v, |
| temp4v, temp5v, temp6v, temp7v ); |
| VEC_ADD_ABS( temp0v, satdv, satdv ); |
| VEC_ADD_ABS( temp1v, satdv, satdv ); |
| VEC_ADD_ABS( temp2v, satdv, satdv ); |
| VEC_ADD_ABS( temp3v, satdv, satdv ); |
| VEC_ADD_ABS( temp4v, satdv, satdv ); |
| VEC_ADD_ABS( temp5v, satdv, satdv ); |
| VEC_ADD_ABS( temp6v, satdv, satdv ); |
| VEC_ADD_ABS( temp7v, satdv, satdv ); |
| |
| satdv = vec_sums( satdv, zero_s32v ); |
| satdv = vec_splat( satdv, 3 ); |
| vec_ste( satdv, 0, &i_satd ); |
| |
| return i_satd / 2; |
| } |
| |
| |
| |
| /*********************************************************************** |
| * Interleaved SAD routines |
| **********************************************************************/ |
| |
| static void pixel_sad_x4_16x16_altivec( uint8_t *fenc, |
| uint8_t *pix0, uint8_t *pix1, |
| uint8_t *pix2, uint8_t *pix3, |
| int i_stride, int scores[4] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| DECLARE_ALIGNED_16( int sum3 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v; |
| //vec_u8_t perm0v, perm1v, perm2v, perm3v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB; |
| |
| vec_s32_t sum0v, sum1v, sum2v, sum3v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| sum3v = vec_splat_s32(0); |
| |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| perm3vA = vec_lvsl(0, pix3); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| perm3vB = vec_lvsl(0, pix3 + i_stride); |
| |
| for (y = 0; y < 8; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vA); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vB); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| |
| |
| } |
| |
| sum0v = vec_sums( sum0v, zero_s32v ); |
| sum1v = vec_sums( sum1v, zero_s32v ); |
| sum2v = vec_sums( sum2v, zero_s32v ); |
| sum3v = vec_sums( sum3v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 3 ); |
| sum1v = vec_splat( sum1v, 3 ); |
| sum2v = vec_splat( sum2v, 3 ); |
| sum3v = vec_splat( sum3v, 3 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| vec_ste( sum3v, 0, &sum3); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| scores[3] = sum3; |
| } |
| |
| static void pixel_sad_x3_16x16_altivec( uint8_t *fenc, uint8_t *pix0, |
| uint8_t *pix1, uint8_t *pix2, |
| int i_stride, int scores[3] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; // temporary load vectors |
| vec_u8_t fencv, pix0v, pix1v, pix2v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB; |
| |
| vec_s32_t sum0v, sum1v, sum2v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| |
| for (y = 0; y < 8; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| } |
| |
| sum0v = vec_sums( sum0v, zero_s32v ); |
| sum1v = vec_sums( sum1v, zero_s32v ); |
| sum2v = vec_sums( sum2v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 3 ); |
| sum1v = vec_splat( sum1v, 3 ); |
| sum2v = vec_splat( sum2v, 3 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| } |
| |
| static void pixel_sad_x4_16x8_altivec( uint8_t *fenc, uint8_t *pix0, uint8_t *pix1, uint8_t *pix2, uint8_t *pix3, int i_stride, int scores[4] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| DECLARE_ALIGNED_16( int sum3 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB; |
| |
| vec_s32_t sum0v, sum1v, sum2v, sum3v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| sum3v = vec_splat_s32(0); |
| |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| perm3vA = vec_lvsl(0, pix3); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| perm3vB = vec_lvsl(0, pix3 + i_stride); |
| |
| for (y = 0; y < 4; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vA); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vB); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| } |
| |
| sum0v = vec_sums( sum0v, zero_s32v ); |
| sum1v = vec_sums( sum1v, zero_s32v ); |
| sum2v = vec_sums( sum2v, zero_s32v ); |
| sum3v = vec_sums( sum3v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 3 ); |
| sum1v = vec_splat( sum1v, 3 ); |
| sum2v = vec_splat( sum2v, 3 ); |
| sum3v = vec_splat( sum3v, 3 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| vec_ste( sum3v, 0, &sum3); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| scores[3] = sum3; |
| } |
| |
| static void pixel_sad_x3_16x8_altivec( uint8_t *fenc, uint8_t *pix0, |
| uint8_t *pix1, uint8_t *pix2, |
| int i_stride, int scores[3] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t fencv, pix0v, pix1v, pix2v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB; |
| |
| vec_s32_t sum0v, sum1v, sum2v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| |
| for (y = 0; y < 4; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| fencv = vec_ld(0, fenc); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| } |
| |
| sum0v = vec_sums( sum0v, zero_s32v ); |
| sum1v = vec_sums( sum1v, zero_s32v ); |
| sum2v = vec_sums( sum2v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 3 ); |
| sum1v = vec_splat( sum1v, 3 ); |
| sum2v = vec_splat( sum2v, 3 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| } |
| |
| |
| static void pixel_sad_x4_8x16_altivec( uint8_t *fenc, |
| uint8_t *pix0, uint8_t *pix1, |
| uint8_t *pix2, uint8_t *pix3, |
| int i_stride, int scores[4] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| DECLARE_ALIGNED_16( int sum3 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB, permEncv; |
| |
| vec_s32_t sum0v, sum1v, sum2v, sum3v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| sum3v = vec_splat_s32(0); |
| |
| permEncv = vec_lvsl(0, fenc); |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| perm3vA = vec_lvsl(0, pix3); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| perm3vB = vec_lvsl(0, pix3 + i_stride); |
| |
| for (y = 0; y < 8; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vA); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vB); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| } |
| |
| sum0v = vec_sum2s( sum0v, zero_s32v ); |
| sum1v = vec_sum2s( sum1v, zero_s32v ); |
| sum2v = vec_sum2s( sum2v, zero_s32v ); |
| sum3v = vec_sum2s( sum3v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 1 ); |
| sum1v = vec_splat( sum1v, 1 ); |
| sum2v = vec_splat( sum2v, 1 ); |
| sum3v = vec_splat( sum3v, 1 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| vec_ste( sum3v, 0, &sum3); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| scores[3] = sum3; |
| } |
| |
| static void pixel_sad_x3_8x16_altivec( uint8_t *fenc, uint8_t *pix0, |
| uint8_t *pix1, uint8_t *pix2, |
| int i_stride, int scores[3] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t fencv, pix0v, pix1v, pix2v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB,permEncv; |
| |
| vec_s32_t sum0v, sum1v, sum2v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| |
| permEncv = vec_lvsl(0, fenc); |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| |
| for (y = 0; y < 8; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| } |
| |
| sum0v = vec_sum2s( sum0v, zero_s32v ); |
| sum1v = vec_sum2s( sum1v, zero_s32v ); |
| sum2v = vec_sum2s( sum2v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 1 ); |
| sum1v = vec_splat( sum1v, 1 ); |
| sum2v = vec_splat( sum2v, 1 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| } |
| |
| static void pixel_sad_x4_8x8_altivec( uint8_t *fenc, |
| uint8_t *pix0, uint8_t *pix1, |
| uint8_t *pix2, uint8_t *pix3, |
| int i_stride, int scores[4] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| DECLARE_ALIGNED_16( int sum3 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB, permEncv; |
| |
| vec_s32_t sum0v, sum1v, sum2v, sum3v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| sum3v = vec_splat_s32(0); |
| |
| permEncv = vec_lvsl(0, fenc); |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| perm3vA = vec_lvsl(0, pix3); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| perm3vB = vec_lvsl(0, pix3 + i_stride); |
| |
| for (y = 0; y < 4; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vA); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| temp_lv = vec_ld(0, pix3); |
| temp_hv = vec_ld(16, pix3); |
| pix3v = vec_perm(temp_lv, temp_hv, perm3vB); |
| pix3 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v ); |
| } |
| |
| sum0v = vec_sum2s( sum0v, zero_s32v ); |
| sum1v = vec_sum2s( sum1v, zero_s32v ); |
| sum2v = vec_sum2s( sum2v, zero_s32v ); |
| sum3v = vec_sum2s( sum3v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 1 ); |
| sum1v = vec_splat( sum1v, 1 ); |
| sum2v = vec_splat( sum2v, 1 ); |
| sum3v = vec_splat( sum3v, 1 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| vec_ste( sum3v, 0, &sum3); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| scores[3] = sum3; |
| } |
| |
| static void pixel_sad_x3_8x8_altivec( uint8_t *fenc, uint8_t *pix0, |
| uint8_t *pix1, uint8_t *pix2, |
| int i_stride, int scores[3] ) |
| { |
| DECLARE_ALIGNED_16( int sum0 ); |
| DECLARE_ALIGNED_16( int sum1 ); |
| DECLARE_ALIGNED_16( int sum2 ); |
| int y; |
| |
| LOAD_ZERO; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t fencv, pix0v, pix1v, pix2v; |
| vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB, permEncv; |
| |
| vec_s32_t sum0v, sum1v, sum2v; |
| |
| sum0v = vec_splat_s32(0); |
| sum1v = vec_splat_s32(0); |
| sum2v = vec_splat_s32(0); |
| |
| permEncv = vec_lvsl(0, fenc); |
| perm0vA = vec_lvsl(0, pix0); |
| perm1vA = vec_lvsl(0, pix1); |
| perm2vA = vec_lvsl(0, pix2); |
| |
| perm0vB = vec_lvsl(0, pix0 + i_stride); |
| perm1vB = vec_lvsl(0, pix1 + i_stride); |
| perm2vB = vec_lvsl(0, pix2 + i_stride); |
| |
| for (y = 0; y < 4; y++) |
| { |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vA); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vA); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vA); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| |
| temp_lv = vec_ld(0, pix0); |
| temp_hv = vec_ld(16, pix0); |
| pix0v = vec_perm(temp_lv, temp_hv, perm0vB); |
| pix0 += i_stride; |
| |
| temp_lv = vec_ld(0, pix1); |
| temp_hv = vec_ld(16, pix1); |
| pix1v = vec_perm(temp_lv, temp_hv, perm1vB); |
| pix1 += i_stride; |
| |
| temp_lv = vec_ld(0, fenc); |
| fencv = vec_perm(temp_lv, temp_hv, permEncv); |
| fenc += FENC_STRIDE; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2v = vec_perm(temp_lv, temp_hv, perm2vB); |
| pix2 += i_stride; |
| |
| sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v ); |
| |
| sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v ); |
| |
| sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v ); |
| } |
| |
| sum0v = vec_sum2s( sum0v, zero_s32v ); |
| sum1v = vec_sum2s( sum1v, zero_s32v ); |
| sum2v = vec_sum2s( sum2v, zero_s32v ); |
| |
| sum0v = vec_splat( sum0v, 1 ); |
| sum1v = vec_splat( sum1v, 1 ); |
| sum2v = vec_splat( sum2v, 1 ); |
| |
| vec_ste( sum0v, 0, &sum0); |
| vec_ste( sum1v, 0, &sum1); |
| vec_ste( sum2v, 0, &sum2); |
| |
| scores[0] = sum0; |
| scores[1] = sum1; |
| scores[2] = sum2; |
| } |
| |
| /*********************************************************************** |
| * SSD routines |
| **********************************************************************/ |
| |
| static int pixel_ssd_16x16_altivec ( uint8_t *pix1, int i_stride_pix1, |
| uint8_t *pix2, int i_stride_pix2) |
| { |
| DECLARE_ALIGNED_16( int sum ); |
| |
| int y; |
| LOAD_ZERO; |
| vec_u8_t pix1vA, pix2vA, pix1vB, pix2vB; |
| vec_u32_t sumv; |
| vec_u8_t maxA, minA, diffA, maxB, minB, diffB; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t permA, permB; |
| |
| sumv = vec_splat_u32(0); |
| |
| permA = vec_lvsl(0, pix2); |
| permB = vec_lvsl(0, pix2 + i_stride_pix2); |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2vA = vec_perm(temp_lv, temp_hv, permA); |
| pix1vA = vec_ld(0, pix1); |
| |
| for (y=0; y < 7; y++) |
| { |
| pix1 += i_stride_pix1; |
| pix2 += i_stride_pix2; |
| |
| maxA = vec_max(pix1vA, pix2vA); |
| minA = vec_min(pix1vA, pix2vA); |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2vB = vec_perm(temp_lv, temp_hv, permB); |
| pix1vB = vec_ld(0, pix1); |
| |
| diffA = vec_sub(maxA, minA); |
| sumv = vec_msum(diffA, diffA, sumv); |
| |
| pix1 += i_stride_pix1; |
| pix2 += i_stride_pix2; |
| |
| maxB = vec_max(pix1vB, pix2vB); |
| minB = vec_min(pix1vB, pix2vB); |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2vA = vec_perm(temp_lv, temp_hv, permA); |
| pix1vA = vec_ld(0, pix1); |
| |
| diffB = vec_sub(maxB, minB); |
| sumv = vec_msum(diffB, diffB, sumv); |
| } |
| |
| pix1 += i_stride_pix1; |
| pix2 += i_stride_pix2; |
| |
| temp_lv = vec_ld(0, pix2); |
| temp_hv = vec_ld(16, pix2); |
| pix2vB = vec_perm(temp_lv, temp_hv, permB); |
| pix1vB = vec_ld(0, pix1); |
| |
| maxA = vec_max(pix1vA, pix2vA); |
| minA = vec_min(pix1vA, pix2vA); |
| |
| maxB = vec_max(pix1vB, pix2vB); |
| minB = vec_min(pix1vB, pix2vB); |
| |
| diffA = vec_sub(maxA, minA); |
| sumv = vec_msum(diffA, diffA, sumv); |
| |
| diffB = vec_sub(maxB, minB); |
| sumv = vec_msum(diffB, diffB, sumv); |
| |
| sumv = (vec_u32_t) vec_sums((vec_s32_t) sumv, zero_s32v); |
| sumv = vec_splat(sumv, 3); |
| vec_ste((vec_s32_t) sumv, 0, &sum); |
| return sum; |
| } |
| |
| static int pixel_ssd_8x8_altivec ( uint8_t *pix1, int i_stride_pix1, |
| uint8_t *pix2, int i_stride_pix2) |
| { |
| DECLARE_ALIGNED_16( int sum ); |
| |
| int y; |
| LOAD_ZERO; |
| vec_u8_t pix1v, pix2v; |
| vec_u32_t sumv; |
| vec_u8_t maxv, minv, diffv; |
| vec_u8_t temp_lv, temp_hv; |
| vec_u8_t perm1v, perm2v; |
| |
| const vec_u32_t sel = (vec_u32_t)CV(-1,-1,0,0); |
| |
| sumv = vec_splat_u32(0); |
| |
| perm1v = vec_lvsl(0, pix1); |
| perm2v = vec_lvsl(0, pix2); |
| |
| for (y=0; y < 8; y++) |
| { |
| temp_hv = vec_ld(0, pix1); |
| temp_lv = vec_ld(7, pix1); |
| pix1v = vec_perm(temp_hv, temp_lv, perm1v); |
| |
| temp_hv = vec_ld(0, pix2); |
| temp_lv = vec_ld(7, pix2); |
| pix2v = vec_perm(temp_hv, temp_lv, perm2v); |
| |
| maxv = vec_max(pix1v, pix2v); |
| minv = vec_min(pix1v, pix2v); |
| |
| diffv = vec_sub(maxv, minv); |
| sumv = vec_msum(diffv, diffv, sumv); |
| |
| pix1 += i_stride_pix1; |
| pix2 += i_stride_pix2; |
| } |
| |
| sumv = vec_sel( zero_u32v, sumv, sel ); |
| |
| sumv = (vec_u32_t) vec_sums((vec_s32_t) sumv, zero_s32v); |
| sumv = vec_splat(sumv, 3); |
| vec_ste((vec_s32_t) sumv, 0, &sum); |
| |
| return sum; |
| } |
| |
| /********************************************************************** |
| * SA8D routines: sum of 8x8 Hadamard transformed differences |
| **********************************************************************/ |
| /* SA8D_1D unrolled by 8 in Altivec */ |
| #define SA8D_1D_ALTIVEC( sa8d0v, sa8d1v, sa8d2v, sa8d3v, \ |
| sa8d4v, sa8d5v, sa8d6v, sa8d7v ) \ |
| { \ |
| /* int a0 = SRC(0) + SRC(4) */ \ |
| vec_s16_t a0v = vec_add(sa8d0v, sa8d4v); \ |
| /* int a4 = SRC(0) - SRC(4) */ \ |
| vec_s16_t a4v = vec_sub(sa8d0v, sa8d4v); \ |
| /* int a1 = SRC(1) + SRC(5) */ \ |
| vec_s16_t a1v = vec_add(sa8d1v, sa8d5v); \ |
| /* int a5 = SRC(1) - SRC(5) */ \ |
| vec_s16_t a5v = vec_sub(sa8d1v, sa8d5v); \ |
| /* int a2 = SRC(2) + SRC(6) */ \ |
| vec_s16_t a2v = vec_add(sa8d2v, sa8d6v); \ |
| /* int a6 = SRC(2) - SRC(6) */ \ |
| vec_s16_t a6v = vec_sub(sa8d2v, sa8d6v); \ |
| /* int a3 = SRC(3) + SRC(7) */ \ |
| vec_s16_t a3v = vec_add(sa8d3v, sa8d7v); \ |
| /* int a7 = SRC(3) - SRC(7) */ \ |
| vec_s16_t a7v = vec_sub(sa8d3v, sa8d7v); \ |
| \ |
| /* int b0 = a0 + a2 */ \ |
| vec_s16_t b0v = vec_add(a0v, a2v); \ |
| /* int b2 = a0 - a2; */ \ |
| vec_s16_t b2v = vec_sub(a0v, a2v); \ |
| /* int b1 = a1 + a3; */ \ |
| vec_s16_t b1v = vec_add(a1v, a3v); \ |
| /* int b3 = a1 - a3; */ \ |
| vec_s16_t b3v = vec_sub(a1v, a3v); \ |
| /* int b4 = a4 + a6; */ \ |
| vec_s16_t b4v = vec_add(a4v, a6v); \ |
| /* int b6 = a4 - a6; */ \ |
| vec_s16_t b6v = vec_sub(a4v, a6v); \ |
| /* int b5 = a5 + a7; */ \ |
| vec_s16_t b5v = vec_add(a5v, a7v); \ |
| /* int b7 = a5 - a7; */ \ |
| vec_s16_t b7v = vec_sub(a5v, a7v); \ |
| \ |
| /* DST(0, b0 + b1) */ \ |
| sa8d0v = vec_add(b0v, b1v); \ |
| /* DST(1, b0 - b1) */ \ |
| sa8d1v = vec_sub(b0v, b1v); \ |
| /* DST(2, b2 + b3) */ \ |
| sa8d2v = vec_add(b2v, b3v); \ |
| /* DST(3, b2 - b3) */ \ |
| sa8d3v = vec_sub(b2v, b3v); \ |
| /* DST(4, b4 + b5) */ \ |
| sa8d4v = vec_add(b4v, b5v); \ |
| /* DST(5, b4 - b5) */ \ |
| sa8d5v = vec_sub(b4v, b5v); \ |
| /* DST(6, b6 + b7) */ \ |
| sa8d6v = vec_add(b6v, b7v); \ |
| /* DST(7, b6 - b7) */ \ |
| sa8d7v = vec_sub(b6v, b7v); \ |
| } |
| |
| static int pixel_sa8d_8x8_core_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| int32_t i_satd=0; |
| |
| PREP_DIFF; |
| PREP_LOAD_SRC( pix1 ); |
| PREP_LOAD_SRC( pix2 ); |
| |
| vec_s16_t diff0v, diff1v, diff2v, diff3v, diff4v, diff5v, diff6v, diff7v; |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, pix2 ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, pix2 ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, pix2 ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, pix2 ); |
| |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff4v, pix2 ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff5v, pix2 ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff6v, pix2 ); |
| VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff7v, pix2 ); |
| |
| vec_s16_t sa8d0v, sa8d1v, sa8d2v, sa8d3v, sa8d4v, sa8d5v, sa8d6v, sa8d7v; |
| |
| SA8D_1D_ALTIVEC(diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v); |
| |
| VEC_TRANSPOSE_8(diff0v, diff1v, diff2v, diff3v, |
| diff4v, diff5v, diff6v, diff7v, |
| sa8d0v, sa8d1v, sa8d2v, sa8d3v, |
| sa8d4v, sa8d5v, sa8d6v, sa8d7v ); |
| |
| SA8D_1D_ALTIVEC(sa8d0v, sa8d1v, sa8d2v, sa8d3v, |
| sa8d4v, sa8d5v, sa8d6v, sa8d7v ); |
| |
| /* accumulation of the absolute value of all elements of the resulting bloc */ |
| vec_s16_t abs0v = VEC_ABS(sa8d0v); |
| vec_s16_t abs1v = VEC_ABS(sa8d1v); |
| vec_s16_t sum01v = vec_add(abs0v, abs1v); |
| |
| vec_s16_t abs2v = VEC_ABS(sa8d2v); |
| vec_s16_t abs3v = VEC_ABS(sa8d3v); |
| vec_s16_t sum23v = vec_add(abs2v, abs3v); |
| |
| vec_s16_t abs4v = VEC_ABS(sa8d4v); |
| vec_s16_t abs5v = VEC_ABS(sa8d5v); |
| vec_s16_t sum45v = vec_add(abs4v, abs5v); |
| |
| vec_s16_t abs6v = VEC_ABS(sa8d6v); |
| vec_s16_t abs7v = VEC_ABS(sa8d7v); |
| vec_s16_t sum67v = vec_add(abs6v, abs7v); |
| |
| vec_s16_t sum0123v = vec_add(sum01v, sum23v); |
| vec_s16_t sum4567v = vec_add(sum45v, sum67v); |
| |
| vec_s32_t sumblocv; |
| |
| sumblocv = vec_sum4s(sum0123v, (vec_s32_t)zerov ); |
| sumblocv = vec_sum4s(sum4567v, sumblocv ); |
| |
| sumblocv = vec_sums(sumblocv, (vec_s32_t)zerov ); |
| |
| sumblocv = vec_splat(sumblocv, 3); |
| |
| vec_ste(sumblocv, 0, &i_satd); |
| |
| return i_satd; |
| } |
| |
| static int pixel_sa8d_8x8_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| int32_t i_satd; |
| i_satd = (pixel_sa8d_8x8_core_altivec( pix1, i_pix1, pix2, i_pix2 )+2)>>2; |
| return i_satd; |
| } |
| |
| static int pixel_sa8d_16x16_altivec( uint8_t *pix1, int i_pix1, |
| uint8_t *pix2, int i_pix2 ) |
| { |
| int32_t i_satd; |
| |
| i_satd = (pixel_sa8d_8x8_core_altivec( &pix1[0], i_pix1, &pix2[0], i_pix2 ) |
| + pixel_sa8d_8x8_core_altivec( &pix1[8], i_pix1, &pix2[8], i_pix2 ) |
| + pixel_sa8d_8x8_core_altivec( &pix1[8*i_pix1], i_pix1, &pix2[8*i_pix2], i_pix2 ) |
| + pixel_sa8d_8x8_core_altivec( &pix1[8*i_pix1+8], i_pix1, &pix2[8*i_pix2+8], i_pix2 ) +2)>>2; |
| return i_satd; |
| } |
| |
| /**************************************************************************** |
| * structural similarity metric |
| ****************************************************************************/ |
| static void ssim_4x4x2_core_altivec( const uint8_t *pix1, int stride1, |
| const uint8_t *pix2, int stride2, |
| int sums[2][4] ) |
| { |
| DECLARE_ALIGNED_16( int temp[4] ); |
| |
| int y; |
| vec_u8_t pix1v, pix2v; |
| vec_u32_t s1v, s2v, ssv, s12v; |
| PREP_LOAD; |
| PREP_LOAD_SRC (pix1); |
| PREP_LOAD_SRC (pix2); |
| LOAD_ZERO; |
| |
| s1v = s2v = ssv = s12v = zero_u32v; |
| |
| for(y=0; y<4; y++) |
| { |
| VEC_LOAD( &pix1[y*stride1], pix1v, 16, vec_u8_t, pix1 ); |
| VEC_LOAD( &pix2[y*stride2], pix2v, 16, vec_u8_t, pix2 ); |
| |
| s1v = vec_sum4s( pix1v, s1v ); |
| s2v = vec_sum4s( pix2v, s2v ); |
| ssv = vec_msum( pix1v, pix1v, ssv ); |
| ssv = vec_msum( pix2v, pix2v, ssv ); |
| s12v = vec_msum( pix1v, pix2v, s12v ); |
| } |
| |
| vec_st( (vec_s32_t)s1v, 0, temp ); |
| sums[0][0] = temp[0]; |
| sums[1][0] = temp[1]; |
| vec_st( (vec_s32_t)s2v, 0, temp ); |
| sums[0][1] = temp[0]; |
| sums[1][1] = temp[1]; |
| vec_st( (vec_s32_t)ssv, 0, temp ); |
| sums[0][2] = temp[0]; |
| sums[1][2] = temp[1]; |
| vec_st( (vec_s32_t)s12v, 0, temp ); |
| sums[0][3] = temp[0]; |
| sums[1][3] = temp[1]; |
| } |
| |
| /**************************************************************************** |
| * x264_pixel_init: |
| ****************************************************************************/ |
| void x264_pixel_altivec_init( x264_pixel_function_t *pixf ) |
| { |
| pixf->sad[PIXEL_16x16] = pixel_sad_16x16_altivec; |
| pixf->sad[PIXEL_8x16] = pixel_sad_8x16_altivec; |
| pixf->sad[PIXEL_16x8] = pixel_sad_16x8_altivec; |
| pixf->sad[PIXEL_8x8] = pixel_sad_8x8_altivec; |
| |
| pixf->sad_x3[PIXEL_16x16] = pixel_sad_x3_16x16_altivec; |
| pixf->sad_x3[PIXEL_8x16] = pixel_sad_x3_8x16_altivec; |
| pixf->sad_x3[PIXEL_16x8] = pixel_sad_x3_16x8_altivec; |
| pixf->sad_x3[PIXEL_8x8] = pixel_sad_x3_8x8_altivec; |
| |
| pixf->sad_x4[PIXEL_16x16] = pixel_sad_x4_16x16_altivec; |
| pixf->sad_x4[PIXEL_8x16] = pixel_sad_x4_8x16_altivec; |
| pixf->sad_x4[PIXEL_16x8] = pixel_sad_x4_16x8_altivec; |
| pixf->sad_x4[PIXEL_8x8] = pixel_sad_x4_8x8_altivec; |
| |
| pixf->satd[PIXEL_16x16] = pixel_satd_16x16_altivec; |
| pixf->satd[PIXEL_8x16] = pixel_satd_8x16_altivec; |
| pixf->satd[PIXEL_16x8] = pixel_satd_16x8_altivec; |
| pixf->satd[PIXEL_8x8] = pixel_satd_8x8_altivec; |
| pixf->satd[PIXEL_8x4] = pixel_satd_8x4_altivec; |
| pixf->satd[PIXEL_4x8] = pixel_satd_4x8_altivec; |
| pixf->satd[PIXEL_4x4] = pixel_satd_4x4_altivec; |
| |
| pixf->ssd[PIXEL_16x16] = pixel_ssd_16x16_altivec; |
| pixf->ssd[PIXEL_8x8] = pixel_ssd_8x8_altivec; |
| |
| pixf->sa8d[PIXEL_16x16] = pixel_sa8d_16x16_altivec; |
| pixf->sa8d[PIXEL_8x8] = pixel_sa8d_8x8_altivec; |
| |
| pixf->ssim_4x4x2_core = ssim_4x4x2_core_altivec; |
| } |
