aboutsummaryrefslogtreecommitdiff
path: root/lib/libutils/isoc/arch/arm/arm32_aeabi_shift.c
blob: 75caa5bc04a318b2a0d2f5cea0664a584aa38f5e (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
42
43
44
45
46
47
48
49
50
// SPDX-License-Identifier: BSD-2-Clause
/*
 * Copyright (c) 2015, Linaro Limited
 * All rights reserved.
 */

union dword {
	unsigned long long dw;
	unsigned long w[2];
};

long long __aeabi_llsl(long long a, int shift);
long long __aeabi_llsl(long long a, int shift)
{
	union dword dword = { .dw = a };
	unsigned long hi = dword.w[1];
	unsigned long lo = dword.w[0];

	if (shift >= 32) {
		hi = lo << (shift - 32);
		lo = 0;
	} else if (shift > 0) {
		hi = (hi << shift) | (lo >> (32 - shift));
		lo = lo << shift;
	}

	dword.w[1] = hi;
	dword.w[0] = lo;
	return dword.dw;
}

long long __aeabi_llsr(long long a, int shift);
long long __aeabi_llsr(long long a, int shift)
{
	union dword dword = { .dw = a };
	unsigned long hi = dword.w[1];
	unsigned long lo = dword.w[0];

	if (shift >= 32) {
		lo = hi >> (shift - 32);
		hi = 0;
	} else if (shift > 0) {
		lo = (lo >> shift) | (hi << (32 - shift));
		hi = hi >> shift;
	}

	dword.w[1] = hi;
	dword.w[0] = lo;
	return dword.dw;
}