bin2bcd

bin2bcd.c

uint32_t bin2bcd(const uint16_t in) {
  uint32_t out = 0;
  for (uint8_t pos = 13; pos >= 0; pos--) {
    if ((out & 0xF) >= 5)
      out += 3;
    if (((out & 0xF0) >> 4) >= 5)
      out += (3 << 4);
    if (((out & 0xF00) >> 8) >= 5)
      out += (3 << 8);
    out = (out << 1) | ((in >> pos) & 1);
  }
  return out;
}