1b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org/*
2b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *  Copyright (c) 2011 The WebRTC project authors. All Rights Reserved.
3b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *
4b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *  Use of this source code is governed by a BSD-style license
5b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *  that can be found in the LICENSE file in the root of the source
6b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *  tree. An additional intellectual property rights grant can be found
7b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *  in the file PATENTS.  All contributing project authors may
8b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *  be found in the AUTHORS file in the root of the source tree.
9b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org */
10b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
11b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org/******************************************************************
12b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
13b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org iLBC Speech Coder ANSI-C Source Code
14b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
15b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org WebRtcIlbcfix_GetSyncSeq.c
16b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
17b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org******************************************************************/
18b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
19b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org#include "defines.h"
20b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org#include "constants.h"
21b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org#include "refiner.h"
22b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org#include "nearest_neighbor.h"
23b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
24b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org/*----------------------------------------------------------------*
25b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org * get the pitch-synchronous sample sequence
26b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org *---------------------------------------------------------------*/
27b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
28b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.orgvoid WebRtcIlbcfix_GetSyncSeq(
29fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t *idata,   /* (i) original data */
30fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t idatal,   /* (i) dimension of data */
31fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t centerStartPos, /* (i) where current block starts */
32fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t *period,   /* (i) rough-pitch-period array       (Q-2) */
33fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t *plocs,   /* (i) where periods of period array are taken (Q-2) */
34fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t periodl,   /* (i) dimension period array */
35fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t hl,    /* (i) 2*hl+1 is the number of sequences */
36fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    int16_t *surround  /* (i/o) The contribution from this sequence
37b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org                                summed with earlier contributions */
38b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org                              ){
39fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org  int16_t i,centerEndPos,q;
40b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  /* Stack based */
41fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org  int16_t lagBlock[2*ENH_HL+1];
42fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org  int16_t blockStartPos[2*ENH_HL+1]; /* Defines the position to search around (Q2) */
43fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org  int16_t plocs2[ENH_PLOCSL];
44b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
45b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  centerEndPos=centerStartPos+ENH_BLOCKL-1;
46b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
47b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  /* present (find predicted lag from this position) */
48b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
49b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  WebRtcIlbcfix_NearestNeighbor(lagBlock+hl,plocs,
50fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org                                (int16_t)WEBRTC_SPL_MUL_16_16(2, (centerStartPos+centerEndPos)),
51b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org                                periodl);
52b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
53fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org  blockStartPos[hl]=(int16_t)WEBRTC_SPL_MUL_16_16(4, centerStartPos);
54b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
55b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  /* past (find predicted position and perform a refined
56b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org     search to find the best sequence) */
57b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
58b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  for(q=hl-1;q>=0;q--) {
59b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    blockStartPos[q]=blockStartPos[q+1]-period[lagBlock[q+1]];
60b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
61b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    WebRtcIlbcfix_NearestNeighbor(lagBlock+q, plocs,
62fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org                                  (int16_t)(blockStartPos[q] + (int16_t)WEBRTC_SPL_MUL_16_16(4, ENH_BLOCKL_HALF)-period[lagBlock[q+1]]),
63b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org                                  periodl);
64b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
65fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    if((blockStartPos[q]-(int16_t)WEBRTC_SPL_MUL_16_16(4, ENH_OVERHANG))>=0) {
66b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
67b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org      /* Find the best possible sequence in the 4 times upsampled
68b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org         domain around blockStartPos+q */
69b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org      WebRtcIlbcfix_Refiner(blockStartPos+q,idata,idatal,
70b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org                            centerStartPos,blockStartPos[q],surround,WebRtcIlbcfix_kEnhWt[q]);
71b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
72b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    } else {
73b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org      /* Don't add anything since this sequence would
74b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org         be outside the buffer */
75b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    }
76b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  }
77b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
78b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  /* future (find predicted position and perform a refined
79b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org     search to find the best sequence) */
80b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
81b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  for(i=0;i<periodl;i++) {
82b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    plocs2[i]=(plocs[i]-period[i]);
83b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  }
84b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
85b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  for(q=hl+1;q<=WEBRTC_SPL_MUL_16_16(2, hl);q++) {
86b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
87b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    WebRtcIlbcfix_NearestNeighbor(lagBlock+q,plocs2,
88fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org                                  (int16_t)(blockStartPos[q-1]+
89fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org                                                  (int16_t)WEBRTC_SPL_MUL_16_16(4, ENH_BLOCKL_HALF)),periodl);
90b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
91b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    blockStartPos[q]=blockStartPos[q-1]+period[lagBlock[q]];
92b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
93fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org    if( (blockStartPos[q]+(int16_t)WEBRTC_SPL_MUL_16_16(4, (ENH_BLOCKL+ENH_OVERHANG)))
94b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org        <
95fbda0fcf2f9e82c82bcaac138f44d4e5144f6e0dpbos@webrtc.org        (int16_t)WEBRTC_SPL_MUL_16_16(4, idatal)) {
96b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
97b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org      /* Find the best possible sequence in the 4 times upsampled
98b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org         domain around blockStartPos+q */
99b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org      WebRtcIlbcfix_Refiner(blockStartPos+q, idata, idatal,
100b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org                            centerStartPos,blockStartPos[q],surround,WebRtcIlbcfix_kEnhWt[2*hl-q]);
101b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org
102b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    }
103b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    else {
104b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org      /* Don't add anything since this sequence would
105b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org         be outside the buffer */
106b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org    }
107b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org  }
108b015cbede88899f67a53fbbe581b02ce8e32794andrew@webrtc.org}
109