/***************************************************************************
 * Copyright (c) 2022, The OpenBLAS Project
 * All rights reserved.
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are
 * met:
 * 1. Redistributions of source code must retain the above copyright
 * notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 * notice, this list of conditions and the following disclaimer in
 * the documentation and/or other materials provided with the
 * distribution.
 * 3. Neither the name of the OpenBLAS project nor the names of
 * its contributors may be used to endorse or promote products
 * derived from this software without specific prior written permission.
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE OPENBLAS PROJECT OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 * *****************************************************************************/
#include <arm_neon.h>

#include "common.h"

int CNAME(BLASLONG m, BLASLONG n, IFLOAT *a, BLASLONG lda, IFLOAT *b) {
  IFLOAT *a_offset, *a_offset0, *a_offset1, *a_offset2, *a_offset3;
  IFLOAT *b_offset;
  a_offset = a;
  b_offset = b;

  uint16x4_t v0_h, v1_h, v2_h, v3_h, v4_h, v5_h, v6_h, v7_h;

  for (BLASLONG j = 0; j < n / 4; j++) {
    a_offset0 = a_offset;
    a_offset1 = a_offset0 + lda;
    a_offset2 = a_offset1 + lda;
    a_offset3 = a_offset2 + lda;
    a_offset += 4;

    for (BLASLONG i = 0; i < m / 4; i++) {
      v0_h = vld1_u16(a_offset0);
      v1_h = vld1_u16(a_offset1);
      v2_h = vld1_u16(a_offset2);
      v3_h = vld1_u16(a_offset3);

      v4_h = vtrn1_u16(v0_h, v1_h);
      v5_h = vtrn2_u16(v0_h, v1_h);
      v6_h = vtrn1_u16(v2_h, v3_h);
      v7_h = vtrn2_u16(v2_h, v3_h);

      v0_h = (uint16x4_t)vtrn1_u32((uint32x2_t)v4_h, (uint32x2_t)v6_h);
      v1_h = (uint16x4_t)vtrn1_u32((uint32x2_t)v5_h, (uint32x2_t)v7_h);
      v2_h = (uint16x4_t)vtrn2_u32((uint32x2_t)v4_h, (uint32x2_t)v6_h);
      v3_h = (uint16x4_t)vtrn2_u32((uint32x2_t)v5_h, (uint32x2_t)v7_h);

      vst1_u16(b_offset, v0_h);
      vst1_u16(b_offset + 4, v1_h);
      vst1_u16(b_offset + 8, v2_h);
      vst1_u16(b_offset + 12, v3_h);

      b_offset += 16;
      a_offset0 += 4 * lda;
      a_offset1 += 4 * lda;
      a_offset2 += 4 * lda;
      a_offset3 += 4 * lda;
    }

    if (m & 3) {
      BLASLONG rest = m & 3;
      for (BLASLONG line = 0; line < 4; line++) {
        b_offset[line * 4] = a_offset0[line];
        b_offset[line * 4 + 1] = rest == 1 ? 0 : a_offset1[line];
        b_offset[line * 4 + 2] = rest <= 2 ? 0 : a_offset2[line];
        b_offset[line * 4 + 3] = rest <= 3 ? 0 : a_offset3[line];
      }
      b_offset += 16;
    }
  }

  if (n & 2) {
    a_offset0 = a_offset;
    a_offset1 = a_offset0 + lda;
    a_offset2 = a_offset1 + lda;
    a_offset3 = a_offset2 + lda;
    a_offset += 2;

    for (BLASLONG i = 0; i < m / 4; i++) {
      for (BLASLONG line = 0; line < 2; line++) {
        b_offset[line * 4] = a_offset0[line];
        b_offset[line * 4 + 1] = a_offset1[line];
        b_offset[line * 4 + 2] = a_offset2[line];
        b_offset[line * 4 + 3] = a_offset3[line];
      }
      b_offset += 8;
      a_offset0 += 4 * lda;
      a_offset1 += 4 * lda;
      a_offset2 += 4 * lda;
      a_offset3 += 4 * lda;
    }

    if (m & 3) {
      BLASLONG rest = m & 3;
      for (BLASLONG line = 0; line < 2; line++) {
        b_offset[line * 4] = a_offset0[line];
        b_offset[line * 4 + 1] = rest == 1 ? 0 : a_offset1[line];
        b_offset[line * 4 + 2] = rest <= 2 ? 0 : a_offset2[line];
        b_offset[line * 4 + 3] = rest <= 3 ? 0 : a_offset3[line];
      }
      b_offset += 8;
    }
  }

  if (n & 1) {
    a_offset0 = a_offset;
    a_offset1 = a_offset0 + lda;
    a_offset2 = a_offset1 + lda;
    a_offset3 = a_offset2 + lda;

    for (BLASLONG i = 0; i < m / 4; i++) {
      b_offset[0] = *a_offset0;
      b_offset[1] = *a_offset1;
      b_offset[2] = *a_offset2;
      b_offset[3] = *a_offset3;
      b_offset += 4;
      a_offset0 += 4 * lda;
      a_offset1 += 4 * lda;
      a_offset2 += 4 * lda;
      a_offset3 += 4 * lda;
    }

    if (m & 3) {
      BLASLONG rest = m & 3;
      b_offset[0] = *a_offset0;
      b_offset[1] = rest == 1 ? 0 : *a_offset1;
      b_offset[2] = rest <= 2 ? 0 : *a_offset2;
      b_offset[3] = rest <= 3 ? 0 : *a_offset3;
    }
  }
  return 0;
}
