CMSIS DSP Library from CMSIS 2.0. See http://www.onarm.com/cmsis/ for full details

Dependents:   K22F_DSP_Matrix_least_square BNO055-ELEC3810 1BNO055 ECE4180Project--Slave2 ... more

Committer:
simon
Date:
Thu Mar 10 15:07:50 2011 +0000
Revision:
0:1014af42efd9

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
simon 0:1014af42efd9 1 /* ----------------------------------------------------------------------
simon 0:1014af42efd9 2 * Copyright (C) 2010 ARM Limited. All rights reserved.
simon 0:1014af42efd9 3 *
simon 0:1014af42efd9 4 * $Date: 29. November 2010
simon 0:1014af42efd9 5 * $Revision: V1.0.3
simon 0:1014af42efd9 6 *
simon 0:1014af42efd9 7 * Project: CMSIS DSP Library
simon 0:1014af42efd9 8 * Title: arm_cmplx_conj_q31.c
simon 0:1014af42efd9 9 *
simon 0:1014af42efd9 10 * Description: Q31 complex conjugate.
simon 0:1014af42efd9 11 *
simon 0:1014af42efd9 12 * Target Processor: Cortex-M4/Cortex-M3
simon 0:1014af42efd9 13 *
simon 0:1014af42efd9 14 * Version 1.0.3 2010/11/29
simon 0:1014af42efd9 15 * Re-organized the CMSIS folders and updated documentation.
simon 0:1014af42efd9 16 *
simon 0:1014af42efd9 17 * Version 1.0.2 2010/11/11
simon 0:1014af42efd9 18 * Documentation updated.
simon 0:1014af42efd9 19 *
simon 0:1014af42efd9 20 * Version 1.0.1 2010/10/05
simon 0:1014af42efd9 21 * Production release and review comments incorporated.
simon 0:1014af42efd9 22 *
simon 0:1014af42efd9 23 * Version 1.0.0 2010/09/20
simon 0:1014af42efd9 24 * Production release and review comments incorporated.
simon 0:1014af42efd9 25 * ---------------------------------------------------------------------------- */
simon 0:1014af42efd9 26
simon 0:1014af42efd9 27 #include "arm_math.h"
simon 0:1014af42efd9 28
simon 0:1014af42efd9 29 /**
simon 0:1014af42efd9 30 * @ingroup groupCmplxMath
simon 0:1014af42efd9 31 */
simon 0:1014af42efd9 32
simon 0:1014af42efd9 33 /**
simon 0:1014af42efd9 34 * @addtogroup cmplx_conj
simon 0:1014af42efd9 35 * @{
simon 0:1014af42efd9 36 */
simon 0:1014af42efd9 37
simon 0:1014af42efd9 38 /**
simon 0:1014af42efd9 39 * @brief Q31 complex conjugate.
simon 0:1014af42efd9 40 * @param *pSrc points to the input vector
simon 0:1014af42efd9 41 * @param *pDst points to the output vector
simon 0:1014af42efd9 42 * @param numSamples number of complex samples in each vector
simon 0:1014af42efd9 43 * @return none.
simon 0:1014af42efd9 44 *
simon 0:1014af42efd9 45 * <b>Scaling and Overflow Behavior:</b>
simon 0:1014af42efd9 46 * \par
simon 0:1014af42efd9 47 * The function uses saturating arithmetic.
simon 0:1014af42efd9 48 * The Q31 value -1 (0x80000000) will be saturated to the maximum allowable positive value 0x7FFFFFFF.
simon 0:1014af42efd9 49 */
simon 0:1014af42efd9 50
simon 0:1014af42efd9 51 void arm_cmplx_conj_q31(
simon 0:1014af42efd9 52 q31_t * pSrc,
simon 0:1014af42efd9 53 q31_t * pDst,
simon 0:1014af42efd9 54 uint32_t numSamples)
simon 0:1014af42efd9 55 {
simon 0:1014af42efd9 56 uint32_t blkCnt; /* loop counter */
simon 0:1014af42efd9 57 q31_t in; /* Input value */
simon 0:1014af42efd9 58
simon 0:1014af42efd9 59 /*loop Unrolling */
simon 0:1014af42efd9 60 blkCnt = numSamples >> 2u;
simon 0:1014af42efd9 61
simon 0:1014af42efd9 62 /* First part of the processing with loop unrolling. Compute 4 outputs at a time.
simon 0:1014af42efd9 63 ** a second loop below computes the remaining 1 to 3 samples. */
simon 0:1014af42efd9 64 while(blkCnt > 0u)
simon 0:1014af42efd9 65 {
simon 0:1014af42efd9 66 /* C[0]+jC[1] = A[0]+ j (-1) A[1] */
simon 0:1014af42efd9 67 /* Calculate Complex Conjugate and then store the results in the destination buffer. */
simon 0:1014af42efd9 68 /* Saturated to 0x7fffffff if the input is -1(0x80000000)*/
simon 0:1014af42efd9 69 *pDst++ = *pSrc++;
simon 0:1014af42efd9 70 in = *pSrc++;
simon 0:1014af42efd9 71 *pDst++ = (in == 0x80000000) ? 0x7fffffff : -in;
simon 0:1014af42efd9 72 *pDst++ = *pSrc++;
simon 0:1014af42efd9 73 in = *pSrc++;
simon 0:1014af42efd9 74 *pDst++ = (in == 0x80000000) ? 0x7fffffff : -in;
simon 0:1014af42efd9 75 *pDst++ = *pSrc++;
simon 0:1014af42efd9 76 in = *pSrc++;
simon 0:1014af42efd9 77 *pDst++ = (in == 0x80000000) ? 0x7fffffff : -in;
simon 0:1014af42efd9 78 *pDst++ = *pSrc++;
simon 0:1014af42efd9 79 in = *pSrc++;
simon 0:1014af42efd9 80 *pDst++ = (in == 0x80000000) ? 0x7fffffff : -in;
simon 0:1014af42efd9 81
simon 0:1014af42efd9 82 /* Decrement the loop counter */
simon 0:1014af42efd9 83 blkCnt--;
simon 0:1014af42efd9 84 }
simon 0:1014af42efd9 85
simon 0:1014af42efd9 86 /* If the numSamples is not a multiple of 4, compute any remaining output samples here.
simon 0:1014af42efd9 87 ** No loop unrolling is used. */
simon 0:1014af42efd9 88 blkCnt = numSamples % 0x4u;
simon 0:1014af42efd9 89
simon 0:1014af42efd9 90 while(blkCnt > 0u)
simon 0:1014af42efd9 91 {
simon 0:1014af42efd9 92 /* C[0]+jC[1] = A[0]+ j (-1) A[1] */
simon 0:1014af42efd9 93 /* Calculate Complex Conjugate and then store the results in the destination buffer. */
simon 0:1014af42efd9 94 /* Saturated to 0x7fffffff if the input is -1(0x80000000)*/
simon 0:1014af42efd9 95 *pDst++ = *pSrc++;
simon 0:1014af42efd9 96 in = *pSrc++;
simon 0:1014af42efd9 97 *pDst++ = (in == 0x80000000) ? 0x7fffffff : -in;
simon 0:1014af42efd9 98
simon 0:1014af42efd9 99 /* Decrement the loop counter */
simon 0:1014af42efd9 100 blkCnt--;
simon 0:1014af42efd9 101 }
simon 0:1014af42efd9 102 }
simon 0:1014af42efd9 103
simon 0:1014af42efd9 104 /**
simon 0:1014af42efd9 105 * @} end of cmplx_conj group
simon 0:1014af42efd9 106 */