198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/* Copyright (C) 2002 Jean-Marc Valin 298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project File: vq.c 398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Vector quantization 498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project Redistribution and use in source and binary forms, with or without 698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project modification, are permitted provided that the following conditions 798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project are met: 898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions of source code must retain the above copyright 1098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer. 1198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Redistributions in binary form must reproduce the above copyright 1398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project notice, this list of conditions and the following disclaimer in the 1498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project documentation and/or other materials provided with the distribution. 1598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 1698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project - Neither the name of the Xiph.org Foundation nor the names of its 1798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project contributors may be used to endorse or promote products derived from 1898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project this software without specific prior written permission. 1998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 2098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 2198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 2298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 2398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR 2498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 2598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 2698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 2798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 2898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 2998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 3098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project*/ 3298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef HAVE_CONFIG_H 3498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "config.h" 3598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 3698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 3798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "vq.h" 3898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "stack_alloc.h" 3998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "arch.h" 4098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 4198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef _USE_SSE 4298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include <xmmintrin.h> 4398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "vq_sse.h" 4498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#elif defined(SHORTCUTS) && (defined(ARM4_ASM) || defined(ARM5E_ASM)) 4598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "vq_arm4.h" 4698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#elif defined(BFIN_ASM) 4798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#include "vq_bfin.h" 4898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 4998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 5198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint scal_quant(spx_word16_t in, const spx_word16_t *boundary, int entries) 5298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 5398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i=0; 5498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (i<entries-1 && in>boundary[0]) 5598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 5698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project boundary++; 5798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project i++; 5898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 5998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return i; 6098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 6198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 6298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectint scal_quant32(spx_word32_t in, const spx_word32_t *boundary, int entries) 6398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 6498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i=0; 6598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project while (i<entries-1 && in>boundary[0]) 6698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 6798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project boundary++; 6898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project i++; 6998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 7098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project return i; 7198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 7298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 7498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifndef OVERRIDE_VQ_NBEST 7598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/*Finds the indices of the n-best entries in a codebook*/ 7698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid vq_nbest(spx_word16_t *in, const spx_word16_t *codebook, int len, int entries, spx_word32_t *E, int N, int *nbest, spx_word32_t *best_dist, char *stack) 7798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 7898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i,j,k,used; 7998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project used = 0; 8098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<entries;i++) 8198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 8298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t dist=0; 8398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<len;j++) 8498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project dist = MAC16_16(dist,in[j],*codebook++); 8598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 8698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project dist=SUB32(SHR32(E[i],1),dist); 8798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 8898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project dist=.5f*E[i]-dist; 8998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 9098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (i<N || dist<best_dist[N-1]) 9198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 9298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (k=N-1; (k >= 1) && (k > used || dist < best_dist[k-1]); k--) 9398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 9498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project best_dist[k]=best_dist[k-1]; 9598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project nbest[k] = nbest[k-1]; 9698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 9798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project best_dist[k]=dist; 9898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project nbest[k]=i; 9998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project used++; 10098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 10198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 10298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 10398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 10498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project 10898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifndef OVERRIDE_VQ_NBEST_SIGN 10998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project/*Finds the indices of the n-best entries in a codebook with sign*/ 11098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Projectvoid vq_nbest_sign(spx_word16_t *in, const spx_word16_t *codebook, int len, int entries, spx_word32_t *E, int N, int *nbest, spx_word32_t *best_dist, char *stack) 11198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project{ 11298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project int i,j,k, sign, used; 11398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project used=0; 11498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (i=0;i<entries;i++) 11598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 11698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project spx_word32_t dist=0; 11798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (j=0;j<len;j++) 11898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project dist = MAC16_16(dist,in[j],*codebook++); 11998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (dist>0) 12098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 12198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project sign=0; 12298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project dist=-dist; 12398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } else 12498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 12598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project sign=1; 12698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 12798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#ifdef FIXED_POINT 12898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project dist = ADD32(dist,SHR32(E[i],1)); 12998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#else 13098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project dist = ADD32(dist,.5f*E[i]); 13198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 13298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (i<N || dist<best_dist[N-1]) 13398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 13498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project for (k=N-1; (k >= 1) && (k > used || dist < best_dist[k-1]); k--) 13598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project { 13698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project best_dist[k]=best_dist[k-1]; 13798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project nbest[k] = nbest[k-1]; 13898913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 13998913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project best_dist[k]=dist; 14098913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project nbest[k]=i; 14198913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project used++; 14298913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project if (sign) 14398913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project nbest[k]+=entries; 14498913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 14598913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project } 14698913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project} 14798913fed6520d8849fb2e246be943e04474aefaThe Android Open Source Project#endif 148