[an error occurred while processing this directive]
|
static uint8 bcd[2];
static uint8 adj(uint8 val);
static void bin2bcd16(uint16 var)
{
uint8 cnt = 16;
bcd[0] = bcd[1] = 0;
for(;;)
{
*(uint16*)bcd <<= 1;
if (var & 0x8000)
bcd[0] |= 1;
var <<= 1;
if (!--cnt) break;
bcd[0] = adj(bcd[0]);
bcd[1] = adj(bcd[1]);
}
}
static uint8 adj(uint8 val)
{
val += 0x33;
if (!(val & 0x08)) val -= 0x03;
if (!(val & 0x80)) val -= 0x30;
return val;
E-mail: info@telesys.ru