//
//    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 --