From 1830d70f92accf609d478ba9ca5f14363e4f5cd0 Mon Sep 17 00:00:00 2001
From: kevin <kevin@larke.org>
Date: Tue, 14 Feb 2023 20:56:39 -0500
Subject: [PATCH] cwVectOps.h : Added interleave() and deinterleave()

---
 cwVectOps.h | 39 ++++++++++++++++++++++++++++++++++-----
 1 file changed, 34 insertions(+), 5 deletions(-)

diff --git a/cwVectOps.h b/cwVectOps.h
index 704726a..a5e402c 100644
--- a/cwVectOps.h
+++ b/cwVectOps.h
@@ -51,19 +51,23 @@ namespace cw
     // Move,fill,copy
     //
     template< typename T0, typename T1 >
-      void copy( T0* v0, const T1* v1, unsigned n )
+    void copy( T0* v0, const T1* v1, unsigned n )
     {
       for(unsigned i=0; i<n; ++i)
         v0[i] = (T0)v1[i]; // Note: copy with convert - not the same as memcpy. 
     }
     
     template< typename T0, typename T1 >
-      void fill( T0* v, unsigned n, const T1& value=0 )
+    void fill( T0* v, unsigned n, const T1& value, unsigned dst_offset )
     {
-      for(unsigned i=0; i<n; ++i)
-        v[i] = value;
+      for(unsigned i=0,j=0; i<n; ++i,j+=dst_offset)
+        v[j] = value;
     }
-
+    
+    template< typename T0, typename T1 >
+    void fill( T0* v, unsigned n, const T1& value=0 )
+    { fill(v,n,value,1); }
+    
     template< typename T >
       void zero( T* v, unsigned n )
     { fill(v,n,0); }
@@ -342,6 +346,31 @@ namespace cw
     //==================================================================================================================
     // Signal Processing
     //
+    template< typename T0, typename T1 >
+    void interleave( T0* v0, const T1* v1, unsigned frameN, unsigned dstChCnt )
+    {
+      // v0[] = { LRLRLRLR ], v1[] = [ LLLLRRRR ]
+      for(unsigned k=0; k<dstChCnt; ++k)
+      {
+        unsigned n = k*frameN;
+        for(unsigned i=0,j=k; i<frameN; ++i,j+=dstChCnt)
+          v0[j] = (T0)v1[i+n];
+      }
+    }
+
+    template< typename T0, typename T1 >
+    void deinterleave( T0* v0, const T1* v1, unsigned frameN, unsigned srcChCnt )
+    {
+      // v0[] = [ LLLLRRRR ], v1[] = { LRLRLRLR ]
+      for(unsigned k=0; k<srcChCnt; ++k)
+      {
+        unsigned n = k*frameN;
+        for(unsigned i=0,j=k; i<frameN; ++i,j+=srcChCnt)
+          v0[i+n] = (T0)v1[j];
+      }
+    }
+
+    
 
     template< typename T >
       unsigned phasor( T* y, unsigned n, T srate, T hz, unsigned init_idx=0 )