platform/common/mp3.c

   1 /*
   2  * PicoDrive
   3  * (C) notaz, 2010,2013
   4  *
   5  * This work is licensed under the terms of MAME license.
   6  * See COPYING file in the top-level directory.
   7  */
   8 #include <stdio.h>
   9 #include <string.h>
  10
  11 #include <pico/pico_int.h>
  12 #include <pico/sound/mix.h>
  13 #include "mp3.h"
  14
  15 static FILE *mp3_current_file;
  16 static int mp3_file_len, mp3_file_pos;
  17 static int cdda_out_pos;
  18 static int decoder_active;
  19
  20 unsigned short mpeg1_l3_bitrates[16] = {
  21         0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320
  22 };
  23
  24 int mp3_find_sync_word(const unsigned char *buf, int size)
  25 {
  26         const unsigned char *p, *pe;
  27
  28         /* find byte-aligned syncword - need 12 (MPEG 1,2) or 11 (MPEG 2.5) matching bits */
  29         for (p = buf, pe = buf + size - 3; p <= pe; p++)
  30         {
  31                 int pn;
  32                 if (p[0] != 0xff)
  33                         continue;
  34                 pn = p[1];
  35                 if ((pn & 0xf8) != 0xf8 || // currently must be MPEG1
  36                     (pn & 6) == 0) {       // invalid layer
  37                         p++; continue;
  38                 }
  39                 pn = p[2];
  40                 if ((pn & 0xf0) < 0x20 || (pn & 0xf0) == 0xf0 || // bitrates
  41                     (pn & 0x0c) != 0) { // not 44kHz
  42                         continue;
  43                 }
  44
  45                 return p - buf;
  46         }
  47
  48         return -1;
  49 }
  50
  51 static int try_get_bitrate(unsigned char *buf, int buf_size)
  52 {
  53         int offs1, offs = 0;
  54         int ret;
  55
  56         while (1)
  57         {
  58                 offs1 = mp3_find_sync_word(buf + offs, buf_size - offs);
  59                 if (offs1 < 0)
  60                         return -2;
  61                 offs += offs1;
  62                 if (buf_size - offs < 4)
  63                         return -3;
  64
  65                 // printf("trying header %08x\n", *(int *)(buf + offs));
  66
  67                 ret = mpeg1_l3_bitrates[buf[offs + 2] >> 4];
  68                 if (ret > 0)
  69                         return ret;
  70         }
  71
  72         return -2;
  73 }
  74
  75 int mp3_get_bitrate(void *f_, int len)
  76 {
  77         unsigned char buf[2048];
  78         FILE *f = f_;
  79         int retval = -1;
  80         int ret;
  81
  82         memset(buf, 0, sizeof(buf));
  83
  84         fseek(f, 0, SEEK_SET);
  85         ret = fread(buf, 1, sizeof(buf), f);
  86         if (ret != sizeof(buf))
  87                 goto out;
  88
  89         ret = try_get_bitrate(buf, sizeof(buf));
  90         if (ret <= 0) {
  91                 // try to read somewhere around the middle
  92                 fseek(f, len / 2, SEEK_SET);
  93                 ret = fread(buf, 1, sizeof(buf), f);
  94                 if (ret == sizeof(buf))
  95                         ret = try_get_bitrate(buf, sizeof(buf));
  96         }
  97         if (ret > 0)
  98                 retval = ret;
  99
 100         //printf("bitrate: %i\n", retval);
 101
 102 out:
 103         fseek(f, 0, SEEK_SET);
 104         return retval;
 105 }
 106
 107 void mp3_start_play(void *f_, int pos1024)
 108 {
 109         unsigned char buf[2048];
 110         FILE *f = f_;
 111         int ret;
 112
 113         mp3_file_len = mp3_file_pos = 0;
 114         mp3_current_file = NULL;
 115         cdda_out_pos = 0;
 116         decoder_active = 0;
 117
 118         if (!(PicoIn.opt & POPT_EN_MCD_CDDA) || f == NULL) // cdda disabled or no file?
 119                 return;
 120
 121         fseek(f, 0, SEEK_END);
 122         mp3_file_len = ftell(f);
 123
 124         // search for first sync word, skipping stuff like ID3 tags
 125         while (mp3_file_pos < 128*1024) {
 126                 int offs, bytes;
 127
 128                 fseek(f, mp3_file_pos, SEEK_SET);
 129                 bytes = fread(buf, 1, sizeof(buf), f);
 130                 if (bytes < 4)
 131                         break;
 132                 offs = mp3_find_sync_word(buf, bytes);
 133                 if (offs >= 0) {
 134                         mp3_file_pos += offs;
 135                         break;
 136                 }
 137                 mp3_file_pos += bytes - 3;
 138         }
 139
 140         // seek..
 141         if (pos1024 != 0) {
 142                 unsigned long long pos64 = mp3_file_len - mp3_file_pos;
 143                 pos64 *= pos1024;
 144                 mp3_file_pos += pos64 >> 10;
 145         }
 146
 147         ret = mp3dec_start(f, mp3_file_pos);
 148         if (ret != 0) {
 149                 return;
 150         }
 151
 152         mp3_current_file = f;
 153         decoder_active = 1;
 154
 155         mp3dec_decode(mp3_current_file, &mp3_file_pos, mp3_file_len);
 156 }
 157
 158 void mp3_update(int *buffer, int length, int stereo)
 159 {
 160         int length_mp3, shr = 0;
 161         void (*mix_samples)(int *dest_buf, short *mp3_buf, int count) = mix_16h_to_32;
 162
 163         if (mp3_current_file == NULL || mp3_file_pos >= mp3_file_len)
 164                 return; /* no file / EOF */
 165
 166         if (!decoder_active)
 167                 return;
 168
 169         length_mp3 = length;
 170         if (PsndRate <= 11025 + 100) {
 171                 mix_samples = mix_16h_to_32_s2;
 172                 length_mp3 <<= 2; shr = 2;
 173         }
 174         else if (PsndRate <= 22050 + 100) {
 175                 mix_samples = mix_16h_to_32_s1;
 176                 length_mp3 <<= 1; shr = 1;
 177         }
 178
 179         if (1152 - cdda_out_pos >= length_mp3) {
 180                 mix_samples(buffer, cdda_out_buffer + cdda_out_pos * 2,
 181                         length * 2);
 182
 183                 cdda_out_pos += length_mp3;
 184         } else {
 185                 int ret, left = 1152 - cdda_out_pos;
 186
 187                 if (left > 0)
 188                         mix_samples(buffer, cdda_out_buffer + cdda_out_pos * 2,
 189                                 (left >> shr) * 2);
 190
 191                 ret = mp3dec_decode(mp3_current_file, &mp3_file_pos,
 192                         mp3_file_len);
 193                 if (ret == 0) {
 194                         cdda_out_pos = length_mp3 - left;
 195                         mix_samples(buffer + (left >> shr) * 2,
 196                                 cdda_out_buffer,
 197                                 (cdda_out_pos >> shr) * 2);
 198                 } else
 199                         cdda_out_pos = 0;
 200         }
 201 }
 202