blob: 94c44eb8d2e180c0eb2df3e017049263cf055952 (
plain) (
blame)
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
51
52
53
54
55
56
57
58
59
60
|
/* See LICENSE file for copyright and license details. */
#include "common.h"
/* XXX be smarter if using the same byteorder */
enum libsyscalls_error
libsyscalls_to_tracee_endian(unsigned long long int value_in,
const struct libsyscalls_datatype_description *type,
void *value_out, size_t out_offset)
{
const unsigned long long int limit = sizeof(long long int) / sizeof(char) * CHAR_BIT;
unsigned long long int bytebits, bytemask, byte, remmask, valmask;
unsigned long long int offset, offset_byte, offset_bit;
unsigned char *out = value_out;
size_t i;
if (!type || !value_out || (unsigned long long int)type->width_in_bits > limit)
return LIBSYSCALLS_E_INVAL;
bytebits = (unsigned long long int)type->width_in_bits;
for (i = 0; !LIBSYSCALLS_IS_BYTEORDER_END_AT(type, i); i++)
if (type->byteorder[i] && (unsigned long long int)type->byteorder[i] < bytebits)
bytebits = (unsigned long long int)type->byteorder[i];
if (bytebits > limit)
return LIBSYSCALLS_E_INVAL;
else if (bytebits == limit)
bytemask = ~0ULL;
else
bytemask = (1ULL << bytebits) - 1ULL;
if ((unsigned long long int)type->width_in_bits == limit)
valmask = ~0ULL;
else
valmask = (1ULL << (unsigned long long int)type->width_in_bits) - 1ULL;
for (i = 0; !LIBSYSCALLS_IS_BYTEORDER_END_AT(type, i); i++) {
offset = out_offset;
offset_byte = offset / CHAR_BIT;
offset_bit = offset % CHAR_BIT;
out_offset += bytebits;
byte = value_in >> type->byteorder[i];
byte &= remmask = bytemask & (valmask >> type->byteorder[i]);
out[offset_byte] &= (unsigned char)~(remmask << offset_bit);
out[offset_byte] |= (unsigned char)(byte << offset_bit);
if (bytebits != limit && (remmask >>= CHAR_BIT - offset_bit)) {
byte >>= CHAR_BIT - offset_bit;
do {
offset_byte += 1;
out[offset_byte] &= (unsigned char)~remmask;
out[offset_byte] |= (unsigned char)byte;
byte >>= CHAR_BIT;
} while (remmask >>= CHAR_BIT);
}
}
return LIBSYSCALLS_E_OK;
}
|
