1 files changed, 79 insertions, 0 deletions
diff --git a/libaf/af_tools.c b/libaf/af_tools.c
new file mode 100644
index 0000000000..6c2111f981
--- /dev/null
+++ b/libaf/af_tools.c
@@ -0,0 +1,79 @@
+#include <math.h>
+#include <af.h>
+
+/* Convert to gain value from dB. Returns AF_OK if of and AF_ERROR if
+   fail */
+inline int af_from_dB(int n, float* in, float* out, float k, float mi, float ma)
+{
+  int i = 0; 
+  // Sanity check
+  if(!in || !out) 
+    return AF_ERROR;
+
+  for(i=0;i<n;i++){
+    if(in[i]<=-200)
+      out[i]=0.0;
+    else
+      out[i]=pow(10.0,clamp(in[i],mi,ma)/k);
+  }
+  return AF_OK;
+}
+
+/* Convert from gain value to dB. Returns AF_OK if of and AF_ERROR if
+   fail */
+inline int af_to_dB(int n, float* in, float* out, float k)
+{
+  int i = 0; 
+  // Sanity check
+  if(!in || !out) 
+    return AF_ERROR;
+
+  for(i=0;i<AF_NCH;i++){
+    if(in[i] == 0.0)
+      out[i]=-200.0;
+    else
+      out[i]=k*log10(in[i]);
+  }
+  return AF_OK;
+}
+
+/* Convert from ms to sample time*/
+inline int af_from_ms(int n, float* in, float* out, int rate, float mi, float ma)
+{
+  int i = 0; 
+  // Sanity check
+  if(!in || !out) 
+    return AF_ERROR;
+
+  for(i=0;i<AF_NCH;i++)
+    out[i]=clamp(in[i],ma,mi);
+
+  return AF_OK;
+}
+
+/* Convert from sample time to ms */
+inline int af_to_ms(int n, float* in, float* out, int rate)
+{
+  int i = 0; 
+  // Sanity check
+  if(!in || !out) 
+    return AF_ERROR;
+
+  for(i=0;i<AF_NCH;i++)
+    out[i]=in[i];
+  
+  return AF_OK;
+}
+
+/* Helper function for testing the output format */
+inline int af_test_output(struct af_instance_s* af, af_data_t* out)
+{
+  if((af->data->format != out->format) || 
+     (af->data->bps    != out->bps)    ||
+     (af->data->rate   != out->rate)   ||
+     (af->data->nch    != out->nch)){
+    memcpy(out,af->data,sizeof(af_data_t));
+    return AF_FALSE;
+  }
+  return AF_OK;
+}