123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499 |
- /*
- * Code for communication with ARM940 and control of it.
- * (C) notaz, 2006-2009
- *
- * This work is licensed under the terms of MAME license.
- * See COPYING file in the top-level directory.
- */
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <unistd.h>
- #include <sys/mman.h>
- #include <sys/ioctl.h>
- #include <fcntl.h>
- #include <errno.h>
- #include "../libpicofe/input.h"
- #include "../libpicofe/gp2x/soc_mmsp2.h"
- #include "../libpicofe/gp2x/soc.h"
- #include "../common/mp3.h"
- #include "../common/arm_utils.h"
- #include "../common/menu_pico.h"
- #include "../common/emu.h"
- #include <pico/pico_int.h>
- #include <pico/sound/ym2612.h>
- #include <pico/sound/mix.h>
- #include "code940/940shared.h"
- #include "plat.h"
- #include "940ctl.h"
- static unsigned char *shared_mem = 0;
- static _940_data_t *shared_data = 0;
- _940_ctl_t *shared_ctl = 0;
- unsigned char *mp3_mem = 0;
- #define MP3_SIZE_MAX (0x400000 + 0x800000) // 12M
- #define CODE940_FILE "pico940_v3.bin"
- int crashed_940 = 0;
- static FILE *loaded_mp3 = 0;
- /***********************************************************/
- #define MAXOUT (+32767)
- #define MINOUT (-32768)
- /* limitter */
- #define Limit(val, max,min) { \
- if ( val > max ) val = max; \
- else if ( val < min ) val = min; \
- }
- /* these will be managed locally on our side */
- static UINT8 ST_address; /* address register */
- static INT32 addr_A1; /* address line A1 */
- static int writebuff_ptr = 0;
- /* YM2612 write */
- /* a = address */
- /* v = value */
- /* returns 1 if sample affecting state changed */
- int YM2612Write_940(unsigned int a, unsigned int v, int scanline)
- {
- int upd = 1; /* the write affects sample generation */
- a &= 3;
- //printf("%05i:%03i: ym w ([%i] %02x)\n", Pico.m.frame_count, Pico.m.scanline, a, v);
- switch (a)
- {
- case 0: /* address port 0 */
- if (addr_A1 == 0 && ST_address == v)
- return 0; /* address already selected, don't send this command to 940 */
- ST_address = v;
- addr_A1 = 0;
- /* don't send DAC or timer related address changes to 940 */
- if (v == 0x24 || v == 0x25 || v == 0x26 || v == 0x2a)
- return 0;
- upd = 0;
- break;
- case 2: /* address port 1 */
- if (addr_A1 == 1 && ST_address == v)
- return 0;
- ST_address = v;
- addr_A1 = 1;
- upd = 0;
- break;
- }
- //printf("ym pass\n");
- if (currentConfig.EmuOpt & 4)
- {
- UINT16 *writebuff = shared_ctl->writebuffsel ? shared_ctl->writebuff0 : shared_ctl->writebuff1;
- /* detect rapid ym updates */
- if (upd && !(writebuff_ptr & 0x80000000))
- {
- int mid = (Pico.m.pal ? 313 : 262) / 2;
- if (scanline >= mid) {
- //printf("%05i:%03i: rapid ym\n", Pico.m.frame_count, scanline);
- writebuff[writebuff_ptr++ & 0xffff] = 0xfffe;
- writebuff_ptr |= 0x80000000;
- //printf("%05i:%03i: ym w ([%02x] %02x, upd=%i)\n", Pico.m.frame_count, scanline, addr, v, upd);
- }
- }
- /* queue this write for 940 */
- if ((writebuff_ptr&0xffff) < 2047) {
- writebuff[writebuff_ptr++ & 0xffff] = (a<<8)|v;
- } else {
- printf("warning: writebuff_ptr > 2047 ([%i] %02x)\n", a, v);
- }
- }
- return 0; // cause the engine to do updates once per frame only
- }
- #define CHECK_BUSY(job) \
- (memregs[0x3b46>>1] & (1<<(job-1)))
- static void wait_busy_940(int job)
- {
- int i;
- job--;
- for (i = 0; (memregs[0x3b46>>1] & (1<<job)) && i < 0x10000; i++)
- spend_cycles(8*1024); // tested to be best for mp3 dec
- if (i < 0x10000) return;
- /* 940 crashed */
- printf("940 crashed (cnt: %i, ve: ", shared_ctl->loopc);
- for (i = 0; i < 8; i++)
- printf("%i ", shared_ctl->vstarts[i]);
- printf(")\n");
- printf("irq pending flags: DUALCPU %04x, SRCPND %08x (see 26), INTPND %08x\n",
- memregs[0x3b46>>1], memregl[0x4500>>2], memregl[0x4510>>2]);
- printf("last lr: %08x, lastjob: %i\n", shared_ctl->last_lr, shared_ctl->lastjob);
- printf("trying to interrupt..\n");
- memregs[0x3B3E>>1] = 0xffff;
- for (i = 0; memregs[0x3b46>>1] && i < 0x10000; i++)
- spend_cycles(8*1024);
- printf("i = 0x%x\n", i);
- printf("irq pending flags: DUALCPU %04x, SRCPND %08x (see 26), INTPND %08x\n",
- memregs[0x3b46>>1], memregl[0x4500>>2], memregl[0x4510>>2]);
- printf("last lr: %08x, lastjob: %i\n", shared_ctl->last_lr, shared_ctl->lastjob);
- menu_update_msg("940 crashed, too much overclock?");
- engineState = PGS_Menu;
- crashed_940 = 1;
- }
- static void add_job_940(int job)
- {
- if (job <= 0 || job > 16) {
- printf("add_job_940: bad job: %i\n", job);
- return;
- }
- // generate interrupt for this job
- job--;
- memregs[(0x3B20+job*2)>>1] = 1;
- // printf("added %i, pending %04x\n", job+1, memregs[0x3b46>>1]);
- }
- void YM2612PicoStateLoad_940(void)
- {
- UINT8 *REGS = YM2612GetRegs();
- /* make sure JOB940_PICOSTATELOAD gets done before next JOB940_YM2612UPDATEONE */
- add_job_940(JOB940_PICOSTATELOAD);
- if (CHECK_BUSY(JOB940_PICOSTATELOAD)) wait_busy_940(JOB940_PICOSTATELOAD);
- writebuff_ptr = 0;
- addr_A1 = *(INT32 *) (REGS + 0x200);
- }
- void YM2612PicoStateSave2_940(int tat, int tbt)
- {
- UINT8 *ym_remote_regs, *ym_local_regs;
- add_job_940(JOB940_PICOSTATESAVE2);
- if (CHECK_BUSY(JOB940_PICOSTATESAVE2)) wait_busy_940(JOB940_PICOSTATESAVE2);
- ym_remote_regs = (UINT8 *) shared_ctl->writebuff0;
- ym_local_regs = YM2612GetRegs();
- if (*(UINT32 *)(ym_remote_regs + 0x100) != 0x41534d59) {
- printf("code940 didn't return valid save data\n");
- return;
- }
- /* copy addin data only */
- memcpy(ym_local_regs, ym_remote_regs, 0x20);
- memcpy(ym_local_regs + 0x100, ym_remote_regs + 0x100, 0x30);
- memcpy(ym_local_regs + 0x0b8, ym_remote_regs + 0x0b8, 0x48);
- memcpy(ym_local_regs + 0x1b8, ym_remote_regs + 0x1b8, 0x48);
- *(INT32 *)(ym_local_regs + 0x108) = tat;
- *(INT32 *)(ym_local_regs + 0x10c) = tbt;
- }
- int YM2612PicoStateLoad2_940(int *tat, int *tbt)
- {
- UINT8 *ym_remote_regs, *ym_local_regs;
- ym_local_regs = YM2612GetRegs();
- ym_remote_regs = (UINT8 *) shared_ctl->writebuff0;
- if (*(UINT32 *)(ym_local_regs + 0x100) != 0x41534d59)
- return -1;
- *tat = *(INT32 *)(ym_local_regs + 0x108);
- *tbt = *(INT32 *)(ym_local_regs + 0x10c);
- if (CHECK_BUSY(JOB940_YM2612UPDATEONE)) wait_busy_940(JOB940_YM2612UPDATEONE);
- /* flush writes */
- if (shared_ctl->writebuffsel == 1) {
- shared_ctl->writebuff0[writebuff_ptr & 0xffff] = 0xffff;
- } else {
- shared_ctl->writebuff1[writebuff_ptr & 0xffff] = 0xffff;
- }
- shared_ctl->writebuffsel ^= 1;
- writebuff_ptr = 0;
- add_job_940(JOB940_PICOSTATELOAD2_PREP);
- if (CHECK_BUSY(JOB940_PICOSTATELOAD2_PREP)) wait_busy_940(JOB940_PICOSTATELOAD2_PREP);
- memcpy(ym_remote_regs, ym_local_regs, 0x200);
- add_job_940(JOB940_PICOSTATELOAD2);
- if (CHECK_BUSY(JOB940_PICOSTATELOAD2)) wait_busy_940(JOB940_PICOSTATELOAD2);
- return 0;
- }
- static void internal_reset(void)
- {
- writebuff_ptr = 0;
- ST_address = addr_A1 = -1;
- }
- /* this must be called after mmu hack, the allocated regions must not get cached */
- void sharedmem940_init(void)
- {
- if (shared_mem != NULL) return;
- shared_mem = (unsigned char *) mmap(0, 0x210000, PROT_READ|PROT_WRITE, MAP_SHARED, memdev, 0x2000000);
- if (shared_mem == MAP_FAILED)
- {
- printf("mmap(shared_data) failed with %i\n", errno);
- exit(1);
- }
- shared_data = (_940_data_t *) (shared_mem+0x100000);
- /* this area must not get buffered on either side */
- shared_ctl = (_940_ctl_t *) (shared_mem+0x200000);
- mp3_mem = (unsigned char *) mmap(0, MP3_SIZE_MAX, PROT_READ|PROT_WRITE, MAP_SHARED, memdev, 0x2400000);
- if (mp3_mem == MAP_FAILED)
- {
- printf("mmap(mp3_mem) failed with %i\n", errno);
- exit(1);
- }
- crashed_940 = 1;
- }
- void sharedmem940_finish(void)
- {
- munmap(shared_mem, 0x210000);
- munmap(mp3_mem, MP3_SIZE_MAX);
- shared_mem = mp3_mem = NULL;
- shared_data = NULL;
- shared_ctl = NULL;
- }
- void YM2612Init_940(int baseclock, int rate, int ssg)
- {
- static int oldrate;
- // HACK
- if (Pico.m.frame_count > 0 && !crashed_940 && rate == oldrate)
- return;
- printf("YM2612Init_940()\n");
- printf("Mem usage: shared_data: %i, shared_ctl: %i\n", sizeof(*shared_data), sizeof(*shared_ctl));
- reset940(1, 2);
- pause940(1);
- memregs[0x3B40>>1] = 0; // disable DUALCPU interrupts for 920
- memregs[0x3B42>>1] = 1; // enable DUALCPU interrupts for 940
- memregl[0x4504>>2] = 0; // make sure no FIQs will be generated
- memregl[0x4508>>2] = ~(1<<26); // unmask DUALCPU ints in the undocumented 940's interrupt controller
- if (crashed_940)
- {
- unsigned char ucData[1024];
- int nRead, nLen = 0;
- char binpath[512];
- FILE *fp;
- emu_make_path(binpath, CODE940_FILE, sizeof(binpath));
- fp = fopen(binpath, "rb");
- if(!fp)
- {
- memset(g_screen_ptr, 0, 320*240*2);
- text_out16(10, 100, "failed to open required file:");
- text_out16(10, 110, CODE940_FILE);
- gp2x_video_flip2();
- in_menu_wait(PBTN_MOK|PBTN_MBACK, NULL, 100);
- printf("failed to open %s\n", binpath);
- exit(1);
- }
- while(1)
- {
- nRead = fread(ucData, 1, 1024, fp);
- if(nRead <= 0)
- break;
- memcpy(shared_mem + nLen, ucData, nRead);
- nLen += nRead;
- }
- fclose(fp);
- crashed_940 = 0;
- }
- memset(shared_data, 0, sizeof(*shared_data));
- memset(shared_ctl, 0, sizeof(*shared_ctl));
- /* cause local ym2612 to init REGS */
- YM2612Init_(baseclock, rate, ssg);
- internal_reset();
- loaded_mp3 = NULL;
- memregs[0x3B46>>1] = 0xffff; // clear pending DUALCPU interrupts for 940
- memregl[0x4500>>2] = 0xffffffff; // clear pending IRQs in SRCPND
- memregl[0x4510>>2] = 0xffffffff; // clear pending IRQs in INTPND
- /* start the 940 */
- reset940(0, 2);
- pause940(0);
- // YM2612ResetChip_940(); // will be done on JOB940_YM2612INIT
- /* now cause 940 to init it's ym2612 stuff */
- shared_ctl->baseclock = baseclock;
- shared_ctl->rate = rate;
- add_job_940(JOB940_INITALL);
- oldrate = rate;
- }
- void YM2612ResetChip_940(void)
- {
- //printf("YM2612ResetChip_940()\n");
- if (shared_data == NULL) {
- printf("YM2612ResetChip_940: reset before init?\n");
- return;
- }
- YM2612ResetChip_();
- internal_reset();
- add_job_940(JOB940_YM2612RESETCHIP);
- }
- int YM2612UpdateOne_940(int *buffer, int length, int stereo, int is_buf_empty)
- {
- int *ym_buf = shared_data->ym_buffer;
- int ym_active_chs;
- //printf("YM2612UpdateOne_940()\n");
- if (CHECK_BUSY(JOB940_YM2612UPDATEONE)) wait_busy_940(JOB940_YM2612UPDATEONE);
- ym_active_chs = shared_ctl->ym_active_chs;
- // mix in ym buffer. is_buf_empty means nobody mixed there anything yet and it may contain trash
- if (is_buf_empty && ym_active_chs) memcpy(buffer, ym_buf, length << (stereo + 2));
- else memset32(buffer, 0, length<<stereo);
- if (shared_ctl->writebuffsel == 1) {
- shared_ctl->writebuff0[writebuff_ptr & 0xffff] = 0xffff;
- } else {
- shared_ctl->writebuff1[writebuff_ptr & 0xffff] = 0xffff;
- }
- writebuff_ptr = 0;
- /* predict sample counter for next frame */
- if (Pico.snd.len_e_add) {
- length = Pico.snd.len;
- if (Pico.snd.len_e_cnt + Pico.snd.len_e_add >= 0x10000) length++;
- }
- /* give 940 ym job */
- shared_ctl->writebuffsel ^= 1;
- shared_ctl->length = length;
- shared_ctl->stereo = stereo;
- add_job_940(JOB940_YM2612UPDATEONE);
- return ym_active_chs;
- }
- /***********************************************************/
- // FIXME: double buffering no longer used..
- int mp3dec_decode(FILE *f, int *file_pos, int file_len)
- {
- if (!(PicoIn.opt & POPT_EXT_FM)) {
- return _mp3dec_decode(f, file_pos, file_len);
- }
- // check if playback was started, track not ended
- if (loaded_mp3 == NULL || shared_ctl->mp3_offs >= shared_ctl->mp3_len) {
- *file_pos = file_len;
- return 1;
- }
- /* do we have to wait? */
- if (CHECK_BUSY(JOB940_MP3DECODE))
- wait_busy_940(JOB940_MP3DECODE);
- memcpy(cdda_out_buffer,
- shared_data->mp3_buffer[shared_ctl->mp3_buffsel],
- sizeof(cdda_out_buffer));
- *file_pos = shared_ctl->mp3_offs;
- if (shared_ctl->mp3_offs < shared_ctl->mp3_len) {
- // ask to decode more
- //shared_ctl->mp3_buffsel ^= 1;
- add_job_940(JOB940_MP3DECODE);
- }
- return 0;
- }
- int mp3dec_start(FILE *f, int fpos_start)
- {
- if (!(PicoIn.opt & POPT_EXT_FM)) {
- return _mp3dec_start(f, fpos_start);
- }
- if (loaded_mp3 != f)
- {
- if (PicoIn.osdMessage != NULL)
- {
- fseek(f, 0, SEEK_END);
- if (ftell(f) > 2*1024*1024)
- PicoIn.osdMessage("Loading MP3...");
- }
- fseek(f, 0, SEEK_SET);
- fread(mp3_mem, 1, MP3_SIZE_MAX, f);
- if (!feof(f))
- printf("Warning: mp3 was too large, not all data loaded.\n");
- shared_ctl->mp3_len = ftell(f);
- loaded_mp3 = f;
- // as we are going to change 940's cacheable area,
- // we must invalidate it's cache..
- if (CHECK_BUSY(JOB940_MP3DECODE))
- wait_busy_940(JOB940_MP3DECODE);
- add_job_940(JOB940_INVALIDATE_DCACHE);
- reset_timing = 1;
- }
- shared_ctl->mp3_offs = fpos_start;
- shared_ctl->mp3_buffsel = 0;
- add_job_940(JOB940_MP3RESET);
- if (CHECK_BUSY(JOB940_MP3RESET))
- wait_busy_940(JOB940_MP3RESET);
- // because we decode ahea, need to start now
- if (shared_ctl->mp3_offs < shared_ctl->mp3_len) {
- add_job_940(JOB940_MP3DECODE);
- }
- return 0;
- }
|