1/* NG4memset.S: Niagara-4 optimized memset/bzero.
2 *
3 * Copyright (C) 2012 David S. Miller (davem@davemloft.net)
4 */
5
6#include <asm/asi.h>
7
8	.register	%g2, #scratch
9	.register	%g3, #scratch
10
11	.text
12	.align		32
13	.globl		NG4memset
14NG4memset:
15	andcc		%o1, 0xff, %o4
16	be,pt		%icc, 1f
17	 mov		%o2, %o1
18	sllx		%o4, 8, %g1
19	or		%g1, %o4, %o2
20	sllx		%o2, 16, %g1
21	or		%g1, %o2, %o2
22	sllx		%o2, 32, %g1
23	ba,pt		%icc, 1f
24	 or		%g1, %o2, %o4
25	.size		NG4memset,.-NG4memset
26
27	.align		32
28	.globl		NG4bzero
29NG4bzero:
30	clr		%o4
311:	cmp		%o1, 16
32	ble		%icc, .Ltiny
33	 mov		%o0, %o3
34	sub		%g0, %o0, %g1
35	and		%g1, 0x7, %g1
36	brz,pt		%g1, .Laligned8
37	 sub		%o1, %g1, %o1
381:	stb		%o4, [%o0 + 0x00]
39	subcc		%g1, 1, %g1
40	bne,pt		%icc, 1b
41	 add		%o0, 1, %o0
42.Laligned8:
43	cmp		%o1, 64 + (64 - 8)
44	ble		.Lmedium
45	 sub		%g0, %o0, %g1
46	andcc		%g1, (64 - 1), %g1
47	brz,pn		%g1, .Laligned64
48	 sub		%o1, %g1, %o1
491:	stx		%o4, [%o0 + 0x00]
50	subcc		%g1, 8, %g1
51	bne,pt		%icc, 1b
52	 add		%o0, 0x8, %o0
53.Laligned64:
54	andn		%o1, 64 - 1, %g1
55	sub		%o1, %g1, %o1
56	brnz,pn		%o4, .Lnon_bzero_loop
57	 mov		0x20, %g2
581:	stxa		%o4, [%o0 + %g0] ASI_BLK_INIT_QUAD_LDD_P
59	subcc		%g1, 0x40, %g1
60	stxa		%o4, [%o0 + %g2] ASI_BLK_INIT_QUAD_LDD_P
61	bne,pt		%icc, 1b
62	 add		%o0, 0x40, %o0
63.Lpostloop:
64	cmp		%o1, 8
65	bl,pn		%icc, .Ltiny
66	 membar		#StoreStore|#StoreLoad
67.Lmedium:
68	andn		%o1, 0x7, %g1
69	sub		%o1, %g1, %o1
701:	stx		%o4, [%o0 + 0x00]
71	subcc		%g1, 0x8, %g1
72	bne,pt		%icc, 1b
73	 add		%o0, 0x08, %o0
74	andcc		%o1, 0x4, %g1
75	be,pt		%icc, .Ltiny
76	 sub		%o1, %g1, %o1
77	stw		%o4, [%o0 + 0x00]
78	add		%o0, 0x4, %o0
79.Ltiny:
80	cmp		%o1, 0
81	be,pn		%icc, .Lexit
821:	 subcc		%o1, 1, %o1
83	stb		%o4, [%o0 + 0x00]
84	bne,pt		%icc, 1b
85	 add		%o0, 1, %o0
86.Lexit:
87	retl
88	 mov		%o3, %o0
89.Lnon_bzero_loop:
90	mov		0x08, %g3
91	mov		0x28, %o5
921:	stxa		%o4, [%o0 + %g0] ASI_BLK_INIT_QUAD_LDD_P
93	subcc		%g1, 0x40, %g1
94	stxa		%o4, [%o0 + %g2] ASI_BLK_INIT_QUAD_LDD_P
95	stxa		%o4, [%o0 + %g3] ASI_BLK_INIT_QUAD_LDD_P
96	stxa		%o4, [%o0 + %o5] ASI_BLK_INIT_QUAD_LDD_P
97	add		%o0, 0x10, %o0
98	stxa		%o4, [%o0 + %g0] ASI_BLK_INIT_QUAD_LDD_P
99	stxa		%o4, [%o0 + %g2] ASI_BLK_INIT_QUAD_LDD_P
100	stxa		%o4, [%o0 + %g3] ASI_BLK_INIT_QUAD_LDD_P
101	stxa		%o4, [%o0 + %o5] ASI_BLK_INIT_QUAD_LDD_P
102	bne,pt		%icc, 1b
103	 add		%o0, 0x30, %o0
104	ba,a,pt		%icc, .Lpostloop
105	.size		NG4bzero,.-NG4bzero
106