arm_negate_f32.c 3.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145
  1. /* ----------------------------------------------------------------------
  2. * Project: CMSIS DSP Library
  3. * Title: arm_negate_f32.c
  4. * Description: Negates floating-point vectors
  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 BasicNegate Vector Negate
  34. Negates the elements of a vector.
  35. <pre>
  36. pDst[n] = -pSrc[n], 0 <= n < blockSize.
  37. </pre>
  38. The functions support in-place computation allowing the source and
  39. destination pointers to reference the same memory buffer.
  40. There are separate functions for floating-point, Q7, Q15, and Q31 data types.
  41. */
  42. /**
  43. @addtogroup BasicNegate
  44. @{
  45. */
  46. /**
  47. @brief Negates the elements of a floating-point vector.
  48. @param[in] pSrc points to input vector.
  49. @param[out] pDst points to output vector.
  50. @param[in] blockSize number of samples in each vector.
  51. @return none
  52. */
  53. void arm_negate_f32(
  54. const float32_t * pSrc,
  55. float32_t * pDst,
  56. uint32_t blockSize)
  57. {
  58. uint32_t blkCnt; /* Loop counter */
  59. #if defined(ARM_MATH_NEON_EXPERIMENTAL)
  60. float32x4_t vec1;
  61. float32x4_t res;
  62. /* Compute 4 outputs at a time */
  63. blkCnt = blockSize >> 2U;
  64. while (blkCnt > 0U)
  65. {
  66. /* C = -A */
  67. /* Negate and then store the results in the destination buffer. */
  68. vec1 = vld1q_f32(pSrc);
  69. res = vnegq_f32(vec1);
  70. vst1q_f32(pDst, res);
  71. /* Increment pointers */
  72. pSrc += 4;
  73. pDst += 4;
  74. /* Decrement the loop counter */
  75. blkCnt--;
  76. }
  77. /* Tail */
  78. blkCnt = blockSize & 0x3;
  79. #else
  80. #if defined (ARM_MATH_LOOPUNROLL)
  81. /* Loop unrolling: Compute 4 outputs at a time */
  82. blkCnt = blockSize >> 2U;
  83. while (blkCnt > 0U)
  84. {
  85. /* C = -A */
  86. /* Negate and store result in destination buffer. */
  87. *pDst++ = -*pSrc++;
  88. *pDst++ = -*pSrc++;
  89. *pDst++ = -*pSrc++;
  90. *pDst++ = -*pSrc++;
  91. /* Decrement loop counter */
  92. blkCnt--;
  93. }
  94. /* Loop unrolling: Compute remaining outputs */
  95. blkCnt = blockSize % 0x4U;
  96. #else
  97. /* Initialize blkCnt with number of samples */
  98. blkCnt = blockSize;
  99. #endif /* #if defined (ARM_MATH_LOOPUNROLL) */
  100. #endif /* #if defined(ARM_MATH_NEON_EXPERIMENTAL) */
  101. while (blkCnt > 0U)
  102. {
  103. /* C = -A */
  104. /* Negate and store result in destination buffer. */
  105. *pDst++ = -*pSrc++;
  106. /* Decrement loop counter */
  107. blkCnt--;
  108. }
  109. }
  110. /**
  111. @} end of BasicNegate group
  112. */