| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106 |
- /* NG4memset.S: Niagara-4 optimized memset/bzero.
- *
- * Copyright (C) 2012 David S. Miller (davem@davemloft.net)
- */
- #include <asm/asi.h>
- .register %g2, #scratch
- .register %g3, #scratch
- .text
- .align 32
- .globl NG4memset
- NG4memset:
- andcc %o1, 0xff, %o4
- be,pt %icc, 1f
- mov %o2, %o1
- sllx %o4, 8, %g1
- or %g1, %o4, %o2
- sllx %o2, 16, %g1
- or %g1, %o2, %o2
- sllx %o2, 32, %g1
- ba,pt %icc, 1f
- or %g1, %o2, %o4
- .size NG4memset,.-NG4memset
- .align 32
- .globl NG4bzero
- NG4bzero:
- clr %o4
- 1: cmp %o1, 16
- ble %icc, .Ltiny
- mov %o0, %o3
- sub %g0, %o0, %g1
- and %g1, 0x7, %g1
- brz,pt %g1, .Laligned8
- sub %o1, %g1, %o1
- 1: stb %o4, [%o0 + 0x00]
- subcc %g1, 1, %g1
- bne,pt %icc, 1b
- add %o0, 1, %o0
- .Laligned8:
- cmp %o1, 64 + (64 - 8)
- ble .Lmedium
- sub %g0, %o0, %g1
- andcc %g1, (64 - 1), %g1
- brz,pn %g1, .Laligned64
- sub %o1, %g1, %o1
- 1: stx %o4, [%o0 + 0x00]
- subcc %g1, 8, %g1
- bne,pt %icc, 1b
- add %o0, 0x8, %o0
- .Laligned64:
- andn %o1, 64 - 1, %g1
- sub %o1, %g1, %o1
- brnz,pn %o4, .Lnon_bzero_loop
- mov 0x20, %g2
- 1: stxa %o4, [%o0 + %g0] ASI_BLK_INIT_QUAD_LDD_P
- subcc %g1, 0x40, %g1
- stxa %o4, [%o0 + %g2] ASI_BLK_INIT_QUAD_LDD_P
- bne,pt %icc, 1b
- add %o0, 0x40, %o0
- .Lpostloop:
- cmp %o1, 8
- bl,pn %icc, .Ltiny
- membar #StoreStore|#StoreLoad
- .Lmedium:
- andn %o1, 0x7, %g1
- sub %o1, %g1, %o1
- 1: stx %o4, [%o0 + 0x00]
- subcc %g1, 0x8, %g1
- bne,pt %icc, 1b
- add %o0, 0x08, %o0
- andcc %o1, 0x4, %g1
- be,pt %icc, .Ltiny
- sub %o1, %g1, %o1
- stw %o4, [%o0 + 0x00]
- add %o0, 0x4, %o0
- .Ltiny:
- cmp %o1, 0
- be,pn %icc, .Lexit
- 1: subcc %o1, 1, %o1
- stb %o4, [%o0 + 0x00]
- bne,pt %icc, 1b
- add %o0, 1, %o0
- .Lexit:
- retl
- mov %o3, %o0
- .Lnon_bzero_loop:
- mov 0x08, %g3
- mov 0x28, %o5
- 1: stxa %o4, [%o0 + %g0] ASI_BLK_INIT_QUAD_LDD_P
- subcc %g1, 0x40, %g1
- stxa %o4, [%o0 + %g2] ASI_BLK_INIT_QUAD_LDD_P
- stxa %o4, [%o0 + %g3] ASI_BLK_INIT_QUAD_LDD_P
- stxa %o4, [%o0 + %o5] ASI_BLK_INIT_QUAD_LDD_P
- add %o0, 0x10, %o0
- stxa %o4, [%o0 + %g0] ASI_BLK_INIT_QUAD_LDD_P
- stxa %o4, [%o0 + %g2] ASI_BLK_INIT_QUAD_LDD_P
- stxa %o4, [%o0 + %g3] ASI_BLK_INIT_QUAD_LDD_P
- stxa %o4, [%o0 + %o5] ASI_BLK_INIT_QUAD_LDD_P
- bne,pt %icc, 1b
- add %o0, 0x30, %o0
- ba,a,pt %icc, .Lpostloop
- .size NG4bzero,.-NG4bzero
|
