123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140 |
- #include "arm_math.h"
- void arm_sub_q15(
- q15_t * pSrcA,
- q15_t * pSrcB,
- q15_t * pDst,
- uint32_t blockSize)
- {
- uint32_t blkCnt;
- #ifndef ARM_MATH_CM0_FAMILY
- q31_t inA1, inA2;
- q31_t inB1, inB2;
-
- blkCnt = blockSize >> 2u;
-
- while(blkCnt > 0u)
- {
-
-
- inA1 = *__SIMD32(pSrcA)++;
- inA2 = *__SIMD32(pSrcA)++;
- inB1 = *__SIMD32(pSrcB)++;
- inB2 = *__SIMD32(pSrcB)++;
- *__SIMD32(pDst)++ = __QSUB16(inA1, inB1);
- *__SIMD32(pDst)++ = __QSUB16(inA2, inB2);
-
- blkCnt--;
- }
-
- blkCnt = blockSize % 0x4u;
- while(blkCnt > 0u)
- {
-
-
- *pDst++ = (q15_t) __QSUB16(*pSrcA++, *pSrcB++);
-
- blkCnt--;
- }
- #else
-
-
- blkCnt = blockSize;
- while(blkCnt > 0u)
- {
-
-
- *pDst++ = (q15_t) __SSAT(((q31_t) * pSrcA++ - *pSrcB++), 16);
-
- blkCnt--;
- }
- #endif
- }
|