diff options
Diffstat (limited to 'libsyscalls_unsection_value.c')
-rw-r--r-- | libsyscalls_unsection_value.c | 76 |
1 files changed, 76 insertions, 0 deletions
diff --git a/libsyscalls_unsection_value.c b/libsyscalls_unsection_value.c new file mode 100644 index 0000000..6cd797e --- /dev/null +++ b/libsyscalls_unsection_value.c @@ -0,0 +1,76 @@ +/* See LICENSE file for copyright and license details. */ +#include "common.h" + + +enum libsyscalls_error +libsyscalls_unsection_value(unsigned long long int value_in, size_t bits, + enum libsyscalls_datatype_section section, unsigned long long int *value_out) +{ + unsigned long long int value = value_in, mask, shift; + + if (bits > sizeof(value) / sizeof(char) * CHAR_BIT || + bits & (size_t)(LIBSYSCALLS_GET_SECTION_FRACTION(section) - 1U)) + return LIBSYSCALLS_E_INVAL; + + switch (section) { + case LIBSYSCALLS_SECTION_UNDETERMINED: + case LIBSYSCALLS_SECTION_WHOLE: /* 0xFFFFFFFFFFFFFFFF */ + break; + + case LIBSYSCALLS_SECTION_LOWER_HALF: /* 0x00000000FFFFFFFF */ + case LIBSYSCALLS_SECTION_LOWER_QUARTER: /* 0x000000000000FFFF */ + break; + + case LIBSYSCALLS_SECTION_UPPER_HALF: /* 0xFFFFFFFF00000000 */ + case LIBSYSCALLS_SECTION_LOWER_MID_QUARTER: /* 0x00000000FFFF0000 */ + value <<= bits; + break; + + case LIBSYSCALLS_SECTION_INNER_HALF: /* 0x0000FFFFFFFF0000 */ + value <<= bits / 2; + break; + + case LIBSYSCALLS_SECTION_UPPER_MID_QUARTER: /* 0x0000FFFF00000000 */ + value <<= bits * 2; + break; + + case LIBSYSCALLS_SECTION_UPPER_QUARTER: /* 0xFFFF000000000000 */ + value <<= bits * 3; + break; + + case LIBSYSCALLS_SECTION_OUTER_HALF: /* 0xFFFF00000000FFFF */ + mask = (1ULL << (bits / 2)) - 1ULL; + value = ((value & ~mask) << bits) | (value & mask); + break; + + case LIBSYSCALLS_SECTION_EVEN_QUARTERS_AS_HALF: /* 0x0000FFFF0000FFFF */ + mask = (1ULL << (bits / 2)) - 1ULL; + value = ((value & ~mask) << (bits / 2)) | (value & mask); + break; + + case LIBSYSCALLS_SECTION_ODD_QUARTERS_AS_HALF: /* 0xFFFF0000FFFF0000 */ + mask = (1ULL << (bits / 2)) - 1ULL; + value = ((value & ~mask) << (bits / 2)) | (value & mask); + value <<= bits / 2; + break; + + case LIBSYSCALLS_SECTION_EVEN_BYTES_AS_HALF: /* 0x00FF00FF00FF00FF */ + value = 0; + for (shift = 0; value_in; value_in >>= 8, shift += 16) + value |= (value_in & 0xFFU) << shift; + break; + + case LIBSYSCALLS_SECTION_ODD_BYTES_AS_HALF: /* 0xFF00FF00FF00FF00 */ + value = 0; + for (shift = 8; value_in; value_in >>= 8, shift += 16) + value |= (value_in & 0xFFU) << shift; + break; + + default: + return LIBSYSCALLS_E_INVAL; + } + + if (value_out) + *value_out = value; + return LIBSYSCALLS_E_OK; +} |