arch/sparc64/lib/GENmemcpy.S

   1 /* GENmemcpy.S: Generic sparc64 memcpy.
   2  *
   3  * Copyright (C) 2007 David S. Miller (davem@davemloft.net)
   4  */
   5
   6 #ifdef __KERNEL__
   7 #define GLOBAL_SPARE    %g7
   8 #else
   9 #define GLOBAL_SPARE    %g5
  10 #endif
  11
  12 #ifndef EX_LD
  13 #define EX_LD(x)        x
  14 #endif
  15
  16 #ifndef EX_ST
  17 #define EX_ST(x)        x
  18 #endif
  19
  20 #ifndef EX_RETVAL
  21 #define EX_RETVAL(x)    x
  22 #endif
  23
  24 #ifndef LOAD
  25 #define LOAD(type,addr,dest)    type [addr], dest
  26 #endif
  27
  28 #ifndef STORE
  29 #define STORE(type,src,addr)    type src, [addr]
  30 #endif
  31
  32 #ifndef FUNC_NAME
  33 #define FUNC_NAME       GENmemcpy
  34 #endif
  35
  36 #ifndef PREAMBLE
  37 #define PREAMBLE
  38 #endif
  39
  40 #ifndef XCC
  41 #define XCC xcc
  42 #endif
  43
  44         .register       %g2,#scratch
  45         .register       %g3,#scratch
  46
  47         .text
  48         .align          64
  49
  50         .globl  FUNC_NAME
  51         .type   FUNC_NAME,#function
  52 FUNC_NAME:      /* %o0=dst, %o1=src, %o2=len */
  53         srlx            %o2, 31, %g2
  54         cmp             %g2, 0
  55         tne             %XCC, 5
  56         PREAMBLE
  57         mov             %o0, GLOBAL_SPARE
  58
  59         cmp             %o2, 0
  60         be,pn           %XCC, 85f
  61          or             %o0, %o1, %o3
  62         cmp             %o2, 16
  63         blu,a,pn        %XCC, 80f
  64          or             %o3, %o2, %o3
  65
  66         xor             %o0, %o1, %o4
  67         andcc           %o4, 0x7, %g0
  68         bne,a,pn        %XCC, 90f
  69          sub            %o0, %o1, %o3
  70
  71         and             %o0, 0x7, %o4
  72         sub             %o4, 0x8, %o4
  73         sub             %g0, %o4, %o4
  74         sub             %o2, %o4, %o2
  75 1:      subcc           %o4, 1, %o4
  76         EX_LD(LOAD(ldub, %o1, %g1))
  77         EX_ST(STORE(stb, %g1, %o0))
  78         add             %o1, 1, %o1
  79         bne,pt          %XCC, 1b
  80         add             %o0, 1, %o0
  81
  82         andn            %o2, 0x7, %g1
  83         sub             %o2, %g1, %o2
  84 1:      subcc           %g1, 0x8, %g1
  85         EX_LD(LOAD(ldx, %o1, %g2))
  86         EX_ST(STORE(stx, %g2, %o0))
  87         add             %o1, 0x8, %o1
  88         bne,pt          %XCC, 1b
  89          add            %o0, 0x8, %o0
  90
  91         brz,pt          %o2, 85f
  92          sub            %o0, %o1, %o3
  93         ba,a,pt         %XCC, 90f
  94
  95         .align          64
  96 80: /* 0 < len <= 16 */
  97         andcc           %o3, 0x3, %g0
  98         bne,pn          %XCC, 90f
  99          sub            %o0, %o1, %o3
 100
 101 1:
 102         subcc           %o2, 4, %o2
 103         EX_LD(LOAD(lduw, %o1, %g1))
 104         EX_ST(STORE(stw, %g1, %o1 + %o3))
 105         bgu,pt          %XCC, 1b
 106          add            %o1, 4, %o1
 107
 108 85:     retl
 109          mov            EX_RETVAL(GLOBAL_SPARE), %o0
 110
 111         .align          32
 112 90:
 113         subcc           %o2, 1, %o2
 114         EX_LD(LOAD(ldub, %o1, %g1))
 115         EX_ST(STORE(stb, %g1, %o1 + %o3))
 116         bgu,pt          %XCC, 90b
 117          add            %o1, 1, %o1
 118         retl
 119          mov            EX_RETVAL(GLOBAL_SPARE), %o0
 120
 121         .size           FUNC_NAME, .-FUNC_NAME