#include "textflag.h"

#define x V0
#define y V1
#define t0 V2
#define t1 V3
#define t2 V4
#define t3 V5
#define ZERO V16
#define NIBBLE_MASK V20
#define INVERSE_SHIFT_ROWS V21
#define M1L V22
#define M1H V23 
#define M2L V24 
#define M2H V25
#define R08_MASK V26 
#define R16_MASK V27
#define R24_MASK V28
#define FK_MASK V29
#define XTMP6 V6
#define XTMP7 V7

#define SM4_SBOX(x, y) \
  ;                                              \ //#############################  inner affine ############################//
  VAND x.B16, NIBBLE_MASK.B16, XTMP7.B16;        \
  VTBL XTMP7.B16, [M1L.B16], y.B16;              \
  VUSHR $4, x.D2, x.D2;                          \
  VAND x.B16, NIBBLE_MASK.B16, XTMP7.B16;        \
  VTBL XTMP7.B16, [M1H.B16], XTMP7.B16;          \
  VEOR y.B16, XTMP7.B16, x.B16;                  \
  VTBL INVERSE_SHIFT_ROWS.B16, [x.B16], x.B16;   \
  AESE ZERO.B16, x.B16;                          \	
  VAND x.B16, NIBBLE_MASK.B16, XTMP7.B16;        \
  VTBL XTMP7.B16, [M2L.B16], y.B16;              \
  VUSHR $4, x.D2, x.D2;                          \
  VAND x.B16, NIBBLE_MASK.B16, XTMP7.B16;        \
  VTBL XTMP7.B16, [M2H.B16], XTMP7.B16;          \
  VEOR y.B16, XTMP7.B16, x.B16

#define SM4_TAO_L1(x, y)         \
  SM4_SBOX(x, y);                              \
  ;                                            \ //####################  4 parallel L1 linear transforms ##################//
  VTBL R08_MASK.B16, [x.B16], y.B16;           \
  VEOR y.B16, x.B16, y.B16;                    \
  VTBL R16_MASK.B16, [x.B16], XTMP7.B16;       \
  VEOR XTMP7.B16, y.B16, y.B16;                \
  VSHL $2, y.S4, XTMP7.S4;                     \
  VUSHR $30, y.S4, y.S4;                       \
  VORR y.B16, XTMP7.B16, y.B16;                \
  VTBL R24_MASK.B16, [x.B16], XTMP7.B16;       \
  VEOR XTMP7.B16, x.B16, x.B16;                \
  VEOR y.B16, x.B16, x.B16

#define SM4_TAO_L2(x, y)         \
  SM4_SBOX(x, y);                             \
  ;                                           \ //####################  4 parallel L2 linear transforms ##################//
  VSHL $13, x.S4, XTMP6.S4;                   \
  VUSHR $19, x.S4, y.S4;                      \
  VORR XTMP6.B16, y.B16, y.B16;               \
  VSHL $23, x.S4, XTMP6.S4;                   \
  VUSHR $9, x.S4, XTMP7.S4;                   \
  VORR XTMP6.B16, XTMP7.B16, XTMP7.B16;       \
  VEOR XTMP7.B16, y.B16, y.B16;               \
  VEOR x.B16, y.B16, x.B16

#define SM4_ROUND(RK, x, y, t0, t1, t2, t3) \
  MOVW.P 4(RK), R19;                        \
  VMOV R19, x.S4;                           \
  VEOR t1.B16, x.B16, x.B16;                \
  VEOR t2.B16, x.B16, x.B16;                \
  VEOR t3.B16, x.B16, x.B16;                \
  SM4_TAO_L1(x, y);                         \
  VEOR x.B16, t0.B16, t0.B16

#define SM4_EXPANDKEY_ROUND(x, y, t0, t1, t2, t3) \
  MOVW.P 4(R9), R19;                               \
  VMOV R19, x.S[0];                                \
  VEOR t1.B16, x.B16, x.B16;                       \
  VEOR t2.B16, x.B16, x.B16;                       \
  VEOR t3.B16, x.B16, x.B16;                       \
  SM4_TAO_L2(x, y);                                \
  VEOR x.B16, t0.B16, t0.B16;                      \
  VMOV t0.S[0], R2;                                \
  MOVW.P R2, 4(R10);                               \
  MOVW.P R2, -4(R11)

#define load_global_data_1() \
  VMOVQ $0x0F0F0F0F0F0F0F0F, $0x0F0F0F0F0F0F0F0F, NIBBLE_MASK;              \ // nibble mask
  VMOVQ $0x9197E2E474720701, $0xC7C1B4B222245157, M1L;                      \
  VMOVQ $0xE240AB09EB49A200, $0xF052B91BF95BB012, M1H;                      \
  VMOVQ $0x5B67F2CEA19D0834, $0xEDD14478172BBE82, M2L;                      \
  VMOVQ $0xAE7201DD73AFDC00, $0x11CDBE62CC1063BF, M2H;                      \
  VMOVQ $0x56aa3350a3b1bac6, $0xb27022dc677d9197, FK_MASK;                  \
  VMOVQ $0x0B0E0104070A0D00, $0x0306090C0F020508, INVERSE_SHIFT_ROWS

#define load_global_data_2() \
  load_global_data_1();                                                     \
  VMOVQ $0x0605040702010003, $0x0E0D0C0F0A09080B, R08_MASK;                 \
  VMOVQ $0x0504070601000302, $0x0D0C0F0E09080B0A, R16_MASK;                 \
  VMOVQ $0x0407060500030201, $0x0C0F0E0D080B0A09, R24_MASK

