// Auto-generated file. Do not edit!
//   Template: src/cs16-vsquareabs/neon.c.in
//   Generator: tools/xngen
//
// Copyright 2022 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 <stddef.h>
#include <stdint.h>

#include <arm_neon.h>

#include <xnnpack/vsquareabs.h>


void xnn_cs16_vsquareabs_ukernel__neon_mlal_ld128_x16(
    size_t batch,
    const int16_t* input,
    uint32_t* output) {

  assert(batch != 0);
  assert(input != NULL);
  assert(output != NULL);

  for (; batch >= 16; batch -= 16) {
    const int16x4x2_t vi0 = vld2_s16(input); input += 8;
    const int16x4x2_t vi1 = vld2_s16(input); input += 8;
    const int16x4x2_t vi2 = vld2_s16(input); input += 8;
    const int16x4x2_t vi3 = vld2_s16(input); input += 8;

    int32x4_t vacc0 = vmull_s16(vi0.val[0], vi0.val[0]);
    vacc0 = vmlal_s16(vacc0, vi0.val[1], vi0.val[1]);
    int32x4_t vacc1 = vmull_s16(vi1.val[0], vi1.val[0]);
    vacc1 = vmlal_s16(vacc1, vi1.val[1], vi1.val[1]);
    int32x4_t vacc2 = vmull_s16(vi2.val[0], vi2.val[0]);
    vacc2 = vmlal_s16(vacc2, vi2.val[1], vi2.val[1]);
    int32x4_t vacc3 = vmull_s16(vi3.val[0], vi3.val[0]);
    vacc3 = vmlal_s16(vacc3, vi3.val[1], vi3.val[1]);

    vst1q_u32(output, vreinterpretq_u32_s32(vacc0)); output += 4;
    vst1q_u32(output, vreinterpretq_u32_s32(vacc1)); output += 4;
    vst1q_u32(output, vreinterpretq_u32_s32(vacc2)); output += 4;
    vst1q_u32(output, vreinterpretq_u32_s32(vacc3)); output += 4;
  }

  // Remainder of full vectors
  for (; batch >= 4; batch -= 4) {
    const int16x4x2_t vi = vld2_s16(input); input += 8;

    int32x4_t vacc = vmull_s16(vi.val[0], vi.val[0]);

    vacc = vmlal_s16(vacc, vi.val[1], vi.val[1]);

    vst1q_u32(output, vreinterpretq_u32_s32(vacc)); output += 4;
  }

  // Remainder of 1 to 3 elements
  if XNN_UNLIKELY(batch != 0) {
    const int16x4x2_t vi = vld2_s16(input);

    int32x4_t vacc = vmull_s16(vi.val[0], vi.val[0]);
    vacc = vmlal_s16(vacc, vi.val[1], vi.val[1]);

    uint32x2_t vacc_lo = vreinterpret_u32_s32(vget_low_s32(vacc));
    if (batch & 2) {
      vst1_u32(output, vacc_lo); output += 2;
      vacc_lo = vreinterpret_u32_s32(vget_high_s32(vacc));
    }
    if (batch & 1) {
      vst1_lane_u32(output, vacc_lo, 0);
    }
  }
}