platform/gp2x/code940/940.c

   1 #include "940shared.h"\r
   2 \r
   3 static _940_data_t *shared_data = (_940_data_t *)   0x00100000;\r
   4 static _940_ctl_t  *shared_ctl  = (_940_ctl_t *)    0x00200000;\r
   5 static unsigned char *mp3_data  = (unsigned char *) 0x01000000;\r
   6 YM2612 *ym2612_940;\r
   7 int *mix_buffer;\r
   8 \r
   9 // from init.s\r
  10 void wait_irq(void);\r
  11 void spend_cycles(int c);\r
  12 void cache_clean(void);\r
  13 void cache_clean_flush(void);\r
  14 \r
  15 //      asm volatile ("mov r0, #0" ::: "r0");\r
  16 //      asm volatile ("mcr p15, 0, r0, c7, c6,  0" ::: "r0"); /* flush dcache */\r
  17 //      asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer */\r
  18 \r
  19 void Main940(int startvector)\r
  20 {\r
  21         ym2612_940 = &shared_data->ym2612;\r
  22         mix_buffer = shared_data->mix_buffer;\r
  23 \r
  24         // debug\r
  25         shared_ctl->vstarts[startvector]++;\r
  26         // asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0");\r
  27 \r
  28 \r
  29         for (;;)\r
  30         {\r
  31                 int job_num = 0;\r
  32 /*\r
  33                 while (!shared_ctl->busy)\r
  34                 {\r
  35                         //shared_ctl->waitc++;\r
  36                         spend_cycles(8*1024);\r
  37                 }\r
  38 */\r
  39                 if (!shared_ctl->busy)\r
  40                 {\r
  41                         wait_irq();\r
  42                 }\r
  43 \r
  44                 for (job_num = 0; job_num < MAX_940JOBS; job_num++)\r
  45                 {\r
  46                         switch (shared_ctl->jobs[job_num])\r
  47                         {\r
  48                                 case JOB940_INITALL:\r
  49                                         /* ym2612 */\r
  50                                         shared_ctl->writebuff0[0] = shared_ctl->writebuff1[0] = 0xffff;\r
  51                                         YM2612Init_(shared_ctl->baseclock, shared_ctl->rate);\r
  52                                         /* Helix mp3 decoder */\r
  53                                         shared_data->mp3dec = MP3InitDecoder();\r
  54                                         break;\r
  55 \r
  56                                 case JOB940_YM2612RESETCHIP:\r
  57                                         YM2612ResetChip_();\r
  58                                         break;\r
  59 \r
  60                                 case JOB940_PICOSTATELOAD:\r
  61                                         YM2612PicoStateLoad_();\r
  62                                         break;\r
  63 \r
  64                                 case JOB940_YM2612UPDATEONE: {\r
  65                                         int i, dw, *wbuff;\r
  66                                         if (shared_ctl->writebuffsel == 1) {\r
  67                                                 wbuff = (int *) shared_ctl->writebuff1;\r
  68                                         } else {\r
  69                                                 wbuff = (int *) shared_ctl->writebuff0;\r
  70                                         }\r
  71 \r
  72                                         /* playback all writes */\r
  73                                         for (i = 2048/2; i > 0; i--) {\r
  74                                                 UINT16 d;\r
  75                                                 dw = *wbuff++;\r
  76                                                 d = dw;\r
  77                                                 if (d == 0xffff) break;\r
  78                                                 YM2612Write_(d >> 8, d);\r
  79                                                 d = (dw>>16);\r
  80                                                 if (d == 0xffff) break;\r
  81                                                 YM2612Write_(d >> 8, d);\r
  82                                         }\r
  83 \r
  84                                         YM2612UpdateOne_(0, shared_ctl->length, shared_ctl->stereo);\r
  85                                         break;\r
  86                                 }\r
  87 \r
  88                                 case JOB940_MP3DECODE: {\r
  89                                         int mp3_offs = shared_ctl->mp3_offs;\r
  90                                         unsigned char *readPtr = mp3_data + mp3_offs;\r
  91                                         int bytesLeft = shared_ctl->mp3_len - mp3_offs;\r
  92                                         int offset; // frame offset from readPtr\r
  93                                         int err;\r
  94 \r
  95                                         if (bytesLeft <= 0) break; // EOF, nothing to do\r
  96 \r
  97                                         offset = MP3FindSyncWord(readPtr, bytesLeft);\r
  98                                         if (offset < 0) {\r
  99                                                 shared_ctl->mp3_offs = shared_ctl->mp3_len;\r
 100                                                 break; // EOF\r
 101                                         }\r
 102                                         readPtr += offset;\r
 103                                         bytesLeft -= offset;\r
 104 \r
 105                                         err = MP3Decode(shared_data->mp3dec, &readPtr, &bytesLeft,\r
 106                                                 shared_data->mp3_buffer[shared_ctl->mp3_buffsel], 0);\r
 107                                         if (err) {\r
 108                                                 if (err == ERR_MP3_INDATA_UNDERFLOW) {\r
 109                                                         shared_ctl->mp3_offs = shared_ctl->mp3_len; // EOF\r
 110                                                         break;\r
 111                                                 } else if (err <= -6 && err >= -12) {\r
 112                                                         // ERR_MP3_INVALID_FRAMEHEADER, ERR_MP3_INVALID_*\r
 113                                                         // just try to skip the offending frame..\r
 114                                                         readPtr++;\r
 115                                                 }\r
 116                                                 shared_ctl->mp3_errors++;\r
 117                                                 shared_ctl->mp3_lasterr = err;\r
 118                                         }\r
 119                                         shared_ctl->mp3_offs = readPtr - mp3_data;\r
 120                                         break;\r
 121                                 }\r
 122                         }\r
 123                 }\r
 124 \r
 125                 cache_clean();\r
 126 //              asm volatile ("mov r0, #0" ::: "r0");\r
 127 //              asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer, should be done on nonbuffered write */\r
 128 //              cache_clean_flush();\r
 129 \r
 130                 shared_ctl->loopc++;\r
 131                 shared_ctl->busy = 0;\r
 132         }\r
 133 }\r
 134 \r