| @ -0,0 +1,102 @@ | |||
| /***************************************************************************** | |||
| * 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 | |||