198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2004 Jean-Marc Valin */ 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/** 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @file cb_search_sse.h 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project @brief Fixed codebook functions (SSE version) 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* 798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Redistribution and use in source and binary forms, with or without 898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project modification, are permitted provided that the following conditions 998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are met: 1098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions of source code must retain the above copyright 1298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer. 1398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions in binary form must reproduce the above copyright 1598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer in the 1698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project documentation and/or other materials provided with the distribution. 1798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Neither the name of the Xiph.org Foundation nor the names of its 1998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project contributors may be used to endorse or promote products derived from 2098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software without specific prior written permission. 2198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 2398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 2498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 2598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR 2698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 2798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 2898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 2998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 3098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 3198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 3298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 3498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include <xmmintrin.h> 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic inline void _spx_mm_getr_ps (__m128 U, float *__Z, float *__Y, float *__X, float *__W) 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project union { 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float __a[4]; 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __m128 __v; 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } __u; 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __u.__v = U; 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project *__Z = __u.__a[0]; 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project *__Y = __u.__a[1]; 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project *__X = __u.__a[2]; 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project *__W = __u.__a[3]; 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#define OVERRIDE_COMPUTE_WEIGHTED_CODEBOOK 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectstatic void compute_weighted_codebook(const signed char *shape_cb, const spx_sig_t *_r, float *resp, __m128 *resp2, __m128 *E, int shape_cb_size, int subvect_size, char *stack) 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i, j, k; 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project __m128 resj, EE; 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project VARDECL(__m128 *r); 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project VARDECL(__m128 *shape); 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ALLOC(r, subvect_size, __m128); 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ALLOC(shape, subvect_size, __m128); 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for(j=0;j<subvect_size;j++) 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project r[j] = _mm_load_ps1(_r+j); 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<shape_cb_size;i+=4) 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project float *_res = resp+i*subvect_size; 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project const signed char *_shape = shape_cb+i*subvect_size; 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EE = _mm_setzero_ps(); 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for(j=0;j<subvect_size;j++) 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project shape[j] = _mm_setr_ps(0.03125*_shape[j], 0.03125*_shape[subvect_size+j], 0.03125*_shape[2*subvect_size+j], 0.03125*_shape[3*subvect_size+j]); 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for(j=0;j<subvect_size;j++) 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project resj = _mm_setzero_ps(); 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (k=0;k<=j;k++) 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project resj = _mm_add_ps(resj, _mm_mul_ps(shape[k],r[j-k])); 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project _spx_mm_getr_ps(resj, _res+j, _res+subvect_size+j, _res+2*subvect_size+j, _res+3*subvect_size+j); 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project *resp2++ = resj; 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EE = _mm_add_ps(EE, _mm_mul_ps(resj, resj)); 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project E[i>>2] = EE; 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 85