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 \r
   8 // from init.s\r
   9 int  wait_get_job(int oldjob);\r
  10 void spend_cycles(int c);\r
  11 void dcache_clean(void);\r
  12 void dcache_clean_flush(void);\r
  13 void drain_wb(void);\r
  14 // this should help to resolve race confition where shared var\r
  15 // is changed by other core just before we update it\r
  16 void set_if_not_changed(int *val, int oldval, int newval);\r
  17 \r
  18 //      asm volatile ("mov r0, #0" ::: "r0");\r
  19 //      asm volatile ("mcr p15, 0, r0, c7, c6,  0" ::: "r0"); /* flush dcache */\r
  20 //      asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer */\r
  21 \r
  22 \r
  23 static void mp3_decode(void)\r
  24 {\r
  25         int mp3_offs = shared_ctl->mp3_offs;\r
  26         unsigned char *readPtr = mp3_data + mp3_offs;\r
  27         int bytesLeft = shared_ctl->mp3_len - mp3_offs;\r
  28         int offset; // frame offset from readPtr\r
  29         int err;\r
  30 \r
  31         if (bytesLeft <= 0) return; // EOF, nothing to do\r
  32 \r
  33         offset = MP3FindSyncWord(readPtr, bytesLeft);\r
  34         if (offset < 0) {\r
  35                 set_if_not_changed(&shared_ctl->mp3_offs, mp3_offs, shared_ctl->mp3_len);\r
  36                 return; // EOF\r
  37         }\r
  38         readPtr += offset;\r
  39         bytesLeft -= offset;\r
  40 \r
  41         err = MP3Decode(shared_data->mp3dec, &readPtr, &bytesLeft,\r
  42                         shared_data->mp3_buffer[shared_ctl->mp3_buffsel], 0);\r
  43         if (err) {\r
  44                 if (err == ERR_MP3_INDATA_UNDERFLOW) {\r
  45                         set_if_not_changed(&shared_ctl->mp3_offs, mp3_offs, shared_ctl->mp3_len);\r
  46                         return;\r
  47                 } else if (err <= -6 && err >= -12) {\r
  48                         // ERR_MP3_INVALID_FRAMEHEADER, ERR_MP3_INVALID_*\r
  49                         // just try to skip the offending frame..\r
  50                         readPtr++;\r
  51                 }\r
  52                 shared_ctl->mp3_errors++;\r
  53                 shared_ctl->mp3_lasterr = err;\r
  54         }\r
  55         set_if_not_changed(&shared_ctl->mp3_offs, mp3_offs, readPtr - mp3_data);\r
  56 }\r
  57 \r
  58 \r
  59 void Main940(void)\r
  60 {\r
  61         int *ym_buffer = shared_data->ym_buffer;\r
  62         int job = 0;\r
  63         ym2612_940 = &shared_data->ym2612;\r
  64 \r
  65 \r
  66         for (;;)\r
  67         {\r
  68                 job = wait_get_job(job);\r
  69 \r
  70                 shared_ctl->lastjob = job;\r
  71 \r
  72                 switch (job)\r
  73                 {\r
  74                         case JOB940_INITALL:\r
  75                                 /* ym2612 */\r
  76                                 shared_ctl->writebuff0[0] = shared_ctl->writebuff1[0] = 0xffff;\r
  77                                 YM2612Init_(shared_ctl->baseclock, shared_ctl->rate);\r
  78                                 /* Helix mp3 decoder */\r
  79                                 shared_data->mp3dec = MP3InitDecoder();\r
  80                                 break;\r
  81 \r
  82                         case JOB940_INVALIDATE_DCACHE:\r
  83                                 drain_wb();\r
  84                                 dcache_clean_flush();\r
  85                                 break;\r
  86 \r
  87                         case JOB940_YM2612RESETCHIP:\r
  88                                 YM2612ResetChip_();\r
  89                                 break;\r
  90 \r
  91                         case JOB940_PICOSTATELOAD:\r
  92                                 YM2612PicoStateLoad_();\r
  93                                 break;\r
  94 \r
  95                         case JOB940_YM2612UPDATEONE: {\r
  96                                 int i, dw, *wbuff;\r
  97                                 if (shared_ctl->writebuffsel == 1) {\r
  98                                         wbuff = (int *) shared_ctl->writebuff1;\r
  99                                 } else {\r
 100                                         wbuff = (int *) shared_ctl->writebuff0;\r
 101                                 }\r
 102 \r
 103                                 /* playback all writes */\r
 104                                 for (i = 2048/2; i > 0; i--) {\r
 105                                         UINT16 d;\r
 106                                         dw = *wbuff++;\r
 107                                         d = dw;\r
 108                                         if (d == 0xffff) break;\r
 109                                         YM2612Write_(d >> 8, d);\r
 110                                         d = (dw>>16);\r
 111                                         if (d == 0xffff) break;\r
 112                                         YM2612Write_(d >> 8, d);\r
 113                                 }\r
 114 \r
 115                                 shared_ctl->ym_active_chs =\r
 116                                         YM2612UpdateOne_(ym_buffer, shared_ctl->length, shared_ctl->stereo, 1);\r
 117                                 break;\r
 118                         }\r
 119 \r
 120                         case JOB940_MP3DECODE:\r
 121                                 mp3_decode();\r
 122                                 break;\r
 123                 }\r
 124 \r
 125                 shared_ctl->loopc++;\r
 126                 dcache_clean();\r
 127         }\r
 128 }\r
 129 \r