// 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.

$assert BATCH_TILE >= 1
$ABC = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ"
$assert OP in ["ADD", "DIV", "RDIV", "MAX", "MIN", "MUL", "SUB", "RSUB", "SQRDIFF"]
#include <assert.h>

#include <arm_fp16.h>

#include "xnnpack/common.h"
#include "xnnpack/intrinsics-polyfill.h"
#include "xnnpack/math.h"
#include "xnnpack/vbinary.h"


$VOPH_F16 = {
$  "ADD": lambda x: "vaddh_f16(%s, vb)" % x,
$  "DIV": lambda x: "vdivh_f16(%s, vb)" % x,
$  "RDIV": lambda x: "vdivh_f16(vb, %s)" % x,
$  "MAX": lambda x: "vmaxnmh_f16(%s, vb)" % x,
$  "MIN": lambda x: "vminnmh_f16(%s, vb)" % x,
$  "MUL": lambda x: "vmulh_f16(%s, vb)" % x,
$  "SUB": lambda x: "vsubh_f16(%s, vb)" % x,
$  "RSUB": lambda x: "vsubh_f16(vb, %s)" % x,
$  "SQRDIFF": lambda x: "vsubh_f16(%s, vb)" % x,
$}[OP]
void xnn_f16_v${OP.lower()}c_ukernel__fp16arith_u${BATCH_TILE}(
    size_t batch,
    const xnn_float16* restrict input_a,
    const xnn_float16* restrict input_b,
    xnn_float16* restrict output,
    const struct xnn_f16_default_params params[restrict XNN_MIN_ELEMENTS(1)])
{
  assert(batch != 0);
  assert(batch % sizeof(float16_t) == 0);
  assert(input_a != NULL);
  assert(input_b != NULL);
  assert(output != NULL);

  const float16_t* a = (const float16_t*) input_a;
  const float16_t* b = (const float16_t*) input_b;
  float16_t* o = (float16_t*) output;

  const float16_t vb = *b;
  $if BATCH_TILE > 1:
    for (; batch >= ${BATCH_TILE} * sizeof(float16_t); batch -= ${BATCH_TILE} * sizeof(float16_t)) {
      $for N in range(BATCH_TILE):
        float16_t vacc${ABC[N]} = a[${N}];
      a += ${BATCH_TILE};

      $for N in range(BATCH_TILE):
        vacc${ABC[N]} = ${VOPH_F16("vacc" + ABC[N])};

      $if OP == "SQRDIFF":
        $for N in range(BATCH_TILE):
          vacc${ABC[N]} = vmulh_f16(vacc${ABC[N]}, vacc${ABC[N]});

      $for N in range(BATCH_TILE):
        o[${N}] = vacc${ABC[N]};
      o += ${BATCH_TILE};
    }
    if XNN_UNLIKELY(batch != 0) {
      $if BATCH_TILE > 2:
        do {
          float16_t vacc = *a++;
          vacc = ${VOPH_F16("vacc")};
          $if OP == "SQRDIFF":
            vacc = vmulh_f16(vacc, vacc);
          *o++ = vacc;
          batch -= sizeof(float16_t);
        } while (batch != 0);
      $else:
        float16_t vacc = *a;
        vacc = ${VOPH_F16("vacc")};
        $if OP == "SQRDIFF":
          vacc = vmulh_f16(vacc, vacc);
        *o = vacc;
    }
  $else:
    do {
      float16_t vacc = *a++;
      vacc = ${VOPH_F16("vacc")};
      $if OP == "SQRDIFF":
        vacc = vmulh_f16(vacc, vacc);
      *o++ = vacc;
      batch -= sizeof(float16_t);
    } while (batch != 0);
}
