1 /*
2 ** Copyright 2001, Travis Geiselbrecht. All rights reserved.
3 ** Distributed under the terms of the NewOS License.
4 */
5 /*
6 * Copyright (c) 2008 Travis Geiselbrecht
7 *
8 * Permission is hereby granted, free of charge, to any person obtaining
9 * a copy of this software and associated documentation files
10 * (the "Software"), to deal in the Software without restriction,
11 * including without limitation the rights to use, copy, modify, merge,
12 * publish, distribute, sublicense, and/or sell copies of the Software,
13 * and to permit persons to whom the Software is furnished to do so,
14 * subject to the following conditions:
15 *
16 * The above copyright notice and this permission notice shall be
17 * included in all copies or substantial portions of the Software.
18 *
19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
20 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
21 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
22 * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
23 * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
24 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
25 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
26 */
27 #include <stdint.h>
28 #include <string.h>
29 #include <sys/types.h>
30
31 #if !_ASM_MEMMOVE
32
33 typedef long word;
34
35 #define lsize sizeof(word)
36 #define lmask (lsize - 1)
37
38 void *
memmove(void * dest,void const * src,size_t count)39 memmove(void *dest, void const *src, size_t count)
40 {
41 char *d = (char *)dest;
42 const char *s = (const char *)src;
43 int len;
44
45 if (count == 0 || dest == src)
46 return dest;
47
48 if ((uintptr_t)d < (uintptr_t)s) {
49 if (((uintptr_t)d | (uintptr_t)s) & lmask) {
50 // src and/or dest do not align on word boundary
51 if ((((uintptr_t)d ^ (uintptr_t)s) & lmask) || (count < lsize))
52 len = count; // copy the rest of the buffer with the byte mover
53 else
54 len = lsize - ((uintptr_t)d & lmask); // move the ptrs up to a word boundary
55
56 count -= len;
57 for (; len > 0; len--)
58 *d++ = *s++;
59 }
60 for (len = count / lsize; len > 0; len--) {
61 *(word *)d = *(word *)s;
62 d += lsize;
63 s += lsize;
64 }
65 for (len = count & lmask; len > 0; len--)
66 *d++ = *s++;
67 } else {
68 d += count;
69 s += count;
70 if (((uintptr_t)d | (uintptr_t)s) & lmask) {
71 // src and/or dest do not align on word boundary
72 if ((((uintptr_t)d ^ (uintptr_t)s) & lmask) || (count <= lsize))
73 len = count;
74 else
75 len = ((uintptr_t)d & lmask);
76
77 count -= len;
78 for (; len > 0; len--)
79 *--d = *--s;
80 }
81 for (len = count / lsize; len > 0; len--) {
82 d -= lsize;
83 s -= lsize;
84 *(word *)d = *(word *)s;
85 }
86 for (len = count & lmask; len > 0; len--)
87 *--d = *--s;
88 }
89
90 return dest;
91 }
92
93 #endif
94
95