From 1ac4600e5bf3ff937d404622158111b576651829 Mon Sep 17 00:00:00 2001 From: Björn Stenberg Date: Fri, 24 May 2002 12:22:14 +0000 Subject: First version git-svn-id: svn://svn.rockbox.org/rockbox/trunk@695 a1c6a512-1295-4272-9138-f99709370657 --- firmware/mpeg.c | 494 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 494 insertions(+) create mode 100644 firmware/mpeg.c (limited to 'firmware/mpeg.c') diff --git a/firmware/mpeg.c b/firmware/mpeg.c new file mode 100644 index 0000000000..5bf4fe0fd8 --- /dev/null +++ b/firmware/mpeg.c @@ -0,0 +1,494 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id$ + * + * Copyright (C) 2002 by Linus Nielsen Feltzing + * + * All files in this archive are subject to the GNU General Public License. + * See the file COPYING in the source tree root for full license agreement. + * + * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY + * KIND, either express or implied. + * + ****************************************************************************/ +#include +#include "i2c.h" +#include "mas.h" +#include "dac.h" +#include "sh7034.h" +#include "system.h" +#include "debug.h" +#include "kernel.h" +#include "thread.h" +#include "panic.h" +#include "file.h" + +#define MPEG_STACK_SIZE 0x2000 +#define MPEG_BUFSIZE 0x100000 +#define MPEG_CHUNKSIZE 0x20000 +#define MPEG_LOW_WATER 0x30000 + +#define MPEG_PLAY 1 +#define MPEG_STOP 2 +#define MPEG_PAUSE 3 +#define MPEG_RESUME 4 +#define MPEG_NEED_DATA 100 + +static unsigned int bass_table[] = +{ + 0, + 0x800, /* 1dB */ + 0x10000, /* 2dB */ + 0x17c00, /* 3dB */ + 0x1f800, /* 4dB */ + 0x27000, /* 5dB */ + 0x2e400, /* 6dB */ + 0x35800, /* 7dB */ + 0x3c000, /* 8dB */ + 0x42800, /* 9dB */ + 0x48800, /* 10dB */ + 0x4e400, /* 11dB */ + 0x53800, /* 12dB */ + 0x58800, /* 13dB */ + 0x5d400, /* 14dB */ + 0x61800 /* 15dB */ +}; + +static unsigned int treble_table[] = +{ + 0, + 0x5400, /* 1dB */ + 0xac00, /* 2dB */ + 0x10400, /* 3dB */ + 0x16000, /* 4dB */ + 0x1c000, /* 5dB */ + 0x22400, /* 6dB */ + 0x28400, /* 7dB */ + 0x2ec00, /* 8dB */ + 0x35400, /* 9dB */ + 0x3c000, /* 10dB */ + 0x42c00, /* 11dB */ + 0x49c00, /* 12dB */ + 0x51800, /* 13dB */ + 0x58400, /* 14dB */ + 0x5f800 /* 15dB */ +}; + +static unsigned char fliptable[] = +{ + 0x00, 0x80, 0x40, 0xc0, 0x20, 0xa0, 0x60, 0xe0, + 0x10, 0x90, 0x50, 0xd0, 0x30, 0xb0, 0x70, 0xf0, + 0x08, 0x88, 0x48, 0xc8, 0x28, 0xa8, 0x68, 0xe8, + 0x18, 0x98, 0x58, 0xd8, 0x38, 0xb8, 0x78, 0xf8, + 0x04, 0x84, 0x44, 0xc4, 0x24, 0xa4, 0x64, 0xe4, + 0x14, 0x94, 0x54, 0xd4, 0x34, 0xb4, 0x74, 0xf4, + 0x0c, 0x8c, 0x4c, 0xcc, 0x2c, 0xac, 0x6c, 0xec, + 0x1c, 0x9c, 0x5c, 0xdc, 0x3c, 0xbc, 0x7c, 0xfc, + 0x02, 0x82, 0x42, 0xc2, 0x22, 0xa2, 0x62, 0xe2, + 0x12, 0x92, 0x52, 0xd2, 0x32, 0xb2, 0x72, 0xf2, + 0x0a, 0x8a, 0x4a, 0xca, 0x2a, 0xaa, 0x6a, 0xea, + 0x1a, 0x9a, 0x5a, 0xda, 0x3a, 0xba, 0x7a, 0xfa, + 0x06, 0x86, 0x46, 0xc6, 0x26, 0xa6, 0x66, 0xe6, + 0x16, 0x96, 0x56, 0xd6, 0x36, 0xb6, 0x76, 0xf6, + 0x0e, 0x8e, 0x4e, 0xce, 0x2e, 0xae, 0x6e, 0xee, + 0x1e, 0x9e, 0x5e, 0xde, 0x3e, 0xbe, 0x7e, 0xfe, + 0x01, 0x81, 0x41, 0xc1, 0x21, 0xa1, 0x61, 0xe1, + 0x11, 0x91, 0x51, 0xd1, 0x31, 0xb1, 0x71, 0xf1, + 0x09, 0x89, 0x49, 0xc9, 0x29, 0xa9, 0x69, 0xe9, + 0x19, 0x99, 0x59, 0xd9, 0x39, 0xb9, 0x79, 0xf9, + 0x05, 0x85, 0x45, 0xc5, 0x25, 0xa5, 0x65, 0xe5, + 0x15, 0x95, 0x55, 0xd5, 0x35, 0xb5, 0x75, 0xf5, + 0x0d, 0x8d, 0x4d, 0xcd, 0x2d, 0xad, 0x6d, 0xed, + 0x1d, 0x9d, 0x5d, 0xdd, 0x3d, 0xbd, 0x7d, 0xfd, + 0x03, 0x83, 0x43, 0xc3, 0x23, 0xa3, 0x63, 0xe3, + 0x13, 0x93, 0x53, 0xd3, 0x33, 0xb3, 0x73, 0xf3, + 0x0b, 0x8b, 0x4b, 0xcb, 0x2b, 0xab, 0x6b, 0xeb, + 0x1b, 0x9b, 0x5b, 0xdb, 0x3b, 0xbb, 0x7b, 0xfb, + 0x07, 0x87, 0x47, 0xc7, 0x27, 0xa7, 0x67, 0xe7, + 0x17, 0x97, 0x57, 0xd7, 0x37, 0xb7, 0x77, 0xf7, + 0x0f, 0x8f, 0x4f, 0xcf, 0x2f, 0xaf, 0x6f, 0xef, + 0x1f, 0x9f, 0x5f, 0xdf, 0x3f, 0xbf, 0x7f, 0xff +}; + +static struct event_queue mpeg_queue; +static int mpeg_stack[MPEG_STACK_SIZE/sizeof(int)]; + +static unsigned char mp3buf[ MPEG_BUFSIZE ]; +static int mp3buf_write; +static int mp3buf_read; + +static int last_dma_chunk_size; + +static bool dma_on; /* The DMA is active */ +static bool playing; /* We are playing an MP3 stream */ +static bool filling; /* We are filling the buffer with data from disk */ + +static int mpeg_file = -1; + +static void mas_poll_start(int interval_in_ms) +{ + unsigned int count; + + count = FREQ / 1000 / 8 * interval_in_ms; + + if(count > 0xffff) + { + panicf("Error! The MAS poll interval is too long (%d ms)\n", + interval_in_ms); + return; + } + + /* We are using timer 1 */ + + TSTR &= ~0x02; /* Stop the timer */ + TSNC &= ~0x02; /* No synchronization */ + TMDR &= ~0x02; /* Operate normally */ + + TCNT1 = 0; /* Start counting at 0 */ + GRA1 = count; + TCR1 = 0x23; /* Clear at GRA match, sysclock/8 */ + + /* Enable interrupt on level 2 */ + IPRC = (IPRC & ~0x000f) | 0x0002; + + TSR1 &= ~0x02; + TIER1 = 0xf9; /* Enable GRA match interrupt */ + + TSTR |= 0x02; /* Start timer 2 */ +} + +static void init_dma(void) +{ + SAR3 = (unsigned int) mp3buf + mp3buf_read; + DAR3 = 0x5FFFEC3; + CHCR3 &= ~0x0002; /* Clear interrupt */ + CHCR3 = 0x1504; /* Single address destination, TXI0, IE=1 */ + last_dma_chunk_size = MIN(65536, mp3buf_write - mp3buf_read); + DTCR3 = last_dma_chunk_size & 0xffff; + DMAOR = 0x0001; /* Enable DMA */ + CHCR3 |= 0x0001; /* Enable DMA IRQ */ +} + +static void start_dma(void) +{ + SCR0 |= 0x80; + dma_on = true; +} + +static void stop_dma(void) +{ + SCR0 &= 0x7f; + dma_on = false; +} + +static void dma_tick(void) +{ + /* Start DMA if it isn't running */ + if(playing && !dma_on) + { + if(PBDR & 0x4000) + { + if(!(SCR0 & 0x80)) + start_dma(); + } + } +} + +static void bitswap(unsigned char *data, int length) +{ + int i; + for(i = 0;i < length;i++) + { + data[i] = fliptable[data[i]]; + } +} + +static void reset_mp3_buffer(void) +{ + mp3buf_read = 0; + mp3buf_write = 0; +} + +#pragma interrupt +void IMIA1(void) +{ + dma_tick(); + TSR1 &= ~0x01; +} + +static void mpeg_thread(void) +{ + struct event ev; + int len; + int free_space_left; + int amount_to_read; + bool play_pending; + + play_pending = false; + playing = false; + + while(1) + { + DEBUGF("S\n"); + queue_wait(&mpeg_queue, &ev); + switch(ev.id) + { + case MPEG_PLAY: + /* Stop the current stream */ + play_pending = false; + playing = false; + stop_dma(); + + reset_mp3_buffer(); + + mpeg_file = open((char*)ev.data, O_RDONLY); + if(mpeg_file < 0) + { + DEBUGF("Couldn't open %s\n",ev.data); + break; + } + + /* Make it read more data */ + filling = true; + queue_post(&mpeg_queue, MPEG_NEED_DATA, 0); + + /* Tell the file loading code that we want to start playing + as soon as we have some data */ + play_pending = true; + break; + + case MPEG_STOP: + /* Stop the current stream */ + playing = false; + stop_dma(); + break; + + case MPEG_PAUSE: + /* Stop the current stream */ + playing = false; + stop_dma(); + break; + + case MPEG_RESUME: + /* Stop the current stream */ + playing = true; + start_dma(); + break; + + case MPEG_NEED_DATA: + free_space_left = mp3buf_read - mp3buf_write; + + /* We interpret 0 as "empty buffer" */ + if(free_space_left <= 0) + free_space_left = MPEG_BUFSIZE + free_space_left; + + if(free_space_left <= MPEG_CHUNKSIZE) + { + DEBUGF("0\n"); + filling = false; + break;; + } + + amount_to_read = MIN(MPEG_CHUNKSIZE, free_space_left); + amount_to_read = MIN(MPEG_BUFSIZE - mp3buf_write, amount_to_read); + + /* Read in a few seconds worth of MP3 data. We don't want to + read too large chunks because the bitswapping will take + too much time. We must keep the DMA happy and also give + the other threads a chance to run. */ + DEBUGF("R\n"); + len = read(mpeg_file, mp3buf+mp3buf_write, amount_to_read); + if(len) + { + DEBUGF("B\n"); + bitswap(mp3buf + mp3buf_write, len); + + mp3buf_write += len; + if(mp3buf_write >= MPEG_BUFSIZE) + { + mp3buf_write = 0; + DEBUGF("W\n"); + } + + /* Tell ourselves that we want more data */ + queue_post(&mpeg_queue, MPEG_NEED_DATA, 0); + + /* And while we're at it, see if we have startet playing + yet. If not, do it. */ + if(play_pending) + { + play_pending = false; + playing = true; + + init_dma(); + start_dma(); + } + } + else + { + close(mpeg_file); + + /* Make sure that the write pointer is at a word + boundary */ + mp3buf_write &= 0xfffffffe; + +#if 1 + /* No more data to play */ + DEBUGF("Finished playing\n"); + playing = false; + filling = false; +#else + next_track(); + if(new_file() < 0) + { + /* No more data to play */ + DEBUGF("Finished playing\n"); + playing = false; + filling = false; + } + else + { + /* Tell ourselves that we want more data */ + queue_post(&mpeg_queue, MPEG_NEED_DATA, 0); + } +#endif + } + break; + } + } +} + +static void setup_sci0(void) +{ + /* PB15 is I/O, PB14 is IRQ6, PB12 is SCK0 */ + PBCR1 = (PBCR1 & 0x0cff) | 0x1200; + + /* Set PB12 to output */ + PBIOR |= 0x1000; + + /* Disable serial port */ + SCR0 = 0x00; + + /* Synchronous, no prescale */ + SMR0 = 0x80; + + /* Set baudrate 1Mbit/s */ + BRR0 = 0x03; + + /* use SCK as serial clock output */ + SCR0 = 0x01; + + /* Clear FER and PER */ + SSR0 &= 0xe7; + + /* Set interrupt ITU2 and SCI0 priority to 0 */ + IPRD &= 0x0ff0; + + /* set IRQ6 and IRQ7 to edge detect */ + ICR |= 0x03; + + /* set PB15 and PB14 to inputs */ + PBIOR &= 0x7fff; + PBIOR &= 0xbfff; + + /* set IRQ6 prio 8 and IRQ7 prio 0 */ + IPRB = ( IPRB & 0xff00 ) | 0x0080; + + /* Enable End of DMA interrupt at prio 8 */ + IPRC = (IPRC & 0xf0ff) | 0x0800; + + /* Enable Tx (only!) */ + SCR0 |= 0x20; +} + +void mpeg_init(void) +{ + int rc; + + setup_sci0(); + +#ifdef DEBUG + { + unsigned char buf[32]; + unsigned char str[32]; + int i; + + rc = mas_readmem(MAS_BANK_D1,0xff6,(unsigned long*)buf,2); + if (rc) + panicf("Error - mas_readmem(0xff6) returned %d\n", rc); + + i = buf[0] | buf[1] << 8; + DEBUGF("MAS version: %x\n", i); + i = buf[4] | buf[5] << 8; + DEBUGF("MAS revision: %x\n", i); + + rc = mas_readmem(MAS_BANK_D1,0xff9,(unsigned long*)buf,7); + if (rc) + panicf("Error - mas_readmem(0xff9) returned %d\n", rc); + + for (i = 0;i < 7;i++) { + str[i*2+1] = buf[i*4]; + str[i*2] = buf[i*4+1]; + } + str[i*2] = 0; + DEBUGF("Description: %s\n", str); + } +#endif + + rc = mas_writereg(0x3b, 0x20); + if (rc < 0) + panicf("Error - mas_writereg(0x3b) returned %d\n", rc); + + rc = mas_run(1); + if (rc < 0) + panicf("Error - mas_run(1) returned %d\n", rc); + + queue_init(&mpeg_queue); + create_thread(mpeg_thread, mpeg_stack, sizeof(mpeg_stack)); + mas_poll_start(2); + + mas_writereg(MAS_REG_KPRESCALE, 0xe9400); +} + +void mpeg_play(char* trackname) +{ + queue_post(&mpeg_queue, MPEG_PLAY, trackname); +} + +void mpeg_stop(void) +{ + queue_post(&mpeg_queue, MPEG_STOP, NULL); +} + +void mpeg_pause(void) +{ + queue_post(&mpeg_queue, MPEG_PAUSE, NULL); +} + +void mpeg_resume(void) +{ + queue_post(&mpeg_queue, MPEG_RESUME, NULL); +} + +void mpeg_volume(int percent) +{ + int volume = 0x2c * percent / 100; + dac_volume(volume); +} + +void mpeg_bass(int percent) +{ + int bass = 15 * percent / 100; + mas_writereg(MAS_REG_KBASS, bass_table[bass]); +} + +void mpeg_treble(int percent) +{ + int treble = 15 * percent / 100; + mas_writereg(MAS_REG_KTREBLE, treble_table[treble]); +} -- cgit v1.2.3