platform/gp2x/940.c

   1 #include "940shared.h"\r
   2 \r
   3 static _940_data_t *shared_data = (_940_data_t *) 0x100000;\r
   4 static _940_ctl_t  *shared_ctl  = (_940_ctl_t *)  0x200000;\r
   5 YM2612 *ym2612_940;\r
   6 int *mix_buffer;\r
   7 \r
   8 // from init.s\r
   9 void wait_irq(void);\r
  10 void spend_cycles(int c);\r
  11 void cache_clean(void);\r
  12 void cache_clean_flush(void);\r
  13 \r
  14 //      asm volatile ("mov r0, #0" ::: "r0");\r
  15 //      asm volatile ("mcr p15, 0, r0, c7, c6,  0" ::: "r0"); /* flush dcache */\r
  16 //      asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer */\r
  17 \r
  18 void Main940(int startvector)\r
  19 {\r
  20         ym2612_940 = &shared_data->ym2612;\r
  21         mix_buffer = shared_data->mix_buffer;\r
  22 \r
  23         // debug\r
  24         shared_ctl->vstarts[startvector]++;\r
  25         asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0");\r
  26 \r
  27 \r
  28         for (;; shared_ctl->loopc++)\r
  29         {\r
  30                 int job_num;\r
  31 /*\r
  32                 while (!shared_ctl->busy)\r
  33                 {\r
  34                         //shared_ctl->waitc++;\r
  35                         spend_cycles(256);\r
  36                 }\r
  37 */\r
  38                 if (!shared_ctl->busy)\r
  39                 {\r
  40                         wait_irq();\r
  41                 }\r
  42 \r
  43                 for (job_num = 0; job_num < MAX_940JOBS; job_num++)\r
  44                 {\r
  45                         switch (shared_ctl->jobs[job_num])\r
  46                         {\r
  47                                 case JOB940_YM2612INIT:\r
  48                                         shared_ctl->writebuff0[0] = shared_ctl->writebuff1[0] = 0xffff;\r
  49                                         YM2612Init_(shared_ctl->baseclock, shared_ctl->rate);\r
  50                                         break;\r
  51 \r
  52                                 case JOB940_YM2612RESETCHIP:\r
  53                                         YM2612ResetChip_();\r
  54                                         break;\r
  55 \r
  56                                 case JOB940_PICOSTATELOAD:\r
  57                                         YM2612PicoStateLoad_();\r
  58                                         break;\r
  59 \r
  60                                 case JOB940_YM2612UPDATEONE: {\r
  61                                         int i, dw, *wbuff;\r
  62                                         if (shared_ctl->writebuffsel == 1) {\r
  63                                                 wbuff = (int *) shared_ctl->writebuff1;\r
  64                                         } else {\r
  65                                                 wbuff = (int *) shared_ctl->writebuff0;\r
  66                                         }\r
  67 \r
  68                                         /* playback all writes */\r
  69                                         for (i = 2048/2; i > 0; i--) {\r
  70                                                 UINT16 d;\r
  71                                                 dw = *wbuff++;\r
  72                                                 d = dw;\r
  73                                                 if (d == 0xffff) break;\r
  74                                                 YM2612Write_(d >> 8, d);\r
  75                                                 d = (dw>>16);\r
  76                                                 if (d == 0xffff) break;\r
  77                                                 YM2612Write_(d >> 8, d);\r
  78                                         }\r
  79 \r
  80                                         YM2612UpdateOne_(0, shared_ctl->length, shared_ctl->stereo);\r
  81                                         break;\r
  82                                 }\r
  83                         }\r
  84                 }\r
  85 \r
  86                 shared_ctl->busy = 0;\r
  87 //              cache_clean_flush();\r
  88                 cache_clean();\r
  89 //              asm volatile ("mov r0, #0" ::: "r0");\r
  90 //              asm volatile ("mcr p15, 0, r0, c7, c10, 4" ::: "r0"); /* drain write buffer, should be done on nonbuffered write */\r
  91         }\r
  92 }\r
  93 \r