arm_sub_f32.c 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116
  1. /* ----------------------------------------------------------------------
  2. * Project: CMSIS DSP Library
  3. * Title: arm_sub_f32.c
  4. * Description: Floating-point vector subtraction
  5. *
  6. * $Date: 18. March 2019
  7. * $Revision: V1.6.0
  8. *
  9. * Target Processor: Cortex-M cores
  10. * -------------------------------------------------------------------- */
  11. /*
  12. * Copyright (C) 2010-2019 ARM Limited or its affiliates. All rights reserved.
  13. *
  14. * SPDX-License-Identifier: Apache-2.0
  15. *
  16. * Licensed under the Apache License, Version 2.0 (the License); you may
  17. * not use this file except in compliance with the License.
  18. * You may obtain a copy of the License at
  19. *
  20. * www.apache.org/licenses/LICENSE-2.0
  21. *
  22. * Unless required by applicable law or agreed to in writing, software
  23. * distributed under the License is distributed on an AS IS BASIS, WITHOUT
  24. * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  25. * See the License for the specific language governing permissions and
  26. * limitations under the License.
  27. */
  28. #include "arm_math.h"
  29. /**
  30. @ingroup groupMath
  31. */
  32. /**
  33. @defgroup BasicSub Vector Subtraction
  34. Element-by-element subtraction of two vectors.
  35. <pre>
  36. pDst[n] = pSrcA[n] - pSrcB[n], 0 <= n < blockSize.
  37. </pre>
  38. There are separate functions for floating-point, Q7, Q15, and Q31 data types.
  39. */
  40. /**
  41. @addtogroup BasicSub
  42. @{
  43. */
  44. /**
  45. @brief Floating-point vector subtraction.
  46. @param[in] pSrcA points to the first input vector
  47. @param[in] pSrcB points to the second input vector
  48. @param[out] pDst points to the output vector
  49. @param[in] blockSize number of samples in each vector
  50. @return none
  51. */
  52. void arm_sub_f32(
  53. const float32_t * pSrcA,
  54. const float32_t * pSrcB,
  55. float32_t * pDst,
  56. uint32_t blockSize)
  57. {
  58. uint32_t blkCnt; /* Loop counter */
  59. #if defined (ARM_MATH_LOOPUNROLL)
  60. /* Loop unrolling: Compute 4 outputs at a time */
  61. blkCnt = blockSize >> 2U;
  62. while (blkCnt > 0U)
  63. {
  64. /* C = A - B */
  65. /* Subtract and store result in destination buffer. */
  66. *pDst++ = (*pSrcA++) - (*pSrcB++);
  67. *pDst++ = (*pSrcA++) - (*pSrcB++);
  68. *pDst++ = (*pSrcA++) - (*pSrcB++);
  69. *pDst++ = (*pSrcA++) - (*pSrcB++);
  70. /* Decrement loop counter */
  71. blkCnt--;
  72. }
  73. /* Loop unrolling: Compute remaining outputs */
  74. blkCnt = blockSize % 0x4U;
  75. #else
  76. /* Initialize blkCnt with number of samples */
  77. blkCnt = blockSize;
  78. #endif /* #if defined (ARM_MATH_LOOPUNROLL) */
  79. while (blkCnt > 0U)
  80. {
  81. /* C = A - B */
  82. /* Subtract and store result in destination buffer. */
  83. *pDst++ = (*pSrcA++) - (*pSrcB++);
  84. /* Decrement loop counter */
  85. blkCnt--;
  86. }
  87. }
  88. /**
  89. @} end of BasicSub group
  90. */