GY-63_MS5611/libraries/NibbleArray/nibbleArray.cpp
2021-01-29 12:31:58 +01:00

61 lines
1.3 KiB
C++

//
// FILE: nibbleArray.cpp
// AUTHOR: Rob Tillaart
// VERSION: 0.2.1
// PURPOSE: Arduino library for a compact array of nibbles (4 bits)
// URL: https://github.com/RobTillaart/nibbleArray
//
// HISTORY:
// 0.1.0 2015-04-12 initial version
// 0.2.0 2020-06-21 refactor; #pragma once; removed pre 1.0 support
// 0.2.1 2020-01-02 arduino-CI + unit test
#include "nibbleArray.h"
nibbleArray::nibbleArray(uint16_t size)
{
_size = min(NIBBLEARRAY_MAXSIZE, size);
arr = (uint8_t *) malloc((_size + 1)/2);
}
nibbleArray::~nibbleArray()
{
if (arr != NULL) free(arr);
}
uint8_t nibbleArray::get(const uint16_t idx)
{
if (idx > _size) return NIBBLEARRAY_ERROR_INDEX; // disable this check for more speed
if (idx & 1) return arr[idx/2] & 0x0F;
return arr[idx/2] >> 4;
}
uint8_t nibbleArray::set(const uint16_t idx, uint8_t value)
{
if (idx > _size) return NIBBLEARRAY_ERROR_INDEX; // disable this check for more speed
uint8_t v = value & 0x0F;
if (idx & 1) arr[idx/2] = (arr[idx/2] & 0xF0) | v;
else arr[idx/2] = (arr[idx/2] & 0x0F) | (v << 4);
return NIBBLEARRAY_OK;
}
void nibbleArray::clear()
{
memset(arr, 0, (_size+1)/2);
}
void nibbleArray::setAll(uint8_t val)
{
uint8_t v = (val << 4) | val;
memset(arr, v, (_size + 1)/2);
}
// -- END OF FILE --