/*****************************************************************************
 * numbers.h: BCD functions
 *****************************************************************************
 * Copyright (C) 2009-2010 VideoLAN
 *
 * Authors: Christophe Massiot <massiot@via.ecp.fr>
 *
 * Permission is hereby granted, free of charge, to any person obtaining
 * a copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sublicense, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject
 * to the following conditions:
 *
 * The above copyright notice and this permission notice shall be
 * included in all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
 * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
 * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 *****************************************************************************/

#ifndef __BITSTREAM_DVB_BCD_H__
#define __BITSTREAM_DVB_BCD_H__

#include <stdint.h>   /* uint8_t, uint16_t, etc... */

#ifdef __cplusplus
extern "C"
{
#endif

/*****************************************************************************
 * DVB numbers
 *****************************************************************************/
static inline unsigned int dvb_bcd_get(const uint8_t *p_bcd, uint8_t i_width)
{
    unsigned int i_result = 0;

    while (i_width >= 8) {
        i_result *= 10;
        i_result += (*p_bcd) >> 4;
        i_result *= 10;
        i_result += (*p_bcd) & 0xf;
        i_width -= 8;
        p_bcd++;
    }

    if (i_width == 4) {
        i_result *= 10;
        i_result += (*p_bcd) >> 4;
    }

    return i_result;
}

static inline void dvb_bcd_set(uint8_t *p_bcd, unsigned int i_int,
                               uint8_t i_width)
{
    /* calculate 10^(i_width/4-1) */
    unsigned int i_factor = 1, i_exp = i_width / 4 - 1, i_base = 10;
    while (i_exp)
    {
        if (i_exp & 1)
            i_factor *= i_base;
        i_exp >>= 1;
        i_base *= i_base;
    }

    while (i_factor >= 10) {
        *p_bcd = (i_int / i_factor) << 4;
        i_int %= i_factor;
        i_factor /= 10;
        *p_bcd |= (i_int / i_factor);
        i_int %= i_factor;
        i_factor /= 10;
        p_bcd++;
    }

    if (i_factor == 1) {
        *p_bcd &= 0xf;
        *p_bcd |= i_int << 4;
    }
}

static inline uint8_t dvb_bcd_set8(unsigned int i_int)
{
    uint8_t i_result;
    dvb_bcd_set(&i_result, i_int, 8);
    return i_result;
}

#ifdef __cplusplus
}
#endif

#endif