1 // Copyright 2020 Google LLC
2 //
3 // This source code is licensed under the BSD-style license found in the
4 // LICENSE file in the root directory of this source tree.
5
6 #include <assert.h>
7 #include <stddef.h>
8
9 #include <arm_neon.h>
10
11 #include <xnnpack/math.h>
12 #include <xnnpack/math-stubs.h>
13
14
xnn_math_f32_sqrt__neonfma_nr3fma(size_t n,const float * input,float * output)15 void xnn_math_f32_sqrt__neonfma_nr3fma(
16 size_t n,
17 const float* input,
18 float* output)
19 {
20 assert(n % (4 * sizeof(float)) == 0);
21
22 const float32x4_t vhalf = vmovq_n_f32(0.5f);
23 for (; n != 0; n -= 4 * sizeof(float)) {
24 const float32x4_t vx = vld1q_f32(input); input += 4;
25
26 // Initial approximation
27 const float32x4_t vrsqrtx = vrsqrteq_f32(vx);
28 float32x4_t vsqrtx = vmulq_f32(vrsqrtx, vx);
29 float32x4_t vhalfrsqrtx = vmulq_f32(vrsqrtx, vhalf);
30
31 // Netwon-Raphson iteration:
32 // residual <- 0.5 - sqrtx * halfrsqrtx
33 // halfrsqrtx <- halfrsqrtx + halfrsqrtx * residual
34 // sqrtx <- sqrtx + sqrtx * residual
35 float32x4_t vresidual = vfmsq_f32(vhalf, vsqrtx, vhalfrsqrtx);
36 vhalfrsqrtx = vfmaq_f32(vhalfrsqrtx, vresidual, vhalfrsqrtx);
37 vsqrtx = vfmaq_f32(vsqrtx, vresidual, vsqrtx);
38
39 vresidual = vfmsq_f32(vhalf, vsqrtx, vhalfrsqrtx);
40 vhalfrsqrtx = vfmaq_f32(vhalfrsqrtx, vresidual, vhalfrsqrtx);
41 vsqrtx = vfmaq_f32(vsqrtx, vresidual, vsqrtx);
42
43 vresidual = vfmsq_f32(vhalf, vsqrtx, vhalfrsqrtx);
44 vsqrtx = vfmaq_f32(vsqrtx, vresidual, vsqrtx);
45
46 const float32x4_t vy = vsqrtx;
47
48 vst1q_f32(output, vy); output += 4;
49 }
50 }
51