1/* 2 * Copyright 2005-2009 Analog Devices Inc. 3 * 4 * Licensed under the ADI BSD license or the GPL-2 (or later) 5 */ 6 7#include <linux/linkage.h> 8 9.align 2 10 11/* 12 * C Library function MEMMOVE 13 * R0 = To Address (leave unchanged to form result) 14 * R1 = From Address 15 * R2 = count 16 * Data may overlap 17 */ 18 19ENTRY(_memmove) 20 I1 = P3; 21 P0 = R0; /* P0 = To address */ 22 P3 = R1; /* P3 = From Address */ 23 P2 = R2; /* P2 = count */ 24 CC = P2 == 0; /* Check zero count*/ 25 IF CC JUMP .Lfinished; /* very unlikely */ 26 27 CC = R1 < R0 (IU); /* From < To */ 28 IF !CC JUMP .Lno_overlap; 29 R3 = R1 + R2; 30 CC = R0 <= R3 (IU); /* (From+len) >= To */ 31 IF CC JUMP .Loverlap; 32.Lno_overlap: 33 R3 = 11; 34 CC = R2 <= R3; 35 IF CC JUMP .Lbytes; 36 R3 = R1 | R0; /* OR addresses together */ 37 R3 <<= 30; /* check bottom two bits */ 38 CC = AZ; /* AZ set if zero.*/ 39 IF !CC JUMP .Lbytes; /* Jump if addrs not aligned.*/ 40 41 I0 = P3; 42 P1 = P2 >> 2; /* count = n/4 */ 43 P1 += -1; 44 R3 = 3; 45 R2 = R2 & R3; /* remainder */ 46 P2 = R2; /* set remainder */ 47 R1 = [I0++]; 48 49 LSETUP (.Lquad_loops, .Lquad_loope) LC0=P1; 50#if ANOMALY_05000202 51.Lquad_loops: 52 [P0++] = R1; 53.Lquad_loope: 54 R1 = [I0++]; 55#else 56.Lquad_loops: 57.Lquad_loope: 58 MNOP || [P0++] = R1 || R1 = [I0++]; 59#endif 60 [P0++] = R1; 61 62 CC = P2 == 0; /* any remaining bytes? */ 63 P3 = I0; /* Ammend P3 to updated ptr. */ 64 IF !CC JUMP .Lbytes; 65 P3 = I1; 66 RTS; 67 68.Lbytes: LSETUP (.Lbyte2_s, .Lbyte2_e) LC0=P2; 69.Lbyte2_s: R1 = B[P3++](Z); 70.Lbyte2_e: B[P0++] = R1; 71 72.Lfinished: P3 = I1; 73 RTS; 74 75.Loverlap: 76 P2 += -1; 77 P0 = P0 + P2; 78 P3 = P3 + P2; 79 R1 = B[P3--] (Z); 80 CC = P2 == 0; 81 IF CC JUMP .Lno_loop; 82#if ANOMALY_05000245 83 NOP; 84 NOP; 85#endif 86 LSETUP (.Lol_s, .Lol_e) LC0 = P2; 87.Lol_s: B[P0--] = R1; 88.Lol_e: R1 = B[P3--] (Z); 89.Lno_loop: B[P0] = R1; 90 P3 = I1; 91 RTS; 92 93ENDPROC(_memmove) 94