#ifndef INCLUDED_volk_32fc_deinterleave_64f_x2_a16_H

#define INCLUDED_volk_32fc_deinterleave_64f_x2_a16_H

#include <inttypes.h>

#include <stdio.h>

#if LV_HAVE_SSE2

#include <emmintrin.h>

/*!

  \brief Deinterleaves the lv_32fc_t vector into double I & Q vector data

  \param complexVector The complex input vector

  \param iBuffer The I buffer output data

  \param qBuffer The Q buffer output data

  \param num_points The number of complex data values to be deinterleaved

*/

static inline void volk_32fc_deinterleave_64f_x2_a16_sse2(double* iBuffer, double* qBuffer, const lv_32fc_t* complexVector, unsigned int num_points){

  unsigned int number = 0;

    const float* complexVectorPtr = (float*)complexVector;

    double* iBufferPtr = iBuffer;

    double* qBufferPtr = qBuffer;

    const unsigned int halfPoints = num_points / 2;    

    __m128 cplxValue, fVal;

    __m128d dVal;

    for(;number < halfPoints; number++){

      cplxValue = _mm_load_ps(complexVectorPtr);

      complexVectorPtr += 4;

      // Arrange in i1i2i1i2 format

      fVal = _mm_shuffle_ps(cplxValue, cplxValue, _MM_SHUFFLE(2,0,2,0));

      dVal = _mm_cvtps_pd(fVal); 

      _mm_store_pd(iBufferPtr, dVal);

      // Arrange in q1q2q1q2 format

      fVal = _mm_shuffle_ps(cplxValue, cplxValue, _MM_SHUFFLE(3,1,3,1));

      dVal = _mm_cvtps_pd(fVal); 

      _mm_store_pd(qBufferPtr, dVal);

      iBufferPtr += 2;

      qBufferPtr += 2;

    }

    number = halfPoints * 2;

    for(; number < num_points; number++){

      *iBufferPtr++ = *complexVectorPtr++;

      *qBufferPtr++ = *complexVectorPtr++;

    }

}

#endif /* LV_HAVE_SSE */

#if LV_HAVE_GENERIC

/*!

  \brief Deinterleaves the lv_32fc_t vector into double I & Q vector data

  \param complexVector The complex input vector

  \param iBuffer The I buffer output data

  \param qBuffer The Q buffer output data

  \param num_points The number of complex data values to be deinterleaved

*/

static inline void volk_32fc_deinterleave_64f_x2_a16_generic(double* iBuffer, double* qBuffer, const lv_32fc_t* complexVector, unsigned int num_points){

  unsigned int number = 0;

  const float* complexVectorPtr = (float*)complexVector;

  double* iBufferPtr = iBuffer;

  double* qBufferPtr = qBuffer;

  for(number = 0; number < num_points; number++){

    *iBufferPtr++ = (double)*complexVectorPtr++;

    *qBufferPtr++ = (double)*complexVectorPtr++;

  }

}

#endif /* LV_HAVE_GENERIC */

#endif /* INCLUDED_volk_32fc_deinterleave_64f_x2_a16_H */