1*8d67ca89SAndroid Build Coastguard Worker /*-
2*8d67ca89SAndroid Build Coastguard Worker * SPDX-License-Identifier: BSD-3-Clause
3*8d67ca89SAndroid Build Coastguard Worker *
4*8d67ca89SAndroid Build Coastguard Worker * Copyright (c) 1990, 1993
5*8d67ca89SAndroid Build Coastguard Worker * The Regents of the University of California. All rights reserved.
6*8d67ca89SAndroid Build Coastguard Worker *
7*8d67ca89SAndroid Build Coastguard Worker * This code is derived from software contributed to Berkeley by
8*8d67ca89SAndroid Build Coastguard Worker * Chris Torek.
9*8d67ca89SAndroid Build Coastguard Worker *
10*8d67ca89SAndroid Build Coastguard Worker * Redistribution and use in source and binary forms, with or without
11*8d67ca89SAndroid Build Coastguard Worker * modification, are permitted provided that the following conditions
12*8d67ca89SAndroid Build Coastguard Worker * are met:
13*8d67ca89SAndroid Build Coastguard Worker * 1. Redistributions of source code must retain the above copyright
14*8d67ca89SAndroid Build Coastguard Worker * notice, this list of conditions and the following disclaimer.
15*8d67ca89SAndroid Build Coastguard Worker * 2. Redistributions in binary form must reproduce the above copyright
16*8d67ca89SAndroid Build Coastguard Worker * notice, this list of conditions and the following disclaimer in the
17*8d67ca89SAndroid Build Coastguard Worker * documentation and/or other materials provided with the distribution.
18*8d67ca89SAndroid Build Coastguard Worker * 3. Neither the name of the University nor the names of its contributors
19*8d67ca89SAndroid Build Coastguard Worker * may be used to endorse or promote products derived from this software
20*8d67ca89SAndroid Build Coastguard Worker * without specific prior written permission.
21*8d67ca89SAndroid Build Coastguard Worker *
22*8d67ca89SAndroid Build Coastguard Worker * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23*8d67ca89SAndroid Build Coastguard Worker * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24*8d67ca89SAndroid Build Coastguard Worker * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25*8d67ca89SAndroid Build Coastguard Worker * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26*8d67ca89SAndroid Build Coastguard Worker * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27*8d67ca89SAndroid Build Coastguard Worker * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28*8d67ca89SAndroid Build Coastguard Worker * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29*8d67ca89SAndroid Build Coastguard Worker * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30*8d67ca89SAndroid Build Coastguard Worker * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31*8d67ca89SAndroid Build Coastguard Worker * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32*8d67ca89SAndroid Build Coastguard Worker * SUCH DAMAGE.
33*8d67ca89SAndroid Build Coastguard Worker */
34*8d67ca89SAndroid Build Coastguard Worker
35*8d67ca89SAndroid Build Coastguard Worker #include <sys/types.h>
36*8d67ca89SAndroid Build Coastguard Worker
37*8d67ca89SAndroid Build Coastguard Worker typedef intptr_t word; /* "word" used for optimal copy speed */
38*8d67ca89SAndroid Build Coastguard Worker
39*8d67ca89SAndroid Build Coastguard Worker #define wsize sizeof(word)
40*8d67ca89SAndroid Build Coastguard Worker #define wmask (wsize - 1)
41*8d67ca89SAndroid Build Coastguard Worker
42*8d67ca89SAndroid Build Coastguard Worker /*
43*8d67ca89SAndroid Build Coastguard Worker * Copy a block of memory, handling overlap.
44*8d67ca89SAndroid Build Coastguard Worker */
45*8d67ca89SAndroid Build Coastguard Worker #include <string.h>
46*8d67ca89SAndroid Build Coastguard Worker
47*8d67ca89SAndroid Build Coastguard Worker void *
48*8d67ca89SAndroid Build Coastguard Worker #ifdef MEMCOPY
memcpy_gc(void * dst0,const void * src0,size_t length)49*8d67ca89SAndroid Build Coastguard Worker memcpy_gc
50*8d67ca89SAndroid Build Coastguard Worker #else
51*8d67ca89SAndroid Build Coastguard Worker memmove_gc
52*8d67ca89SAndroid Build Coastguard Worker #endif
53*8d67ca89SAndroid Build Coastguard Worker (void *dst0, const void *src0, size_t length)
54*8d67ca89SAndroid Build Coastguard Worker {
55*8d67ca89SAndroid Build Coastguard Worker char *dst = dst0;
56*8d67ca89SAndroid Build Coastguard Worker const char *src = src0;
57*8d67ca89SAndroid Build Coastguard Worker size_t t;
58*8d67ca89SAndroid Build Coastguard Worker
59*8d67ca89SAndroid Build Coastguard Worker if (length == 0 || dst == src) /* nothing to do */
60*8d67ca89SAndroid Build Coastguard Worker goto done;
61*8d67ca89SAndroid Build Coastguard Worker
62*8d67ca89SAndroid Build Coastguard Worker /*
63*8d67ca89SAndroid Build Coastguard Worker * Macros: loop-t-times; and loop-t-times, t>0
64*8d67ca89SAndroid Build Coastguard Worker */
65*8d67ca89SAndroid Build Coastguard Worker #define TLOOP(s) if (t) TLOOP1(s)
66*8d67ca89SAndroid Build Coastguard Worker #define TLOOP1(s) do { s; } while (--t)
67*8d67ca89SAndroid Build Coastguard Worker
68*8d67ca89SAndroid Build Coastguard Worker if ((unsigned long)dst < (unsigned long)src) {
69*8d67ca89SAndroid Build Coastguard Worker /*
70*8d67ca89SAndroid Build Coastguard Worker * Copy forward.
71*8d67ca89SAndroid Build Coastguard Worker */
72*8d67ca89SAndroid Build Coastguard Worker t = (uintptr_t)src; /* only need low bits */
73*8d67ca89SAndroid Build Coastguard Worker if ((t | (uintptr_t)dst) & wmask) {
74*8d67ca89SAndroid Build Coastguard Worker /*
75*8d67ca89SAndroid Build Coastguard Worker * Try to align operands. This cannot be done
76*8d67ca89SAndroid Build Coastguard Worker * unless the low bits match.
77*8d67ca89SAndroid Build Coastguard Worker */
78*8d67ca89SAndroid Build Coastguard Worker if ((t ^ (uintptr_t)dst) & wmask || length < wsize)
79*8d67ca89SAndroid Build Coastguard Worker t = length;
80*8d67ca89SAndroid Build Coastguard Worker else
81*8d67ca89SAndroid Build Coastguard Worker t = wsize - (t & wmask);
82*8d67ca89SAndroid Build Coastguard Worker length -= t;
83*8d67ca89SAndroid Build Coastguard Worker TLOOP1(*dst++ = *src++);
84*8d67ca89SAndroid Build Coastguard Worker }
85*8d67ca89SAndroid Build Coastguard Worker /*
86*8d67ca89SAndroid Build Coastguard Worker * Copy whole words, then mop up any trailing bytes.
87*8d67ca89SAndroid Build Coastguard Worker */
88*8d67ca89SAndroid Build Coastguard Worker t = length / wsize;
89*8d67ca89SAndroid Build Coastguard Worker TLOOP(*(word *)(void *)dst = *(const word *)(const void *)src;
90*8d67ca89SAndroid Build Coastguard Worker src += wsize; dst += wsize);
91*8d67ca89SAndroid Build Coastguard Worker t = length & wmask;
92*8d67ca89SAndroid Build Coastguard Worker TLOOP(*dst++ = *src++);
93*8d67ca89SAndroid Build Coastguard Worker } else {
94*8d67ca89SAndroid Build Coastguard Worker /*
95*8d67ca89SAndroid Build Coastguard Worker * Copy backwards. Otherwise essentially the same.
96*8d67ca89SAndroid Build Coastguard Worker * Alignment works as before, except that it takes
97*8d67ca89SAndroid Build Coastguard Worker * (t&wmask) bytes to align, not wsize-(t&wmask).
98*8d67ca89SAndroid Build Coastguard Worker */
99*8d67ca89SAndroid Build Coastguard Worker src += length;
100*8d67ca89SAndroid Build Coastguard Worker dst += length;
101*8d67ca89SAndroid Build Coastguard Worker t = (uintptr_t)src;
102*8d67ca89SAndroid Build Coastguard Worker if ((t | (uintptr_t)dst) & wmask) {
103*8d67ca89SAndroid Build Coastguard Worker if ((t ^ (uintptr_t)dst) & wmask || length <= wsize)
104*8d67ca89SAndroid Build Coastguard Worker t = length;
105*8d67ca89SAndroid Build Coastguard Worker else
106*8d67ca89SAndroid Build Coastguard Worker t &= wmask;
107*8d67ca89SAndroid Build Coastguard Worker length -= t;
108*8d67ca89SAndroid Build Coastguard Worker TLOOP1(*--dst = *--src);
109*8d67ca89SAndroid Build Coastguard Worker }
110*8d67ca89SAndroid Build Coastguard Worker t = length / wsize;
111*8d67ca89SAndroid Build Coastguard Worker TLOOP(src -= wsize; dst -= wsize;
112*8d67ca89SAndroid Build Coastguard Worker *(word *)(void *)dst = *(const word *)(const void *)src);
113*8d67ca89SAndroid Build Coastguard Worker t = length & wmask;
114*8d67ca89SAndroid Build Coastguard Worker TLOOP(*--dst = *--src);
115*8d67ca89SAndroid Build Coastguard Worker }
116*8d67ca89SAndroid Build Coastguard Worker done:
117*8d67ca89SAndroid Build Coastguard Worker #if defined(MEMCOPY) || defined(MEMMOVE)
118*8d67ca89SAndroid Build Coastguard Worker return (dst0);
119*8d67ca89SAndroid Build Coastguard Worker #else
120*8d67ca89SAndroid Build Coastguard Worker return;
121*8d67ca89SAndroid Build Coastguard Worker #endif
122*8d67ca89SAndroid Build Coastguard Worker }
123