mirror of
https://github.com/emmansun/gmsm.git
synced 2025-04-22 18:26:17 +08:00
252 lines
7.4 KiB
ArmAsm
252 lines
7.4 KiB
ArmAsm
#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
|