112 lines
2.3 KiB
C
112 lines
2.3 KiB
C
/* Copyright (C) 2023 Aryadev Chavali
|
|
|
|
* You may distribute and modify this code under the terms of the
|
|
* GPLv2 license. You should have received a copy of the GPLv2
|
|
* license with this file. If not, please write to:
|
|
* aryadev@aryadevchavali.com.
|
|
|
|
* Created: 2023-10-26
|
|
* Author: Aryadev Chavali
|
|
* Description: Implementation of basic library functions
|
|
*/
|
|
|
|
#include "./base.h"
|
|
|
|
#include <string.h>
|
|
|
|
union hword_pun
|
|
{
|
|
hword_t h;
|
|
byte_t bytes[HWORD_SIZE];
|
|
};
|
|
|
|
union word_pun
|
|
{
|
|
word_t h;
|
|
byte_t bytes[WORD_SIZE];
|
|
};
|
|
|
|
hword_t hword_htobc(hword_t w)
|
|
{
|
|
if (LITTLE_ENDIAN)
|
|
return w;
|
|
union hword_pun x = {w};
|
|
union hword_pun y = {0};
|
|
for (size_t i = 0, j = HWORD_SIZE; i < HWORD_SIZE; ++i, --j)
|
|
y.bytes[j - 1] = x.bytes[i];
|
|
return y.h;
|
|
}
|
|
|
|
hword_t hword_bctoh(hword_t w)
|
|
{
|
|
if (LITTLE_ENDIAN)
|
|
return w;
|
|
union hword_pun x = {w};
|
|
union hword_pun y = {0};
|
|
for (size_t i = 0, j = HWORD_SIZE; i < HWORD_SIZE; ++i, --j)
|
|
y.bytes[j - 1] = x.bytes[i];
|
|
return y.h;
|
|
}
|
|
|
|
word_t word_htobc(word_t w)
|
|
{
|
|
if (LITTLE_ENDIAN)
|
|
return w;
|
|
union word_pun x = {w};
|
|
union word_pun y = {0};
|
|
for (size_t i = 0, j = WORD_SIZE; i < WORD_SIZE; ++i, --j)
|
|
y.bytes[j - 1] = x.bytes[i];
|
|
return y.h;
|
|
}
|
|
|
|
word_t word_bctoh(word_t w)
|
|
{
|
|
if (LITTLE_ENDIAN)
|
|
return w;
|
|
union word_pun x = {w};
|
|
union word_pun y = {0};
|
|
for (size_t i = 0, j = WORD_SIZE; i < WORD_SIZE; ++i, --j)
|
|
y.bytes[j - 1] = x.bytes[i];
|
|
return y.h;
|
|
}
|
|
|
|
hword_t convert_bytes_to_hword(const byte_t *bytes)
|
|
{
|
|
hword_t h = 0;
|
|
if (LITTLE_ENDIAN)
|
|
memcpy(&h, bytes, HWORD_SIZE);
|
|
else
|
|
for (size_t i = 0; i < HWORD_SIZE; ++i)
|
|
h |= ((hword_t)(bytes[i]) << (8 * i));
|
|
return h;
|
|
}
|
|
|
|
word_t convert_bytes_to_word(const byte_t *bytes)
|
|
{
|
|
word_t h = 0;
|
|
if (LITTLE_ENDIAN)
|
|
memcpy(&h, bytes, WORD_SIZE);
|
|
else
|
|
for (size_t i = 0; i < WORD_SIZE; ++i)
|
|
h |= ((word_t)(bytes[i]) << (8 * i));
|
|
return h;
|
|
}
|
|
|
|
void convert_hword_to_bytes(hword_t w, byte_t *bytes)
|
|
{
|
|
if (LITTLE_ENDIAN)
|
|
memcpy(bytes, &w, HWORD_SIZE);
|
|
else
|
|
for (size_t i = 0; i < HWORD_SIZE; ++i)
|
|
bytes[i] = WORD_NTH_BYTE(w, i);
|
|
}
|
|
|
|
void convert_word_to_bytes(word_t w, byte_t *bytes)
|
|
{
|
|
if (LITTLE_ENDIAN)
|
|
memcpy(bytes, &w, WORD_SIZE);
|
|
else
|
|
for (size_t i = 0; i < WORD_SIZE; ++i)
|
|
bytes[i] = WORD_NTH_BYTE(w, i);
|
|
}
|