| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* bzero.S: Simple prefetching memset, bzero, and clear_user | 
|  | 2 | *          implementations. | 
|  | 3 | * | 
|  | 4 | * Copyright (C) 2005 David S. Miller <davem@davemloft.net> | 
|  | 5 | */ | 
|  | 6 |  | 
|  | 7 | .text | 
|  | 8 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 9 | .globl	memset | 
|  | 10 | .type	memset, #function | 
|  | 11 | memset:			/* %o0=buf, %o1=pat, %o2=len */ | 
|  | 12 | and		%o1, 0xff, %o3 | 
|  | 13 | mov		%o2, %o1 | 
|  | 14 | sllx		%o3, 8, %g1 | 
|  | 15 | or		%g1, %o3, %o2 | 
|  | 16 | sllx		%o2, 16, %g1 | 
|  | 17 | or		%g1, %o2, %o2 | 
|  | 18 | sllx		%o2, 32, %g1 | 
|  | 19 | ba,pt		%xcc, 1f | 
|  | 20 | or		%g1, %o2, %o2 | 
|  | 21 |  | 
|  | 22 | .globl	__bzero | 
|  | 23 | .type	__bzero, #function | 
|  | 24 | __bzero:		/* %o0=buf, %o1=len */ | 
|  | 25 | clr		%o2 | 
|  | 26 | 1:	mov		%o0, %o3 | 
|  | 27 | brz,pn		%o1, __bzero_done | 
|  | 28 | cmp		%o1, 16 | 
|  | 29 | bl,pn		%icc, __bzero_tiny | 
|  | 30 | prefetch	[%o0 + 0x000], #n_writes | 
|  | 31 | andcc		%o0, 0x3, %g0 | 
|  | 32 | be,pt		%icc, 2f | 
|  | 33 | 1:	 stb		%o2, [%o0 + 0x00] | 
|  | 34 | add		%o0, 1, %o0 | 
|  | 35 | andcc		%o0, 0x3, %g0 | 
|  | 36 | bne,pn		%icc, 1b | 
|  | 37 | sub		%o1, 1, %o1 | 
|  | 38 | 2:	andcc		%o0, 0x7, %g0 | 
|  | 39 | be,pt		%icc, 3f | 
|  | 40 | stw		%o2, [%o0 + 0x00] | 
|  | 41 | sub		%o1, 4, %o1 | 
|  | 42 | add		%o0, 4, %o0 | 
|  | 43 | 3:	and		%o1, 0x38, %g1 | 
|  | 44 | cmp		%o1, 0x40 | 
|  | 45 | andn		%o1, 0x3f, %o4 | 
|  | 46 | bl,pn		%icc, 5f | 
|  | 47 | and		%o1, 0x7, %o1 | 
|  | 48 | prefetch	[%o0 + 0x040], #n_writes | 
|  | 49 | prefetch	[%o0 + 0x080], #n_writes | 
|  | 50 | prefetch	[%o0 + 0x0c0], #n_writes | 
|  | 51 | prefetch	[%o0 + 0x100], #n_writes | 
|  | 52 | prefetch	[%o0 + 0x140], #n_writes | 
|  | 53 | 4:	prefetch	[%o0 + 0x180], #n_writes | 
|  | 54 | stx		%o2, [%o0 + 0x00] | 
|  | 55 | stx		%o2, [%o0 + 0x08] | 
|  | 56 | stx		%o2, [%o0 + 0x10] | 
|  | 57 | stx		%o2, [%o0 + 0x18] | 
|  | 58 | stx		%o2, [%o0 + 0x20] | 
|  | 59 | stx		%o2, [%o0 + 0x28] | 
|  | 60 | stx		%o2, [%o0 + 0x30] | 
|  | 61 | stx		%o2, [%o0 + 0x38] | 
|  | 62 | subcc		%o4, 0x40, %o4 | 
|  | 63 | bne,pt		%icc, 4b | 
|  | 64 | add		%o0, 0x40, %o0 | 
|  | 65 | brz,pn		%g1, 6f | 
|  | 66 | nop | 
|  | 67 | 5:	stx		%o2, [%o0 + 0x00] | 
|  | 68 | subcc		%g1, 8, %g1 | 
|  | 69 | bne,pt		%icc, 5b | 
|  | 70 | add		%o0, 0x8, %o0 | 
|  | 71 | 6:	brz,pt		%o1, __bzero_done | 
|  | 72 | nop | 
|  | 73 | __bzero_tiny: | 
|  | 74 | 1:	stb		%o2, [%o0 + 0x00] | 
|  | 75 | subcc		%o1, 1, %o1 | 
|  | 76 | bne,pt		%icc, 1b | 
|  | 77 | add		%o0, 1, %o0 | 
|  | 78 | __bzero_done: | 
|  | 79 | retl | 
|  | 80 | mov		%o3, %o0 | 
|  | 81 | .size		__bzero, .-__bzero | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | .size		memset, .-memset | 
|  | 83 |  | 
|  | 84 | #define EX_ST(x,y)		\ | 
|  | 85 | 98:	x,y;			\ | 
| David S. Miller | 4d000d5 | 2006-03-04 23:23:56 -0800 | [diff] [blame] | 86 | .section __ex_table,"a";\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | .align 4;		\ | 
| David S. Miller | 40bdac7 | 2009-02-08 22:00:55 -0800 | [diff] [blame] | 88 | .word 98b, __retl_o1;	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | .text;			\ | 
|  | 90 | .align 4; | 
|  | 91 |  | 
| David S. Miller | c857e3f | 2006-02-17 10:35:23 -0800 | [diff] [blame] | 92 | .globl	__clear_user | 
|  | 93 | .type	__clear_user, #function | 
|  | 94 | __clear_user:		/* %o0=buf, %o1=len */ | 
|  | 95 | brz,pn		%o1, __clear_user_done | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 | cmp		%o1, 16 | 
| David S. Miller | c857e3f | 2006-02-17 10:35:23 -0800 | [diff] [blame] | 97 | bl,pn		%icc, __clear_user_tiny | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | EX_ST(prefetcha [%o0 + 0x00] %asi, #n_writes) | 
|  | 99 | andcc		%o0, 0x3, %g0 | 
|  | 100 | be,pt		%icc, 2f | 
|  | 101 | 1:	 EX_ST(stba	%g0, [%o0 + 0x00] %asi) | 
|  | 102 | add		%o0, 1, %o0 | 
|  | 103 | andcc		%o0, 0x3, %g0 | 
|  | 104 | bne,pn		%icc, 1b | 
|  | 105 | sub		%o1, 1, %o1 | 
|  | 106 | 2:	andcc		%o0, 0x7, %g0 | 
|  | 107 | be,pt		%icc, 3f | 
|  | 108 | EX_ST(stwa	%g0, [%o0 + 0x00] %asi) | 
|  | 109 | sub		%o1, 4, %o1 | 
|  | 110 | add		%o0, 4, %o0 | 
|  | 111 | 3:	and		%o1, 0x38, %g1 | 
|  | 112 | cmp		%o1, 0x40 | 
|  | 113 | andn		%o1, 0x3f, %o4 | 
|  | 114 | bl,pn		%icc, 5f | 
|  | 115 | and		%o1, 0x7, %o1 | 
|  | 116 | EX_ST(prefetcha	[%o0 + 0x040] %asi, #n_writes) | 
|  | 117 | EX_ST(prefetcha	[%o0 + 0x080] %asi, #n_writes) | 
|  | 118 | EX_ST(prefetcha	[%o0 + 0x0c0] %asi, #n_writes) | 
|  | 119 | EX_ST(prefetcha	[%o0 + 0x100] %asi, #n_writes) | 
|  | 120 | EX_ST(prefetcha	[%o0 + 0x140] %asi, #n_writes) | 
|  | 121 | 4:	EX_ST(prefetcha	[%o0 + 0x180] %asi, #n_writes) | 
|  | 122 | EX_ST(stxa	%g0, [%o0 + 0x00] %asi) | 
|  | 123 | EX_ST(stxa	%g0, [%o0 + 0x08] %asi) | 
|  | 124 | EX_ST(stxa	%g0, [%o0 + 0x10] %asi) | 
|  | 125 | EX_ST(stxa	%g0, [%o0 + 0x18] %asi) | 
|  | 126 | EX_ST(stxa	%g0, [%o0 + 0x20] %asi) | 
|  | 127 | EX_ST(stxa	%g0, [%o0 + 0x28] %asi) | 
|  | 128 | EX_ST(stxa	%g0, [%o0 + 0x30] %asi) | 
|  | 129 | EX_ST(stxa	%g0, [%o0 + 0x38] %asi) | 
|  | 130 | subcc		%o4, 0x40, %o4 | 
|  | 131 | bne,pt		%icc, 4b | 
|  | 132 | add		%o0, 0x40, %o0 | 
|  | 133 | brz,pn		%g1, 6f | 
|  | 134 | nop | 
|  | 135 | 5:	EX_ST(stxa	%g0, [%o0 + 0x00] %asi) | 
|  | 136 | subcc		%g1, 8, %g1 | 
|  | 137 | bne,pt		%icc, 5b | 
|  | 138 | add		%o0, 0x8, %o0 | 
| David S. Miller | c857e3f | 2006-02-17 10:35:23 -0800 | [diff] [blame] | 139 | 6:	brz,pt		%o1, __clear_user_done | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | nop | 
| David S. Miller | c857e3f | 2006-02-17 10:35:23 -0800 | [diff] [blame] | 141 | __clear_user_tiny: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 142 | 1:	EX_ST(stba	%g0, [%o0 + 0x00] %asi) | 
|  | 143 | subcc		%o1, 1, %o1 | 
|  | 144 | bne,pt		%icc, 1b | 
|  | 145 | add		%o0, 1, %o0 | 
| David S. Miller | c857e3f | 2006-02-17 10:35:23 -0800 | [diff] [blame] | 146 | __clear_user_done: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | retl | 
|  | 148 | clr		%o0 | 
| David S. Miller | c857e3f | 2006-02-17 10:35:23 -0800 | [diff] [blame] | 149 | .size		__clear_user, .-__clear_user |