123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135 |
- #include "arm_math.h"
- void arm_offset_q7(
- q7_t * pSrc,
- q7_t offset,
- q7_t * pDst,
- uint32_t blockSize)
- {
- uint32_t blkCnt;
- #ifndef ARM_MATH_CM0_FAMILY
- q31_t offset_packed;
-
- blkCnt = blockSize >> 2u;
-
- offset_packed = __PACKq7(offset, offset, offset, offset);
-
- while(blkCnt > 0u)
- {
-
-
- *__SIMD32(pDst)++ = __QADD8(*__SIMD32(pSrc)++, offset_packed);
-
- blkCnt--;
- }
-
- blkCnt = blockSize % 0x4u;
- while(blkCnt > 0u)
- {
-
-
- *pDst++ = (q7_t) __SSAT(*pSrc++ + offset, 8);
-
- blkCnt--;
- }
- #else
-
-
- blkCnt = blockSize;
- while(blkCnt > 0u)
- {
-
-
- *pDst++ = (q7_t) __SSAT((q15_t) * pSrc++ + offset, 8);
-
- blkCnt--;
- }
- #endif
- }
|