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