// func expandKeyAsm(key *byte, ck, enc, dec *uint32)
TEXT ·expandKeyAsm(SB),NOSPLIT,$0
  MOVD key+0(FP), R8
  MOVD ck+8(FP), R9
  MOVD enc+16(FP), R10
  MOVD dec+24(FP), R11
  
  load_global_data_1()
	
  VLD1 (R8), [t0.B16]
  VREV32 t0.B16, t0.B16
  VEOR t0.B16, FK_MASK.B16, t0.B16
  VMOV t0.S[1], t1.S[0]
  VMOV t0.S[2], t2.S[0]
  VMOV t0.S[3], t3.S[0]

  EOR R0, R0
  ADD $124, R11
  VEOR ZERO.B16, ZERO.B16, ZERO.B16

ksLoop:
  SM4_EXPANDKEY_ROUND(x, y, t0, t1, t2, t3)
  SM4_EXPANDKEY_ROUND(x, y, t1, t2, t3, t0)
  SM4_EXPANDKEY_ROUND(x, y, t2, t3, t0, t1)
  SM4_EXPANDKEY_ROUND(x, y, t3, t0, t1, t2)

  ADD $16, R0 
  CMP $128, R0
  BNE ksLoop

  RET 

// func encryptBlocksAsm(xk *uint32, dst, src []byte)
TEXT ·encryptBlocksAsm(SB),NOSPLIT,$0
  MOVD xk+0(FP), R8
  MOVD dst+8(FP), R9
  MOVD src+32(FP), R10

  VLD1 (R10), [V5.S4, V6.S4, V7.S4, V8.S4]
  VMOV V5.S[0], t0.S[0]
  VMOV V5.S[1], t1.S[0]
  VMOV V5.S[2], t2.S[0]
  VMOV V5.S[3], t3.S[0]
  
  VMOV V6.S[0], t0.S[1]
  VMOV V6.S[1], t1.S[1]
  VMOV V6.S[2], t2.S[1]
  VMOV V6.S[3], t3.S[1]

  VMOV V7.S[0], t0.S[2]
  VMOV V7.S[1], t1.S[2]
  VMOV V7.S[2], t2.S[2]
  VMOV V7.S[3], t3.S[2]  

  VMOV V8.S[0], t0.S[3]
  VMOV V8.S[1], t1.S[3]
  VMOV V8.S[2], t2.S[3]
  VMOV V8.S[3], t3.S[3]    

  load_global_data_2()

  VREV32 t0.B16, t0.B16
  VREV32 t1.B16, t1.B16
  VREV32 t2.B16, t2.B16
  VREV32 t3.B16, t3.B16

  VEOR ZERO.B16, ZERO.B16, ZERO.B16
  EOR R0, R0

encryptBlocksLoop:
  SM4_ROUND(R8, x, y, t0, t1, t2, t3)
  SM4_ROUND(R8, x, y, t1, t2, t3, t0)
  SM4_ROUND(R8, x, y, t2, t3, t0, t1)
  SM4_ROUND(R8, x, y, t3, t0, t1, t2)

  ADD $16, R0
  CMP $128, R0
  BNE encryptBlocksLoop

  VREV32 t0.B16, t0.B16
  VREV32 t1.B16, t1.B16
  VREV32 t2.B16, t2.B16
  VREV32 t3.B16, t3.B16

  VMOV t3.S[0], V8.S[0]
  VMOV t2.S[0], V8.S[1]
  VMOV t1.S[0], V8.S[2]
  VMOV t0.S[0], V8.S[3]
  VST1.P [V8.B16], 16(R9)

  VMOV t3.S[1], V8.S[0]
  VMOV t2.S[1], V8.S[1]
  VMOV t1.S[1], V8.S[2]
  VMOV t0.S[1], V8.S[3]
  VST1.P [V8.B16], 16(R9)

  VMOV t3.S[2], V8.S[0]
  VMOV t2.S[2], V8.S[1]
  VMOV t1.S[2], V8.S[2]
  VMOV t0.S[2], V8.S[3]
  VST1.P [V8.B16], 16(R9)

  VMOV t3.S[3], V8.S[0]
  VMOV t2.S[3], V8.S[1]
  VMOV t1.S[3], V8.S[2]
  VMOV t0.S[3], V8.S[3]
  VST1 [V8.B16], (R9)

  RET


// func encryptBlockAsm(xk *uint32, dst, src *byte)
TEXT ·encryptBlockAsm(SB),NOSPLIT,$0
  MOVD xk+0(FP), R8
  MOVD dst+8(FP), R9
  MOVD src+16(FP), R10

  VLD1 (R10), [t0.S4]
  VREV32 t0.B16, t0.B16
  VMOV t0.S[1], t1.S[0]
  VMOV t0.S[2], t2.S[0]
  VMOV t0.S[3], t3.S[0]

  load_global_data_2()

  VEOR ZERO.B16, ZERO.B16, ZERO.B16
  EOR R0, R0

encryptBlockLoop:
  SM4_ROUND(R8, x, y, t0, t1, t2, t3)
  SM4_ROUND(R8, x, y, t1, t2, t3, t0)
  SM4_ROUND(R8, x, y, t2, t3, t0, t1)
  SM4_ROUND(R8, x, y, t3, t0, t1, t2)

  ADD $16, R0
  CMP $128, R0
  BNE encryptBlockLoop

  VREV32 t0.B16, t0.B16
  VREV32 t1.B16, t1.B16
  VREV32 t2.B16, t2.B16
  VREV32 t3.B16, t3.B16

  VMOV t3.S[0], V8.S[0]
  VMOV t2.S[0], V8.S[1]
  VMOV t1.S[0], V8.S[2]
  VMOV t0.S[0], V8.S[3]
  VST1 [V8.B16], (R9)

  RET