shithub: qk1

ref: b478d66c58707eb392d7132ab3106a2c1b2cacfd
dir: /cmprocess_arm64.s/

View raw version
#include "colormatrix.h"

TEXT cmprocess(SB), $0
	MOV p+8(FP), R1
	MOVW n+16(FP), R2

	MOVW cmkind(SB), R4
	CMPW $CmIdent, R4
	BEQ _done

	BIC $7, R2
	LSL $2, R2
	ADD R1, R2, R3

	CMPW $CmBright, R4
	BNE _full

/* just the brightness */
	WORD $0x4d40c400 // ld1r {v0.8h}, [x0]
	WORD $0x4f0797fc // orr v28.8h, 0xff, lsl 0
	WORD $0x4f0777fd // orr v29.4s, 0xff, lsl 24
_brightconv:
	WORD $0x3dc00021 // ldr q1, [x1]
	CMP R1, R3
	BEQ _done
	WORD $0x6f08a422 // uxtl2 v2.8h, v1.16b
	WORD $0x2f08a421 // uxtl v1.8h, v1.8b
	WORD $0x2f40a023 // umull v3.4s, v1.4h, v0.h[0]
	WORD $0x6f40a024 // umull2 v4.4s, v1.8h, v0.h[0]
	WORD $0x2f40a045 // umull v5.4s, v2.4h, v0.h[0]
	WORD $0x6f40a046 // umull2 v6.4s, v2.8h, v0.h[0]
	WORD $0x0f148463 // shrn v3.4h, v3.4s, 12
	WORD $0x4f148483 // shrn2 v3.8h, v4.4s, 12
	WORD $0x0f1484a4 // shrn v4.4h, v5.4s, 12
	WORD $0x4f1484c4 // shrn2 v4.8h, v6.4s, 12
	WORD $0x4e7c6c63 // smin.8h v3, v3, v28
	WORD $0x4e7c6c84 // smin.8h v4, v4, v28
	WORD $0x0e212863 // xtn v3.8b, v3.8h
	WORD $0x4e212883 // xtn2 v3.16b, v4.8h
	WORD $0x4ebd1c63 // orr.16b v3, v3, v29
	WORD $0x3c810423 // str q3, [x1], 16
	B _brightconv

/* full-on multiplication */
_full:
	WORD $0x4c40a000 // ld1.16b {v0, v1}, [x0]
	WORD $0x4f0707fe // movi v30.4s, 0xff, lsl 0
	WORD $0x6e3d1fbd // eor.16b v29, v29, v29
_fullconv:
	WORD $0x0d40803f // ld1 {v31.s}[0], [x1]
	CMP R1, R3
	BEQ _done
	WORD $0x0f0777ff // orr v31.2s, 0xff, lsl 24
	WORD $0x2f08a7ff // uxtl.8h v31, v31
	WORD $0x4e0807ff // dup v31.2d, v31.d[0]
	WORD $0x0e60c3e2 // smull v2.4s, v31.4h, v0.4h
	WORD $0x4e60c3e3 // smull2 v3.4s, v31.8h, v0.8h
	WORD $0x0e61c3e4 // smull v4.4s, v31.4h, v1.4h
	WORD $0x4e61c3e5 // smull2 v5.4s, v31.8h, v1.8h
	WORD $0x4eb1b842 // addv s2, v2.4s
	WORD $0x4eb1b863 // addv s3, v3.4s
	WORD $0x4eb1b884 // addv s4, v4.4s
	WORD $0x4eb1b8a5 // addv s5, v5.4s
	WORD $0x4e832842 // trn1.4s v2, v2, v3
	WORD $0x4e852884 // trn1.4s v4, v4, v5
	WORD $0x4ec42842 // trn1.2d v2, v2, v4
	WORD $0x4f340442 // sshr.4s v2, v2, 12
	WORD $0x4ebd6442 // smax.4s v2, v2, v29
	WORD $0x4ebe6c42 // smin.4s v2, v2, v30
	WORD $0x0e612842 // xtn v2.4h, v2.4s
	WORD $0x0e212842 // xtn v2.8b, v2.8h
	WORD $0x0d9f8022 // str1.s {v2}[0], [x1], 4
	B _fullconv

_done:
	RETURN