BCD.h

Go to the documentation of this file.

#ifndef COSA_BCD_H
#define COSA_BCD_H

#include "Cosa/Types.h"

inline uint8_t to_binary(uint8_t value) __attribute__((always_inline));
inline uint8_t
to_binary(uint8_t value)
{
  uint8_t high = (value >> 4);
  uint8_t low = (value & 0x0f);
  return ((high << 3) + (high << 1) + low);
}

inline uint8_t to_bcd(uint8_t value)  __attribute__((always_inline));
inline uint8_t
to_bcd(uint8_t value)
{
  uint8_t res = 0;
  while (value > 9) {
    res += 0x10;
    value -= 10;
  }
  return (res + value);
}

inline void
to_binary(uint8_t* buf, size_t size)
{
  for (uint8_t i = 0; i < size; i++)
    buf[i] = to_binary(buf[i]);
}

inline void
to_bcd(uint8_t* buf, size_t size)
{
  for (uint8_t i = 0; i < size; i++)
    buf[i] = to_bcd(buf[i]);
}

#endif