Suga koubou / Mbed 2 deprecated madplayer_lpc4088

MP3 Player. You can change fwd/rev speed and skip. see: http://mbed.org/users/okini3939/notebook/lpc4088_madplayer/

Dependencies:   I2SSlave SDFileSystem TLV320 mbed

madplayer/bit.cpp@0:8ba6230eefbd, 2014-02-18 (annotated)

Committer:
okini3939
Date:
Tue Feb 18 00:22:50 2014 +0000
Revision:
0:8ba6230eefbd
1st build

Who changed what in which revision?

UserRevisionLine numberNew contents of line
okini3939 0:8ba6230eefbd 1 /*
okini3939 0:8ba6230eefbd 2 * libmad - MPEG audio decoder library
okini3939 0:8ba6230eefbd 3 * Copyright (C) 2000-2004 Underbit Technologies, Inc.
okini3939 0:8ba6230eefbd 4 *
okini3939 0:8ba6230eefbd 5 * This program is free software; you can redistribute it and/or modify
okini3939 0:8ba6230eefbd 6 * it under the terms of the GNU General Public License as published by
okini3939 0:8ba6230eefbd 7 * the Free Software Foundation; either version 2 of the License, or
okini3939 0:8ba6230eefbd 8 * (at your option) any later version.
okini3939 0:8ba6230eefbd 9 *
okini3939 0:8ba6230eefbd 10 * This program is distributed in the hope that it will be useful,
okini3939 0:8ba6230eefbd 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
okini3939 0:8ba6230eefbd 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
okini3939 0:8ba6230eefbd 13 * GNU General Public License for more details.
okini3939 0:8ba6230eefbd 14 *
okini3939 0:8ba6230eefbd 15 * You should have received a copy of the GNU General Public License
okini3939 0:8ba6230eefbd 16 * along with this program; if not, write to the Free Software
okini3939 0:8ba6230eefbd 17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
okini3939 0:8ba6230eefbd 18 *
okini3939 0:8ba6230eefbd 19 * $Id: bit.c,v 1.1 2010/11/23 20:12:57 andy Exp $
okini3939 0:8ba6230eefbd 20 */
okini3939 0:8ba6230eefbd 21
okini3939 0:8ba6230eefbd 22 # include "config.h"
okini3939 0:8ba6230eefbd 23
okini3939 0:8ba6230eefbd 24 # include "global.h"
okini3939 0:8ba6230eefbd 25
okini3939 0:8ba6230eefbd 26 # ifdef HAVE_LIMITS_H
okini3939 0:8ba6230eefbd 27 # include <limits.h>
okini3939 0:8ba6230eefbd 28 # else
okini3939 0:8ba6230eefbd 29 # define CHAR_BIT 8
okini3939 0:8ba6230eefbd 30 # endif
okini3939 0:8ba6230eefbd 31
okini3939 0:8ba6230eefbd 32 # include "bit.h"
okini3939 0:8ba6230eefbd 33
okini3939 0:8ba6230eefbd 34 /*
okini3939 0:8ba6230eefbd 35 * This is the lookup table for computing the CRC-check word.
okini3939 0:8ba6230eefbd 36 * As described in section 2.4.3.1 and depicted in Figure A.9
okini3939 0:8ba6230eefbd 37 * of ISO/IEC 11172-3, the generator polynomial is:
okini3939 0:8ba6230eefbd 38 *
okini3939 0:8ba6230eefbd 39 * G(X) = X^16 + X^15 + X^2 + 1
okini3939 0:8ba6230eefbd 40 */
okini3939 0:8ba6230eefbd 41 static
okini3939 0:8ba6230eefbd 42 unsigned short const crc_table[256] = {
okini3939 0:8ba6230eefbd 43 0x0000, 0x8005, 0x800f, 0x000a, 0x801b, 0x001e, 0x0014, 0x8011,
okini3939 0:8ba6230eefbd 44 0x8033, 0x0036, 0x003c, 0x8039, 0x0028, 0x802d, 0x8027, 0x0022,
okini3939 0:8ba6230eefbd 45 0x8063, 0x0066, 0x006c, 0x8069, 0x0078, 0x807d, 0x8077, 0x0072,
okini3939 0:8ba6230eefbd 46 0x0050, 0x8055, 0x805f, 0x005a, 0x804b, 0x004e, 0x0044, 0x8041,
okini3939 0:8ba6230eefbd 47 0x80c3, 0x00c6, 0x00cc, 0x80c9, 0x00d8, 0x80dd, 0x80d7, 0x00d2,
okini3939 0:8ba6230eefbd 48 0x00f0, 0x80f5, 0x80ff, 0x00fa, 0x80eb, 0x00ee, 0x00e4, 0x80e1,
okini3939 0:8ba6230eefbd 49 0x00a0, 0x80a5, 0x80af, 0x00aa, 0x80bb, 0x00be, 0x00b4, 0x80b1,
okini3939 0:8ba6230eefbd 50 0x8093, 0x0096, 0x009c, 0x8099, 0x0088, 0x808d, 0x8087, 0x0082,
okini3939 0:8ba6230eefbd 51
okini3939 0:8ba6230eefbd 52 0x8183, 0x0186, 0x018c, 0x8189, 0x0198, 0x819d, 0x8197, 0x0192,
okini3939 0:8ba6230eefbd 53 0x01b0, 0x81b5, 0x81bf, 0x01ba, 0x81ab, 0x01ae, 0x01a4, 0x81a1,
okini3939 0:8ba6230eefbd 54 0x01e0, 0x81e5, 0x81ef, 0x01ea, 0x81fb, 0x01fe, 0x01f4, 0x81f1,
okini3939 0:8ba6230eefbd 55 0x81d3, 0x01d6, 0x01dc, 0x81d9, 0x01c8, 0x81cd, 0x81c7, 0x01c2,
okini3939 0:8ba6230eefbd 56 0x0140, 0x8145, 0x814f, 0x014a, 0x815b, 0x015e, 0x0154, 0x8151,
okini3939 0:8ba6230eefbd 57 0x8173, 0x0176, 0x017c, 0x8179, 0x0168, 0x816d, 0x8167, 0x0162,
okini3939 0:8ba6230eefbd 58 0x8123, 0x0126, 0x012c, 0x8129, 0x0138, 0x813d, 0x8137, 0x0132,
okini3939 0:8ba6230eefbd 59 0x0110, 0x8115, 0x811f, 0x011a, 0x810b, 0x010e, 0x0104, 0x8101,
okini3939 0:8ba6230eefbd 60
okini3939 0:8ba6230eefbd 61 0x8303, 0x0306, 0x030c, 0x8309, 0x0318, 0x831d, 0x8317, 0x0312,
okini3939 0:8ba6230eefbd 62 0x0330, 0x8335, 0x833f, 0x033a, 0x832b, 0x032e, 0x0324, 0x8321,
okini3939 0:8ba6230eefbd 63 0x0360, 0x8365, 0x836f, 0x036a, 0x837b, 0x037e, 0x0374, 0x8371,
okini3939 0:8ba6230eefbd 64 0x8353, 0x0356, 0x035c, 0x8359, 0x0348, 0x834d, 0x8347, 0x0342,
okini3939 0:8ba6230eefbd 65 0x03c0, 0x83c5, 0x83cf, 0x03ca, 0x83db, 0x03de, 0x03d4, 0x83d1,
okini3939 0:8ba6230eefbd 66 0x83f3, 0x03f6, 0x03fc, 0x83f9, 0x03e8, 0x83ed, 0x83e7, 0x03e2,
okini3939 0:8ba6230eefbd 67 0x83a3, 0x03a6, 0x03ac, 0x83a9, 0x03b8, 0x83bd, 0x83b7, 0x03b2,
okini3939 0:8ba6230eefbd 68 0x0390, 0x8395, 0x839f, 0x039a, 0x838b, 0x038e, 0x0384, 0x8381,
okini3939 0:8ba6230eefbd 69
okini3939 0:8ba6230eefbd 70 0x0280, 0x8285, 0x828f, 0x028a, 0x829b, 0x029e, 0x0294, 0x8291,
okini3939 0:8ba6230eefbd 71 0x82b3, 0x02b6, 0x02bc, 0x82b9, 0x02a8, 0x82ad, 0x82a7, 0x02a2,
okini3939 0:8ba6230eefbd 72 0x82e3, 0x02e6, 0x02ec, 0x82e9, 0x02f8, 0x82fd, 0x82f7, 0x02f2,
okini3939 0:8ba6230eefbd 73 0x02d0, 0x82d5, 0x82df, 0x02da, 0x82cb, 0x02ce, 0x02c4, 0x82c1,
okini3939 0:8ba6230eefbd 74 0x8243, 0x0246, 0x024c, 0x8249, 0x0258, 0x825d, 0x8257, 0x0252,
okini3939 0:8ba6230eefbd 75 0x0270, 0x8275, 0x827f, 0x027a, 0x826b, 0x026e, 0x0264, 0x8261,
okini3939 0:8ba6230eefbd 76 0x0220, 0x8225, 0x822f, 0x022a, 0x823b, 0x023e, 0x0234, 0x8231,
okini3939 0:8ba6230eefbd 77 0x8213, 0x0216, 0x021c, 0x8219, 0x0208, 0x820d, 0x8207, 0x0202
okini3939 0:8ba6230eefbd 78 };
okini3939 0:8ba6230eefbd 79
okini3939 0:8ba6230eefbd 80 # define CRC_POLY 0x8005
okini3939 0:8ba6230eefbd 81
okini3939 0:8ba6230eefbd 82 /*
okini3939 0:8ba6230eefbd 83 * NAME: bit->init()
okini3939 0:8ba6230eefbd 84 * DESCRIPTION: initialize bit pointer struct
okini3939 0:8ba6230eefbd 85 */
okini3939 0:8ba6230eefbd 86 void mad_bit_init(struct mad_bitptr *bitptr, unsigned char const *byte)
okini3939 0:8ba6230eefbd 87 {
okini3939 0:8ba6230eefbd 88 bitptr->byte = byte;
okini3939 0:8ba6230eefbd 89 bitptr->cache = 0;
okini3939 0:8ba6230eefbd 90 bitptr->left = CHAR_BIT;
okini3939 0:8ba6230eefbd 91 }
okini3939 0:8ba6230eefbd 92
okini3939 0:8ba6230eefbd 93 /*
okini3939 0:8ba6230eefbd 94 * NAME: bit->length()
okini3939 0:8ba6230eefbd 95 * DESCRIPTION: return number of bits between start and end points
okini3939 0:8ba6230eefbd 96 */
okini3939 0:8ba6230eefbd 97 unsigned int mad_bit_length(struct mad_bitptr const *begin,
okini3939 0:8ba6230eefbd 98 struct mad_bitptr const *end)
okini3939 0:8ba6230eefbd 99 {
okini3939 0:8ba6230eefbd 100 return begin->left +
okini3939 0:8ba6230eefbd 101 CHAR_BIT * (end->byte - (begin->byte + 1)) + (CHAR_BIT - end->left);
okini3939 0:8ba6230eefbd 102 }
okini3939 0:8ba6230eefbd 103
okini3939 0:8ba6230eefbd 104 /*
okini3939 0:8ba6230eefbd 105 * NAME: bit->nextbyte()
okini3939 0:8ba6230eefbd 106 * DESCRIPTION: return pointer to next unprocessed byte
okini3939 0:8ba6230eefbd 107 */
okini3939 0:8ba6230eefbd 108 unsigned char const *mad_bit_nextbyte(struct mad_bitptr const *bitptr)
okini3939 0:8ba6230eefbd 109 {
okini3939 0:8ba6230eefbd 110 return bitptr->left == CHAR_BIT ? bitptr->byte : bitptr->byte + 1;
okini3939 0:8ba6230eefbd 111 }
okini3939 0:8ba6230eefbd 112
okini3939 0:8ba6230eefbd 113 /*
okini3939 0:8ba6230eefbd 114 * NAME: bit->skip()
okini3939 0:8ba6230eefbd 115 * DESCRIPTION: advance bit pointer
okini3939 0:8ba6230eefbd 116 */
okini3939 0:8ba6230eefbd 117 void mad_bit_skip(struct mad_bitptr *bitptr, unsigned int len)
okini3939 0:8ba6230eefbd 118 {
okini3939 0:8ba6230eefbd 119 bitptr->byte += len / CHAR_BIT;
okini3939 0:8ba6230eefbd 120 bitptr->left -= len % CHAR_BIT;
okini3939 0:8ba6230eefbd 121
okini3939 0:8ba6230eefbd 122 if (bitptr->left > CHAR_BIT) {
okini3939 0:8ba6230eefbd 123 bitptr->byte++;
okini3939 0:8ba6230eefbd 124 bitptr->left += CHAR_BIT;
okini3939 0:8ba6230eefbd 125 }
okini3939 0:8ba6230eefbd 126
okini3939 0:8ba6230eefbd 127 if (bitptr->left < CHAR_BIT)
okini3939 0:8ba6230eefbd 128 bitptr->cache = *bitptr->byte;
okini3939 0:8ba6230eefbd 129 }
okini3939 0:8ba6230eefbd 130
okini3939 0:8ba6230eefbd 131 /*
okini3939 0:8ba6230eefbd 132 * NAME: bit->read()
okini3939 0:8ba6230eefbd 133 * DESCRIPTION: read an arbitrary number of bits and return their UIMSBF value
okini3939 0:8ba6230eefbd 134 */
okini3939 0:8ba6230eefbd 135 unsigned long mad_bit_read(struct mad_bitptr *bitptr, unsigned int len)
okini3939 0:8ba6230eefbd 136 {
okini3939 0:8ba6230eefbd 137 register unsigned long value;
okini3939 0:8ba6230eefbd 138
okini3939 0:8ba6230eefbd 139 if (bitptr->left == CHAR_BIT)
okini3939 0:8ba6230eefbd 140 bitptr->cache = *bitptr->byte;
okini3939 0:8ba6230eefbd 141
okini3939 0:8ba6230eefbd 142 if (len < bitptr->left) {
okini3939 0:8ba6230eefbd 143 value = (bitptr->cache & ((1 << bitptr->left) - 1)) >>
okini3939 0:8ba6230eefbd 144 (bitptr->left - len);
okini3939 0:8ba6230eefbd 145 bitptr->left -= len;
okini3939 0:8ba6230eefbd 146
okini3939 0:8ba6230eefbd 147 return value;
okini3939 0:8ba6230eefbd 148 }
okini3939 0:8ba6230eefbd 149
okini3939 0:8ba6230eefbd 150 /* remaining bits in current byte */
okini3939 0:8ba6230eefbd 151
okini3939 0:8ba6230eefbd 152 value = bitptr->cache & ((1 << bitptr->left) - 1);
okini3939 0:8ba6230eefbd 153 len -= bitptr->left;
okini3939 0:8ba6230eefbd 154
okini3939 0:8ba6230eefbd 155 bitptr->byte++;
okini3939 0:8ba6230eefbd 156 bitptr->left = CHAR_BIT;
okini3939 0:8ba6230eefbd 157
okini3939 0:8ba6230eefbd 158 /* more bytes */
okini3939 0:8ba6230eefbd 159
okini3939 0:8ba6230eefbd 160 while (len >= CHAR_BIT) {
okini3939 0:8ba6230eefbd 161 value = (value << CHAR_BIT) | *bitptr->byte++;
okini3939 0:8ba6230eefbd 162 len -= CHAR_BIT;
okini3939 0:8ba6230eefbd 163 }
okini3939 0:8ba6230eefbd 164
okini3939 0:8ba6230eefbd 165 if (len > 0) {
okini3939 0:8ba6230eefbd 166 bitptr->cache = *bitptr->byte;
okini3939 0:8ba6230eefbd 167
okini3939 0:8ba6230eefbd 168 value = (value << len) | (bitptr->cache >> (CHAR_BIT - len));
okini3939 0:8ba6230eefbd 169 bitptr->left -= len;
okini3939 0:8ba6230eefbd 170 }
okini3939 0:8ba6230eefbd 171
okini3939 0:8ba6230eefbd 172 return value;
okini3939 0:8ba6230eefbd 173 }
okini3939 0:8ba6230eefbd 174
okini3939 0:8ba6230eefbd 175 # if 0
okini3939 0:8ba6230eefbd 176 /*
okini3939 0:8ba6230eefbd 177 * NAME: bit->write()
okini3939 0:8ba6230eefbd 178 * DESCRIPTION: write an arbitrary number of bits
okini3939 0:8ba6230eefbd 179 */
okini3939 0:8ba6230eefbd 180 void mad_bit_write(struct mad_bitptr *bitptr, unsigned int len,
okini3939 0:8ba6230eefbd 181 unsigned long value)
okini3939 0:8ba6230eefbd 182 {
okini3939 0:8ba6230eefbd 183 unsigned char *ptr;
okini3939 0:8ba6230eefbd 184
okini3939 0:8ba6230eefbd 185 ptr = (unsigned char *) bitptr->byte;
okini3939 0:8ba6230eefbd 186
okini3939 0:8ba6230eefbd 187 /* ... */
okini3939 0:8ba6230eefbd 188 }
okini3939 0:8ba6230eefbd 189 # endif
okini3939 0:8ba6230eefbd 190
okini3939 0:8ba6230eefbd 191 /*
okini3939 0:8ba6230eefbd 192 * NAME: bit->crc()
okini3939 0:8ba6230eefbd 193 * DESCRIPTION: compute CRC-check word
okini3939 0:8ba6230eefbd 194 */
okini3939 0:8ba6230eefbd 195 unsigned short mad_bit_crc(struct mad_bitptr bitptr, unsigned int len,
okini3939 0:8ba6230eefbd 196 unsigned short init)
okini3939 0:8ba6230eefbd 197 {
okini3939 0:8ba6230eefbd 198 register unsigned int crc;
okini3939 0:8ba6230eefbd 199
okini3939 0:8ba6230eefbd 200 for (crc = init; len >= 32; len -= 32) {
okini3939 0:8ba6230eefbd 201 register unsigned long data;
okini3939 0:8ba6230eefbd 202
okini3939 0:8ba6230eefbd 203 data = mad_bit_read(&bitptr, 32);
okini3939 0:8ba6230eefbd 204
okini3939 0:8ba6230eefbd 205 crc = (crc << 8) ^ crc_table[((crc >> 8) ^ (data >> 24)) & 0xff];
okini3939 0:8ba6230eefbd 206 crc = (crc << 8) ^ crc_table[((crc >> 8) ^ (data >> 16)) & 0xff];
okini3939 0:8ba6230eefbd 207 crc = (crc << 8) ^ crc_table[((crc >> 8) ^ (data >> 8)) & 0xff];
okini3939 0:8ba6230eefbd 208 crc = (crc << 8) ^ crc_table[((crc >> 8) ^ (data >> 0)) & 0xff];
okini3939 0:8ba6230eefbd 209 }
okini3939 0:8ba6230eefbd 210
okini3939 0:8ba6230eefbd 211 switch (len / 8) {
okini3939 0:8ba6230eefbd 212 case 3: crc = (crc << 8) ^
okini3939 0:8ba6230eefbd 213 crc_table[((crc >> 8) ^ mad_bit_read(&bitptr, 8)) & 0xff];
okini3939 0:8ba6230eefbd 214 case 2: crc = (crc << 8) ^
okini3939 0:8ba6230eefbd 215 crc_table[((crc >> 8) ^ mad_bit_read(&bitptr, 8)) & 0xff];
okini3939 0:8ba6230eefbd 216 case 1: crc = (crc << 8) ^
okini3939 0:8ba6230eefbd 217 crc_table[((crc >> 8) ^ mad_bit_read(&bitptr, 8)) & 0xff];
okini3939 0:8ba6230eefbd 218
okini3939 0:8ba6230eefbd 219 len %= 8;
okini3939 0:8ba6230eefbd 220
okini3939 0:8ba6230eefbd 221 case 0: break;
okini3939 0:8ba6230eefbd 222 }
okini3939 0:8ba6230eefbd 223
okini3939 0:8ba6230eefbd 224 while (len--) {
okini3939 0:8ba6230eefbd 225 register unsigned int msb;
okini3939 0:8ba6230eefbd 226
okini3939 0:8ba6230eefbd 227 msb = mad_bit_read(&bitptr, 1) ^ (crc >> 15);
okini3939 0:8ba6230eefbd 228
okini3939 0:8ba6230eefbd 229 crc <<= 1;
okini3939 0:8ba6230eefbd 230 if (msb & 1)
okini3939 0:8ba6230eefbd 231 crc ^= CRC_POLY;
okini3939 0:8ba6230eefbd 232 }
okini3939 0:8ba6230eefbd 233
okini3939 0:8ba6230eefbd 234 return crc & 0xffff;
okini3939 0:8ba6230eefbd 235 }