Add a function to set a single nibble in a bitarray.

2 files changed, 9 insertions, 0 deletions

diff --git a/src/bitfield/bitfield.c b/src/bitfield/bitfield.c
index af17d485..ae1be403 100644
--- a/src/bitfield/bitfield.c
+++ b/src/bitfield/bitfield.c
@@ -21,3 +21,9 @@ uint8_t get_byte(const uint8_t source[], const uint8_t source_length,
     }
     return 0;
 }
+
+bool set_nibble(const uint16_t nibble_index, const uint8_t value,
+        uint8_t* destination, const uint16_t destination_length) {
+    return copy_bits(&value, CHAR_BIT, NIBBLE_SIZE, NIBBLE_SIZE, destination,
+            destination_length, nibble_index * NIBBLE_SIZE);
+}
diff --git a/src/bitfield/bitfield.h b/src/bitfield/bitfield.h
index b58e4e59..990482fc 100644
--- a/src/bitfield/bitfield.h
+++ b/src/bitfield/bitfield.h
@@ -110,6 +110,9 @@ bool copy_bits_right_aligned(const uint8_t source[], const uint16_t source_lengt
                 const uint16_t offset, const uint16_t bit_count,
                 uint8_t* destination, const uint16_t destination_length);
 
+bool set_nibble(const uint16_t nibble_index, const uint8_t value,
+                uint8_t* destination, const uint16_t destination_length);
+
 #ifdef __cplusplus
 }
 #endif