| // Copyright 2019 Google LLC |
| // |
| // This source code is licensed under the BSD-style license found in the |
| // LICENSE file in the root directory of this source tree. |
| |
| #include <assert.h> |
| |
| #include <arm_neon.h> |
| |
| #include <xnnpack/dwconv.h> |
| #include <xnnpack/math.h> |
| |
| |
| void xnn_f32_dwconv_spchw_ukernel_3x3p1__neonfma( |
| size_t m, |
| size_t n, |
| const float* input, |
| const float* weights, |
| float* output, |
| size_t input_tuple_stride, |
| size_t output_tuple_stride, |
| size_t input_width_stride, |
| size_t output_width_stride, |
| const union xnn_f32_spchw_params params[restrict static 1]) |
| { |
| assert(n != 0); |
| |
| const uint32x4_t vmask = vld1q_u32(params->neon.mask); |
| const float32x4_t vmax = vld1q_dup_f32(¶ms->neon.max); |
| const float32x4_t vmin = vld1q_dup_f32(¶ms->neon.min); |
| |
| const size_t input_width_increment = 3 * input_width_stride - round_up_po2(n, 4) / 4 * input_tuple_stride; |
| const size_t output_width_increment = 3 * output_width_stride - (n - 1) / 4 * output_tuple_stride; |
| const size_t input_width_increment_single = input_width_stride - round_up_po2(n, 4) / 4 * input_tuple_stride; |
| const size_t output_width_increment_single = output_width_stride - (n - 1) / 4 * output_tuple_stride; |
| |
| // No vertical padding. |
| const float* i0 = input; |
| const float* i1 = (const float*) ((uintptr_t) i0 + input_width_stride); |
| const float* i2 = (const float*) ((uintptr_t) i1 + input_width_stride); |
| const float* i3 = (const float*) ((uintptr_t) i2 + input_width_stride); |
| const float* i4 = (const float*) ((uintptr_t) i3 + input_width_stride); |
| |
| float* output0 = output; |
| float* output1 = (float *)((uintptr_t)output0 + output_width_stride); |
| float* output2 = (float *)((uintptr_t)output1 + output_width_stride); |
| |
| const float32x4_t vw0123 = vld1q_f32(weights); |
| const float32x4_t vw4567 = vld1q_f32(weights + 4); |
| const float32x2_t vw89 = vld1_f32(weights + 8); |
| |
| while (m >= 3) { |
| float32x4_t vi0x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi1x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi2x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi3x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi4x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi0x4567 = vld1q_f32(i0); i0 = (const float*) ((uintptr_t) i0 + input_tuple_stride); |
| float32x4_t vi1x4567 = vld1q_f32(i1); i1 = (const float*) ((uintptr_t) i1 + input_tuple_stride); |
| float32x4_t vi2x4567 = vld1q_f32(i2); i2 = (const float*) ((uintptr_t) i2 + input_tuple_stride); |
| float32x4_t vi3x4567 = vld1q_f32(i3); i3 = (const float*) ((uintptr_t) i3 + input_tuple_stride); |
| float32x4_t vi4x4567 = vld1q_f32(i4); i4 = (const float*) ((uintptr_t) i4 + input_tuple_stride); |
| |
| size_t k = n; |
| for (; k > 4; k -= 4) { |
| float32x4_t vo4567p00 = vdupq_laneq_f32(vw0123, 0); |
| float32x4_t vo4567p01 = vdupq_laneq_f32(vw0123, 0); |
| float32x4_t vo4567p02 = vdupq_laneq_f32(vw0123, 0); |
| |
| const float32x4_t vi0x89AB = vld1q_f32(i0); i0 = (const float*) ((uintptr_t) i0 + input_tuple_stride); |
| const float32x4_t vi1x89AB = vld1q_f32(i1); i1 = (const float*) ((uintptr_t) i1 + input_tuple_stride); |
| const float32x4_t vi2x89AB = vld1q_f32(i2); i2 = (const float*) ((uintptr_t) i2 + input_tuple_stride); |
| const float32x4_t vi3x89AB = vld1q_f32(i3); i3 = (const float*) ((uintptr_t) i3 + input_tuple_stride); |
| const float32x4_t vi4x89AB = vld1q_f32(i4); i4 = (const float*) ((uintptr_t) i4 + input_tuple_stride); |
| |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi0x4567, vw0123, 2); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi1x4567, vw4567, 1); |
| vo4567p00 = vfmaq_lane_f32(vo4567p00, vi2x4567, vw89, 0); |
| |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi1x4567, vw0123, 2); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi2x4567, vw4567, 1); |
| vo4567p01 = vfmaq_lane_f32(vo4567p01, vi3x4567, vw89, 0); |
| |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi2x4567, vw0123, 2); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi3x4567, vw4567, 1); |
| vo4567p02 = vfmaq_lane_f32(vo4567p02, vi4x4567, vw89, 0); |
| |
| const float32x4_t vi0x3456 = vextq_f32(vi0x0123, vi0x4567, 3); |
| const float32x4_t vi1x3456 = vextq_f32(vi1x0123, vi1x4567, 3); |
| const float32x4_t vi2x3456 = vextq_f32(vi2x0123, vi2x4567, 3); |
| const float32x4_t vi3x3456 = vextq_f32(vi3x0123, vi3x4567, 3); |
| const float32x4_t vi4x3456 = vextq_f32(vi4x0123, vi4x4567, 3); |
| |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi0x3456, vw0123, 1); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi1x3456, vw4567, 0); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi2x3456, vw4567, 3); |
| |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi1x3456, vw0123, 1); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi2x3456, vw4567, 0); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi3x3456, vw4567, 3); |
| |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi2x3456, vw0123, 1); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi3x3456, vw4567, 0); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi4x3456, vw4567, 3); |
| |
| vi0x0123 = vi0x4567; |
| vi1x0123 = vi1x4567; |
| vi2x0123 = vi2x4567; |
| vi3x0123 = vi3x4567; |
| vi4x0123 = vi4x4567; |
| |
| const float32x4_t vi0x5678 = vextq_f32(vi0x4567, vi0x89AB, 1); |
| const float32x4_t vi1x5678 = vextq_f32(vi1x4567, vi1x89AB, 1); |
| const float32x4_t vi2x5678 = vextq_f32(vi2x4567, vi2x89AB, 1); |
| const float32x4_t vi3x5678 = vextq_f32(vi3x4567, vi3x89AB, 1); |
| const float32x4_t vi4x5678 = vextq_f32(vi4x4567, vi4x89AB, 1); |
| |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi0x5678, vw0123, 3); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi1x5678, vw4567, 2); |
| vo4567p00 = vfmaq_lane_f32(vo4567p00, vi2x5678, vw89, 1); |
| |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi1x5678, vw0123, 3); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi2x5678, vw4567, 2); |
| vo4567p01 = vfmaq_lane_f32(vo4567p01, vi3x5678, vw89, 1); |
| |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi2x5678, vw0123, 3); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi3x5678, vw4567, 2); |
| vo4567p02 = vfmaq_lane_f32(vo4567p02, vi4x5678, vw89, 1); |
| |
| vi0x4567 = vi0x89AB; |
| vi1x4567 = vi1x89AB; |
| vi2x4567 = vi2x89AB; |
| vi3x4567 = vi3x89AB; |
| vi4x4567 = vi4x89AB; |
| |
| float32x4_t vo0 = vo4567p00; |
| float32x4_t vo1 = vo4567p01; |
| float32x4_t vo2 = vo4567p02; |
| |
| vo0 = vmaxq_f32(vo0, vmin); |
| vo0 = vminq_f32(vo0, vmax); |
| vo1 = vmaxq_f32(vo1, vmin); |
| vo1 = vminq_f32(vo1, vmax); |
| vo2 = vmaxq_f32(vo2, vmin); |
| vo2 = vminq_f32(vo2, vmax); |
| |
| vst1q_f32(output0, vo0); output0 = (float*) ((uintptr_t) output0 + output_tuple_stride); |
| vst1q_f32(output1, vo1); output1 = (float*) ((uintptr_t) output1 + output_tuple_stride); |
| vst1q_f32(output2, vo2); output2 = (float*) ((uintptr_t) output2 + output_tuple_stride); |
| } |
| // Always process the last block of 1..4 pixels. |
| assert(k >= 1); |
| assert(k <= 4); |
| { |
| float32x4_t vo4567p00 = vdupq_laneq_f32(vw0123, 0); |
| float32x4_t vo4567p01 = vdupq_laneq_f32(vw0123, 0); |
| float32x4_t vo4567p02 = vdupq_laneq_f32(vw0123, 0); |
| |
| vi0x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi0x4567))); |
| vi1x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi1x4567))); |
| vi2x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi2x4567))); |
| vi3x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi3x4567))); |
| vi4x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi4x4567))); |
| |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi0x4567, vw0123, 2); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi1x4567, vw4567, 1); |
| vo4567p00 = vfmaq_lane_f32(vo4567p00, vi2x4567, vw89, 0); |
| |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi1x4567, vw0123, 2); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi2x4567, vw4567, 1); |
| vo4567p01 = vfmaq_lane_f32(vo4567p01, vi3x4567, vw89, 0); |
| |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi2x4567, vw0123, 2); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi3x4567, vw4567, 1); |
| vo4567p02 = vfmaq_lane_f32(vo4567p02, vi4x4567, vw89, 0); |
| |
| const float32x4_t vi0x3456 = vextq_f32(vi0x0123, vi0x4567, 3); |
| const float32x4_t vi1x3456 = vextq_f32(vi1x0123, vi1x4567, 3); |
| const float32x4_t vi2x3456 = vextq_f32(vi2x0123, vi2x4567, 3); |
| const float32x4_t vi3x3456 = vextq_f32(vi3x0123, vi3x4567, 3); |
| const float32x4_t vi4x3456 = vextq_f32(vi4x0123, vi4x4567, 3); |
| |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi0x3456, vw0123, 1); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi1x3456, vw4567, 0); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi2x3456, vw4567, 3); |
| |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi1x3456, vw0123, 1); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi2x3456, vw4567, 0); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi3x3456, vw4567, 3); |
| |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi2x3456, vw0123, 1); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi3x3456, vw4567, 0); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi4x3456, vw4567, 3); |
| |
| const float32x4_t vzero = vmovq_n_f32(0.0f); |
| const float32x4_t vi0x5678 = vextq_f32(vi0x4567, vzero, 1); |
| const float32x4_t vi1x5678 = vextq_f32(vi1x4567, vzero, 1); |
| const float32x4_t vi2x5678 = vextq_f32(vi2x4567, vzero, 1); |
| const float32x4_t vi3x5678 = vextq_f32(vi3x4567, vzero, 1); |
| const float32x4_t vi4x5678 = vextq_f32(vi4x4567, vzero, 1); |
| |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi0x5678, vw0123, 3); |
| vo4567p00 = vfmaq_laneq_f32(vo4567p00, vi1x5678, vw4567, 2); |
| vo4567p00 = vfmaq_lane_f32(vo4567p00, vi2x5678, vw89, 1); |
| |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi1x5678, vw0123, 3); |
| vo4567p01 = vfmaq_laneq_f32(vo4567p01, vi2x5678, vw4567, 2); |
| vo4567p01 = vfmaq_lane_f32(vo4567p01, vi3x5678, vw89, 1); |
| |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi2x5678, vw0123, 3); |
| vo4567p02 = vfmaq_laneq_f32(vo4567p02, vi3x5678, vw4567, 2); |
| vo4567p02 = vfmaq_lane_f32(vo4567p02, vi4x5678, vw89, 1); |
| |
| float32x4_t vo0 = vo4567p00; |
| float32x4_t vo1 = vo4567p01; |
| float32x4_t vo2 = vo4567p02; |
| |
| vo0 = vmaxq_f32(vo0, vmin); |
| vo0 = vminq_f32(vo0, vmax); |
| vo1 = vmaxq_f32(vo1, vmin); |
| vo1 = vminq_f32(vo1, vmax); |
| vo2 = vmaxq_f32(vo2, vmin); |
| vo2 = vminq_f32(vo2, vmax); |
| |
| if XNN_LIKELY(k & 4) { |
| vst1q_f32(output0, vo0); |
| vst1q_f32(output1, vo1); |
| vst1q_f32(output2, vo2); |
| } else { |
| float* output0_lo = output0; |
| float* output1_lo = output1; |
| float* output2_lo = output2; |
| float32x2_t vo0_lo = vget_low_f32(vo0); |
| float32x2_t vo1_lo = vget_low_f32(vo1); |
| float32x2_t vo2_lo = vget_low_f32(vo2); |
| if (k & 2) { |
| vst1_f32(output0_lo, vo0_lo); output0_lo += 2; |
| vst1_f32(output1_lo, vo1_lo); output1_lo += 2; |
| vst1_f32(output2_lo, vo2_lo); output2_lo += 2; |
| vo0_lo = vget_high_f32(vo0); |
| vo1_lo = vget_high_f32(vo1); |
| vo2_lo = vget_high_f32(vo2); |
| } |
| if (k & 1) { |
| vst1_lane_f32(output0_lo, vo0_lo, 0); |
| vst1_lane_f32(output1_lo, vo1_lo, 0); |
| vst1_lane_f32(output2_lo, vo2_lo, 0); |
| } |
| } |
| } |
| |
| i0 = (const float*) ((uintptr_t) i0 + input_width_increment); |
| i1 = (const float*) ((uintptr_t) i1 + input_width_increment); |
| i2 = (const float*) ((uintptr_t) i2 + input_width_increment); |
| i3 = (const float*) ((uintptr_t) i3 + input_width_increment); |
| i4 = (const float*) ((uintptr_t) i4 + input_width_increment); |
| output0 = (float*) ((uintptr_t) output0 + output_width_increment); |
| output1 = (float*) ((uintptr_t) output1 + output_width_increment); |
| output2 = (float*) ((uintptr_t) output2 + output_width_increment); |
| m -= 3; |
| } |
| |
| while (m != 0) { |
| float32x4_t vi0x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi1x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi2x0123 = vmovq_n_f32(0.0f); |
| float32x4_t vi0x4567 = vld1q_f32(i0); i0 = (const float*) ((uintptr_t) i0 + input_tuple_stride); |
| float32x4_t vi1x4567 = vld1q_f32(i1); i1 = (const float*) ((uintptr_t) i1 + input_tuple_stride); |
| float32x4_t vi2x4567 = vld1q_f32(i2); i2 = (const float*) ((uintptr_t) i2 + input_tuple_stride); |
| |
| size_t k = n; |
| for (; k > 4; k -= 4) { |
| float32x4_t vo4567p0 = vdupq_laneq_f32(vw0123, 0); |
| |
| const float32x4_t vi0x89AB = vld1q_f32(i0); i0 = (const float*) ((uintptr_t) i0 + input_tuple_stride); |
| const float32x4_t vi1x89AB = vld1q_f32(i1); i1 = (const float*) ((uintptr_t) i1 + input_tuple_stride); |
| const float32x4_t vi2x89AB = vld1q_f32(i2); i2 = (const float*) ((uintptr_t) i2 + input_tuple_stride); |
| |
| vo4567p0 = vfmaq_laneq_f32(vo4567p0, vi0x4567, vw0123, 2); |
| float32x4_t vo4567p1 = vmulq_laneq_f32(vi1x4567, vw4567, 1); |
| float32x4_t vo4567p2 = vmulq_lane_f32(vi2x4567, vw89, 0); |
| |
| const float32x4_t vi0x3456 = vextq_f32(vi0x0123, vi0x4567, 3); |
| const float32x4_t vi1x3456 = vextq_f32(vi1x0123, vi1x4567, 3); |
| const float32x4_t vi2x3456 = vextq_f32(vi2x0123, vi2x4567, 3); |
| |
| vo4567p0 = vfmaq_laneq_f32(vo4567p0, vi0x3456, vw0123, 1); |
| vo4567p1 = vfmaq_laneq_f32(vo4567p1, vi1x3456, vw4567, 0); |
| vo4567p2 = vfmaq_laneq_f32(vo4567p2, vi2x3456, vw4567, 3); |
| |
| vi0x0123 = vi0x4567; |
| vi1x0123 = vi1x4567; |
| vi2x0123 = vi2x4567; |
| |
| const float32x4_t vi0x5678 = vextq_f32(vi0x4567, vi0x89AB, 1); |
| const float32x4_t vi1x5678 = vextq_f32(vi1x4567, vi1x89AB, 1); |
| const float32x4_t vi2x5678 = vextq_f32(vi2x4567, vi2x89AB, 1); |
| |
| vo4567p0 = vfmaq_laneq_f32(vo4567p0, vi0x5678, vw0123, 3); |
| vo4567p1 = vfmaq_laneq_f32(vo4567p1, vi1x5678, vw4567, 2); |
| vo4567p2 = vfmaq_lane_f32(vo4567p2, vi2x5678, vw89, 1); |
| |
| vi0x4567 = vi0x89AB; |
| vi1x4567 = vi1x89AB; |
| vi2x4567 = vi2x89AB; |
| |
| float32x4_t vo = vaddq_f32(vo4567p0, vo4567p1); |
| vo = vaddq_f32(vo, vo4567p2); |
| |
| vo = vmaxq_f32(vo, vmin); |
| vo = vminq_f32(vo, vmax); |
| |
| vst1q_f32(output0, vo); output0 = (float*) ((uintptr_t) output0 + output_tuple_stride); |
| } |
| // Always process the last block of 1..4 pixels. |
| assert(k >= 1); |
| assert(k <= 4); |
| { |
| float32x4_t vo4567p0 = vdupq_laneq_f32(vw0123, 0); |
| |
| vi0x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi0x4567))); |
| vi1x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi1x4567))); |
| vi2x4567 = vreinterpretq_f32_u32(vandq_u32(vmask, vreinterpretq_u32_f32(vi2x4567))); |
| |
| vo4567p0 = vfmaq_laneq_f32(vo4567p0, vi0x4567, vw0123, 2); |
| float32x4_t vo4567p1 = vmulq_laneq_f32(vi1x4567, vw4567, 1); |
| float32x4_t vo4567p2 = vmulq_lane_f32(vi2x4567, vw89, 0); |
| |
| const float32x4_t vi0x3456 = vextq_f32(vi0x0123, vi0x4567, 3); |
| const float32x4_t vi1x3456 = vextq_f32(vi1x0123, vi1x4567, 3); |
| const float32x4_t vi2x3456 = vextq_f32(vi2x0123, vi2x4567, 3); |
| |
| vo4567p0 = vfmaq_laneq_f32(vo4567p0, vi0x3456, vw0123, 1); |
| vo4567p1 = vfmaq_laneq_f32(vo4567p1, vi1x3456, vw4567, 0); |
| vo4567p2 = vfmaq_laneq_f32(vo4567p2, vi2x3456, vw4567, 3); |
| |
| const float32x4_t vzero = vmovq_n_f32(0.0f); |
| const float32x4_t vi0x5678 = vextq_f32(vi0x4567, vzero, 1); |
| const float32x4_t vi1x5678 = vextq_f32(vi1x4567, vzero, 1); |
| const float32x4_t vi2x5678 = vextq_f32(vi2x4567, vzero, 1); |
| |
| vo4567p0 = vfmaq_laneq_f32(vo4567p0, vi0x5678, vw0123, 3); |
| vo4567p1 = vfmaq_laneq_f32(vo4567p1, vi1x5678, vw4567, 2); |
| vo4567p2 = vfmaq_lane_f32(vo4567p2, vi2x5678, vw89, 1); |
| |
| float32x4_t vo = vaddq_f32(vo4567p0, vo4567p1); |
| vo = vaddq_f32(vo, vo4567p2); |
| |
| vo = vmaxq_f32(vo, vmin); |
| vo = vminq_f32(vo, vmax); |
| |
| if XNN_LIKELY(k & 4) { |
| vst1q_f32(output0, vo); |
| } else { |
| float* output0_lo = output0; |
| float32x2_t vo_lo = vget_low_f32(vo); |
| if (k & 2) { |
| vst1_f32(output0_lo, vo_lo); output0_lo += 2; |
| vo_lo = vget_high_f32(vo); |
| } |
| if (k & 1) { |
| vst1_lane_f32(output0_lo, vo_lo, 0); |
| } |
| } |
| } |
| |
| i0 = (const float*) ((uintptr_t) i0 + input_width_increment_single); |
| i1 = (const float*) ((uintptr_t) i1 + input_width_increment_single); |
| i2 = (const float*) ((uintptr_t) i2 + input_width_increment_single); |
| output0 = (float*) ((uintptr_t) output0 + output_width_increment_single); |
| m -= 1; |
| } |
| } |