LXR linux/arch/powerpc/lib/mem

   1/*
   2 * String handling functions for PowerPC.
   3 *
   4 * Copyright (C) 1996 Paul Mackerras.
   5 *
   6 * This program is free software; you can redistribute it and/or
   7 * modify it under the terms of the GNU General Public License
   8 * as published by the Free Software Foundation; either version
   9 * 2 of the License, or (at your option) any later version.
  10 */
  11#include <asm/processor.h>
  12#include <asm/errno.h>
  13#include <asm/ppc_asm.h>
  14
  15_GLOBAL(memset)
  16        neg     r0,r3
  17        rlwimi  r4,r4,8,16,23
  18        andi.   r0,r0,7                 /* # bytes to be 8-byte aligned */
  19        rlwimi  r4,r4,16,0,15
  20        cmplw   cr1,r5,r0               /* do we get that far? */
  21        rldimi  r4,r4,32,0
  22        PPC_MTOCRF      1,r0
  23        mr      r6,r3
  24        blt     cr1,8f
  25        beq+    3f                      /* if already 8-byte aligned */
  26        subf    r5,r0,r5
  27        bf      31,1f
  28        stb     r4,0(r6)
  29        addi    r6,r6,1
  301:      bf      30,2f
  31        sth     r4,0(r6)
  32        addi    r6,r6,2
  332:      bf      29,3f
  34        stw     r4,0(r6)
  35        addi    r6,r6,4
  363:      srdi.   r0,r5,6
  37        clrldi  r5,r5,58
  38        mtctr   r0
  39        beq     5f
  404:      std     r4,0(r6)
  41        std     r4,8(r6)
  42        std     r4,16(r6)
  43        std     r4,24(r6)
  44        std     r4,32(r6)
  45        std     r4,40(r6)
  46        std     r4,48(r6)
  47        std     r4,56(r6)
  48        addi    r6,r6,64
  49        bdnz    4b
  505:      srwi.   r0,r5,3
  51        clrlwi  r5,r5,29
  52        PPC_MTOCRF      1,r0
  53        beq     8f
  54        bf      29,6f
  55        std     r4,0(r6)
  56        std     r4,8(r6)
  57        std     r4,16(r6)
  58        std     r4,24(r6)
  59        addi    r6,r6,32
  606:      bf      30,7f
  61        std     r4,0(r6)
  62        std     r4,8(r6)
  63        addi    r6,r6,16
  647:      bf      31,8f
  65        std     r4,0(r6)
  66        addi    r6,r6,8
  678:      cmpwi   r5,0
  68        PPC_MTOCRF      1,r5
  69        beqlr+
  70        bf      29,9f
  71        stw     r4,0(r6)
  72        addi    r6,r6,4
  739:      bf      30,10f
  74        sth     r4,0(r6)
  75        addi    r6,r6,2
  7610:     bflr    31
  77        stb     r4,0(r6)
  78        blr
  79
  80_GLOBAL(memmove)
  81        cmplw   0,r3,r4
  82        bgt     .backwards_memcpy
  83        b       .memcpy
  84
  85_GLOBAL(backwards_memcpy)
  86        rlwinm. r7,r5,32-3,3,31         /* r0 = r5 >> 3 */
  87        add     r6,r3,r5
  88        add     r4,r4,r5
  89        beq     2f
  90        andi.   r0,r6,3
  91        mtctr   r7
  92        bne     5f
  931:      lwz     r7,-4(r4)
  94        lwzu    r8,-8(r4)
  95        stw     r7,-4(r6)
  96        stwu    r8,-8(r6)
  97        bdnz    1b
  98        andi.   r5,r5,7
  992:      cmplwi  0,r5,4
 100        blt     3f
 101        lwzu    r0,-4(r4)
 102        subi    r5,r5,4
 103        stwu    r0,-4(r6)
 1043:      cmpwi   0,r5,0
 105        beqlr
 106        mtctr   r5
 1074:      lbzu    r0,-1(r4)
 108        stbu    r0,-1(r6)
 109        bdnz    4b
 110        blr
 1115:      mtctr   r0
 1126:      lbzu    r7,-1(r4)
 113        stbu    r7,-1(r6)
 114        bdnz    6b
 115        subf    r5,r0,r5
 116        rlwinm. r7,r5,32-3,3,31
 117        beq     2b
 118        mtctr   r7
 119        b       1b
 120