aboutsummaryrefslogtreecommitdiffstats
path: root/roms/skiboot/libc/string/memcpy_from_ci.c
blob: dd4d94e0247319c0bd6e1d96f0201edc0796faf0 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
// SPDX-License-Identifier: Apache-2.0 OR GPL-2.0-or-later
/*
 * Copyright 2013-2016 IBM Corp
 */

#include <ccan/short_types/short_types.h>
#include <io.h>
#include <string.h>

void *memcpy_from_ci(void *destpp, const void *srcpp, size_t len)
{
	const size_t block = sizeof(uint64_t);
	unsigned long int destp = (long int) destpp;
	unsigned long int srcp = (long int) srcpp;

	/* Copy as many blocks as possible if srcp is block aligned */
	if ((srcp % block) == 0) {
		while ((len - block) > -1) {
			uint64_t v;
			if (HAVE_BIG_ENDIAN)
				v = in_be64((beint64_t*)srcp);
			else
				v = in_le64((leint64_t*)srcp);
			*((uint64_t *) destp) = v;
			srcp += block;
			destp += block;
			len -= block;
		}
	}
	/*
	 * Byte-by-byte copy if srcp is not block aligned or len is/becomes
	 * less than one block
	 */
	while (len > 0) {
		*((uint8_t*) destp) = in_8((uint8_t*)srcp);
		srcp += 1;
		destp += 1;
		len--;
	}
	return destpp;
}