comparison src/scalar.c @ 196:e764049c0a82

quick fix to xtract_irregularity_j and a sort of working xtract_hps

 }
 
 int xtract_irregularity_j(const double *data, const int N, const void *argv, double *result)
 {
 
-    int n = N;
+    int n = N - 1;
 
     double num = 0.0, den = 0.0;
 
     while(n--)
     {

 
     return XTRACT_SUCCESS;
 
 }
 
-int xtract_hps(const double *data, const int N, const void *argv, double *result)
+/*int xtract_hps(const double *data, const int N, const void *argv, double *result)
 {
 
     int n = N, M, m, l, peak_index, position1_lwr;
     double *coeffs2, *coeffs3, *product, L,
           largest1_lwr, peak, ratio1, sr;

     free(coeffs2);
     free(coeffs3);
     free(product);
 
     return XTRACT_SUCCESS;
-}
-
+}*/
+
+int xtract_hps(const double *data, const int N, const void *argv, double *result)
+{
+    int numBins, numBinsToUse, i, maxIndex;
+    double tempProduct, currentMax;
+
+    numBins = N / 2;
+
+    numBinsToUse = ceil(numBins / 3.0);
+
+    if (numBinsToUse <= 1)
+    {
+        /* Input data is too short. */
+        *result = 0;
+        return XTRACT_NO_RESULT;
+    }
+
+    tempProduct = currentMax = 0;
+    for (i = 0; i < numBinsToUse; ++i)
+    {
+        tempProduct = data [i] * data [i * 2] * data [i * 3];
+
+        if (tempProduct > currentMax)
+        {
+            currentMax = tempProduct;
+            maxIndex = i;
+        }
+    }
+
+    *result = data [numBins + maxIndex];
+
+    return XTRACT_SUCCESS;
+}
 
 int xtract_f0(const double *data, const int N, const void *argv, double *result)
 {
 
     int M, tau, n;