/*************************************************************************** * __________ __ ___. * Open \______ \ ____ ____ | | _\_ |__ _______ ___ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ * \/ \/ \/ \/ \/ * $Id$ * * Copyright (C) 2007 Dave Chapman * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY * KIND, either express or implied. * ****************************************************************************/ #include "plugin.h" PLUGIN_HEADER /* All swcodec targets have BUTTON_SELECT apart from the H10 and M3 */ #if CONFIG_KEYPAD == IRIVER_H10_PAD #define TESTCODEC_EXITBUTTON BUTTON_RIGHT #elif CONFIG_KEYPAD == IAUDIO_M3_PAD #define TESTCODEC_EXITBUTTON BUTTON_RC_PLAY #elif CONFIG_KEYPAD == SAMSUNG_YH_PAD #define TESTCODEC_EXITBUTTON BUTTON_PLAY #elif CONFIG_KEYPAD == COWOND2_PAD || CONFIG_KEYPAD == ONDAVX747_PAD #define TESTCODEC_EXITBUTTON BUTTON_POWER #else #define TESTCODEC_EXITBUTTON BUTTON_SELECT #endif /* Log functions copied from test_disk.c */ static int line = 0; static int max_line = 0; static int log_fd = -1; static char logfilename[MAX_PATH]; static bool log_init(bool use_logfile) { int h; rb->lcd_getstringsize("A", NULL, &h); max_line = LCD_HEIGHT / h; line = 0; rb->lcd_clear_display(); rb->lcd_update(); if (use_logfile) { rb->create_numbered_filename(logfilename, "/", "test_codec_log_", ".txt", 2 IF_CNFN_NUM_(, NULL)); log_fd = rb->open(logfilename, O_RDWR|O_CREAT|O_TRUNC); return log_fd >= 0; } return true; } static void log_text(char *text, bool advance) { rb->lcd_puts(0, line, text); rb->lcd_update(); if (advance) { if (++line >= max_line) line = 0; if (log_fd >= 0) rb->fdprintf(log_fd, "%s\n", text); } } static void log_close(void) { if (log_fd >= 0) rb->close(log_fd); } struct wavinfo_t { int fd; int samplerate; int channels; int sampledepth; int stereomode; int totalsamples; }; static void* audiobuf; static void* codec_mallocbuf; static size_t audiosize; static char str[MAX_PATH]; /* Our local implementation of the codec API */ static struct codec_api ci; struct test_track_info { struct mp3entry id3; /* TAG metadata */ size_t filesize; /* File total length */ }; static struct test_track_info track; static bool taginfo_ready = true; static bool use_dsp; static volatile unsigned int elapsed; static volatile bool codec_playing; static volatile long endtick; struct wavinfo_t wavinfo; static unsigned char wav_header[44] = { 'R','I','F','F', // 0 - ChunkID 0,0,0,0, // 4 - ChunkSize (filesize-8) 'W','A','V','E', // 8 - Format 'f','m','t',' ', // 12 - SubChunkID 16,0,0,0, // 16 - SubChunk1ID // 16 for PCM 1,0, // 20 - AudioFormat (1=16-bit) 0,0, // 22 - NumChannels 0,0,0,0, // 24 - SampleRate in Hz 0,0,0,0, // 28 - Byte Rate (SampleRate*NumChannels*(BitsPerSample/8) 0,0, // 32 - BlockAlign (== NumChannels * BitsPerSample/8) 16,0, // 34 - BitsPerSample 'd','a','t','a', // 36 - Subchunk2ID 0,0,0,0 // 40 - Subchunk2Size }; static inline void int2le32(unsigned char* buf, int32_t x) { buf[0] = (x & 0xff); buf[1] = (x & 0xff00) >> 8; buf[2] = (x & 0xff0000) >> 16; buf[3] = (x & 0xff000000) >>24; } static inline void int2le24(unsigned char* buf, int32_t x) { buf[0] = (x & 0xff); buf[1] = (x & 0xff00) >> 8; buf[2] = (x & 0xff0000) >> 16; } static inline void int2le16(unsigned char* buf, int16_t x) { buf[0] = (x & 0xff); buf[1] = (x & 0xff00) >> 8; } /* 32KB should be enough */ static unsigned char wavbuffer[32*1024]; static unsigned char dspbuffer[32*1024]; void init_wav(char* filename) { wavinfo.totalsamples = 0; wavinfo.fd = rb->creat(filename); if (wavinfo.fd >= 0) { /* Write WAV header - we go back and fill in the details at the end */ rb->write(wavinfo.fd, wav_header, sizeof(wav_header)); } } void close_wav(void) { int filesize = rb->filesize(wavinfo.fd); int channels = (wavinfo.stereomode == STEREO_MONO) ? 1 : 2; int bps = 16; /* TODO */ /* We assume 16-bit, Stereo */ rb->lseek(wavinfo.fd,0,SEEK_SET); int2le32(wav_header+4, filesize-8); /* ChunkSize */ int2le16(wav_header+22, channels); int2le32(wav_header+24, wavinfo.samplerate); int2le32(wav_header+28, wavinfo.samplerate * channels * (bps / 8)); /* ByteRate */ int2le16(wav_header+32, channels * (bps / 8)); int2le32(wav_header+40, filesize - 44); /* Subchunk2Size */ rb->write(wavinfo.fd, wav_header, sizeof(wav_header)); rb->close(wavinfo.fd); } /* Returns buffer to malloc array. Only codeclib should need this. */ static void* codec_get_buffer(size_t *size) { DEBUGF("codec_get_buffer(%d)\n",(int)size); *size = CODEC_SIZE; return codec_mallocbuf; } static int process_dsp(const void *ch1, const void *ch2, int count) { const char *src[2] = { ch1, ch2 }; int written_count = 0; char *dest = dspbuffer; while (count > 0) { int out_count = rb->dsp_output_count(ci.dsp, count); int inp_count = rb->dsp_input_count(ci.dsp, out_count); if (inp_count <= 0) break; if (inp_count > count) inp_count = count; out_count = rb->dsp_process(ci.dsp, dest, src, inp_count); if (out_count <= 0) break; written_count += out_count; dest += out_count * 4; count -= inp_count; } return written_count; } /* Null output */ static bool pcmbuf_insert_null(const void *ch1, const void *ch2, int count) { if (use_dsp) process_dsp(ch1, ch2, count); /* Prevent idle poweroff */ rb->reset_poweroff_timer(); return true; } static inline int32_t clip_sample(int32_t sample) { if ((int16_t)sample != sample) sample = 0x7fff ^ (sample >> 31); return sample; } /* WAV output */ static bool pcmbuf_insert_wav(const void *ch1, const void *ch2, int count) { const int16_t* data1_16; const int16_t* data2_16; const int32_t* data1_32; const int32_t* data2_32; unsigned char* p = wavbuffer; const int scale = wavinfo.sampledepth - 15; const int dc_bias = 1 << (scale - 1); int channels = (wavinfo.stereomode == STEREO_MONO) ? 1 : 2; /* Prevent idle poweroff */ rb->reset_poweroff_timer(); if (use_dsp) { count = process_dsp(ch1, ch2, count); wavinfo.totalsamples += count; if (channels == 1) { unsigned char *s = dspbuffer, *d = dspbuffer; int c = count; while (c-- > 0) { *d++ = *s++; *d++ = *s++; s++; s++; } } rb->write(wavinfo.fd, dspbuffer, count * 2 * channels); } else { if (wavinfo.sampledepth <= 16) { data1_16 = ch1; data2_16 = ch2; switch(wavinfo.stereomode) { case STEREO_INTERLEAVED: while (count--) { int2le16(p,*data1_16++); p += 2; int2le16(p,*data1_16++); p += 2; } break; case STEREO_NONINTERLEAVED: while (count--) { int2le16(p,*data1_16++); p += 2; int2le16(p,*data2_16++); p += 2; } break; case STEREO_MONO: while (count--) { int2le16(p,*data1_16++); p += 2; } break; } } else { data1_32 = ch1; data2_32 = ch2; switch(wavinfo.stereomode) { case STEREO_INTERLEAVED: while (count--) { int2le16(p, clip_sample((*data1_32++ + dc_bias) >> scale)); p += 2; int2le16(p, clip_sample((*data1_32++ + dc_bias) >> scale)); p += 2; } break; case STEREO_NONINTERLEAVED: while (count--) { int2le16(p, clip_sample((*data1_32++ + dc_bias) >> scale)); p += 2; int2le16(p, clip_sample((*data2_32++ + dc_bias) >> scale)); p += 2; } break; case STEREO_MONO: while (count--) { int2le16(p, clip_sample((*data1_32++ + dc_bias) >> scale)); p += 2; } break; } } wavinfo.totalsamples += count; rb->write(wavinfo.fd, wavbuffer, p - wavbuffer); } /* else */ return true; } /* Set song position in WPS (value in ms). */ static void set_elapsed(unsigned int value) { elapsed = value; } /* Read next amount bytes from file buffer to . Will return number of bytes read or 0 if end of file. */ static size_t read_filebuf(void *ptr, size_t size) { if (ci.curpos > (off_t)track.filesize) { return 0; } else { /* TODO: Don't read beyond end of buffer */ rb->memcpy(ptr, audiobuf + ci.curpos, size); ci.curpos += size; return size; } } /* Request pointer to file buffer which can be used to read amount of data. tells the buffer system how much data it should try to allocate. If is 0, end of file is reached. */ static void* request_buffer(size_t *realsize, size_t reqsize) { *realsize = MIN(track.filesize-ci.curpos,reqsize); return (audiobuf + ci.curpos); } /* Advance file buffer position by amount of bytes. */ static void advance_buffer(size_t amount) { ci.curpos += amount; } /* Advance file buffer to a pointer location inside file buffer. */ static void advance_buffer_loc(void *ptr) { ci.curpos = ptr - audiobuf; } /* Seek file buffer to position beginning of file. */ static bool seek_buffer(size_t newpos) { ci.curpos = newpos; return true; } /* Codec should call this function when it has done the seeking. */ static void seek_complete(void) { /* Do nothing */ } /* Request file change from file buffer. Returns true is next track is available and changed. If return value is false, codec should exit immediately with PLUGIN_OK status. */ static bool request_next_track(void) { /* We are only decoding a single track */ return false; } /* Free the buffer area of the current codec after its loaded */ static void discard_codec(void) { /* ??? */ } static void set_offset(size_t value) { /* ??? */ (void)value; } /* Configure different codec buffer parameters. */ static void configure(int setting, intptr_t value) { if (use_dsp) rb->dsp_configure(ci.dsp, setting, value); switch(setting) { case DSP_SWITCH_FREQUENCY: case DSP_SET_FREQUENCY: DEBUGF("samplerate=%d\n",(int)value); wavinfo.samplerate = (int)value; break; case DSP_SET_SAMPLE_DEPTH: DEBUGF("sampledepth = %d\n",(int)value); wavinfo.sampledepth=(int)value; break; case DSP_SET_STEREO_MODE: DEBUGF("Stereo mode = %d\n",(int)value); wavinfo.stereomode=(int)value; break; } } static void init_ci(void) { /* --- Our "fake" implementations of the codec API functions. --- */ ci.codec_get_buffer = codec_get_buffer; if (wavinfo.fd >= 0) { ci.pcmbuf_insert = pcmbuf_insert_wav; } else { ci.pcmbuf_insert = pcmbuf_insert_null; } ci.set_elapsed = set_elapsed; ci.read_filebuf = read_filebuf; ci.request_buffer = request_buffer; ci.advance_buffer = advance_buffer; ci.advance_buffer_loc = advance_buffer_loc; ci.seek_buffer = seek_buffer; ci.seek_complete = seek_complete; ci.request_next_track = request_next_track; ci.discard_codec = discard_codec; ci.set_offset = set_offset; ci.configure = configure; ci.dsp = (struct dsp_config *)rb->dsp_configure(NULL, DSP_MYDSP, CODEC_IDX_AUDIO); /* --- "Core" functions --- */ /* kernel/ system */ ci.sleep = rb->sleep; ci.yield = rb->yield; /* strings and memory */ ci.strcpy = rb->strcpy; ci.strlen = rb->strlen; ci.strcmp = rb->strcmp; ci.strcat = rb->strcat; ci.memset = rb->memset; ci.memcpy = rb->memcpy; ci.memmove = rb->memmove; ci.memcmp = rb->memcmp; ci.memchr = rb->memchr; ci.strcasestr = rb->strcasestr; #if defined(DEBUG) || defined(SIMULATOR) ci.debugf = rb->debugf; #endif #ifdef ROCKBOX_HAS_LOGF ci.logf = rb->logf; #endif ci.qsort = rb->qsort; ci.global_settings = rb->global_settings; #ifdef RB_PROFILE ci.profile_thread = rb->profile_thread; ci.profstop = rb->profstop; ci.profile_func_enter = rb->profile_func_enter; ci.profile_func_exit = rb->profile_func_exit; #endif #if NUM_CORES > 1 ci.cpucache_invalidate = rb->cpucache_invalidate; ci.cpucache_flush = rb->cpucache_flush; #endif #if NUM_CORES > 1 ci.create_thread = rb->create_thread; ci.thread_thaw = rb->thread_thaw; ci.thread_wait = rb->thread_wait; ci.semaphore_init = rb->semaphore_init; ci.semaphore_wait = rb->semaphore_wait; ci.semaphore_release = rb->semaphore_release; #endif #ifdef CPU_ARM ci.__div0 = rb->__div0; #endif } static void codec_thread(void) { const char* codecname; int res; codecname = rb->get_codec_filename(track.id3.codectype); /* Load the codec and start decoding. */ res = rb->codec_load_file(codecname,&ci); /* Signal to the main thread that we are done */ endtick = *rb->current_tick; codec_playing = false; } static enum plugin_status test_track(const char* filename) { size_t n; int fd; enum plugin_status res = PLUGIN_ERROR; long starttick; long ticks; unsigned long speed; unsigned long duration; const char* ch; /* Display filename (excluding any path)*/ ch = rb->strrchr(filename, '/'); if (ch==NULL) ch = filename; else ch++; rb->snprintf(str,sizeof(str),"%s",ch); log_text(str,true); log_text("Loading...",false); fd = rb->open(filename,O_RDONLY); if (fd < 0) { log_text("Cannot open file",true); goto exit; } track.filesize = rb->filesize(fd); /* Clear the id3 struct */ rb->memset(&track.id3, 0, sizeof(struct mp3entry)); if (!rb->get_metadata(&(track.id3), fd, filename)) { log_text("Cannot read metadata",true); goto exit; } if (track.filesize > audiosize) { log_text("File too large",true); goto exit; } n = rb->read(fd, audiobuf, track.filesize); if (n != track.filesize) { log_text("Read failed.",true); goto exit; } /* Initialise the function pointers in the codec API */ init_ci(); /* Prepare the codec struct for playing the whole file */ ci.filesize = track.filesize; ci.id3 = &track.id3; ci.taginfo_ready = &taginfo_ready; ci.curpos = 0; ci.stop_codec = false; ci.new_track = 0; ci.seek_time = 0; if (use_dsp) rb->dsp_configure(ci.dsp, DSP_RESET, 0); starttick = *rb->current_tick; codec_playing = true; rb->codec_thread_do_callback(codec_thread, NULL); /* Wait for codec thread to die */ while (codec_playing) { rb->sleep(HZ); rb->snprintf(str,sizeof(str),"%d of %d",elapsed,(int)track.id3.length); log_text(str,false); } ticks = endtick - starttick; /* Be sure it is done */ rb->codec_thread_do_callback(NULL, NULL); log_text(str,true); if (wavinfo.fd < 0) { /* Display benchmark information */ rb->snprintf(str,sizeof(str),"Decode time - %d.%02ds",(int)ticks/100,(int)ticks%100); log_text(str,true); duration = track.id3.length / 10; rb->snprintf(str,sizeof(str),"File duration - %d.%02ds",(int)duration/100,(int)duration%100); log_text(str,true); if (ticks > 0) speed = duration * 10000 / ticks; else speed = 0; rb->snprintf(str,sizeof(str),"%d.%02d%% realtime",(int)speed/100,(int)speed%100); log_text(str,true); #ifndef SIMULATOR /* show effective clockrate in MHz needed for realtime decoding */ if (speed > 0) { speed = CPUFREQ_MAX / speed; rb->snprintf(str,sizeof(str),"%d.%02dMHz needed for realtime", (int)speed/100,(int)speed%100); log_text(str,true); } #endif } res = PLUGIN_OK; exit: rb->backlight_on(); if (fd >= 0) { rb->close(fd); } return res; } /* plugin entry point */ enum plugin_status plugin_start(const void* parameter) { int result, selection = 0; enum plugin_status res = PLUGIN_OK; int scandir; struct dirent *entry; DIR* dir; char* ch; char dirpath[MAX_PATH]; char filename[MAX_PATH]; if (parameter == NULL) { rb->splash(HZ*2, "No File"); return PLUGIN_ERROR; } codec_mallocbuf = rb->plugin_get_audio_buffer(&audiosize); audiobuf = SKIPBYTES(codec_mallocbuf, CODEC_SIZE); audiosize -= CODEC_SIZE; #ifdef HAVE_ADJUSTABLE_CPU_FREQ rb->cpu_boost(true); #endif rb->lcd_clear_display(); rb->lcd_update(); MENUITEM_STRINGLIST( menu, "test_codec", NULL, "Speed test", "Speed test folder", "Write WAV", "Speed test w/DSP", "Speed test folder w/DSP", "Write WAV w/DSP", "Quit", ); show_menu: rb->lcd_clear_display(); result=rb->do_menu(&menu,&selection, NULL, false); if (result == 6) { res = PLUGIN_OK; goto exit; } scandir = 0; if ((use_dsp = ((result >= 3) && (result <=5)))) { result -= 3; } if (result==0) { wavinfo.fd = -1; log_init(false); } else if (result==1) { wavinfo.fd = -1; scandir = 1; /* Only create a log file when we are testing a folder */ if (!log_init(true)) { rb->splash(HZ*2, "Cannot create logfile"); res = PLUGIN_ERROR; goto exit; } } else if (result==2) { log_init(false); init_wav("/test.wav"); if (wavinfo.fd < 0) { rb->splash(HZ*2, "Cannot create /test.wav"); res = PLUGIN_ERROR; goto exit; } } else if (result == MENU_ATTACHED_USB) { res = PLUGIN_USB_CONNECTED; goto exit; } else if (result < 0) { res = PLUGIN_OK; goto exit; } if (scandir) { /* Test all files in the same directory as the file selected by the user */ rb->strlcpy(dirpath,parameter,sizeof(dirpath)); ch = rb->strrchr(dirpath,'/'); ch[1]=0; DEBUGF("Scanning directory \"%s\"\n",dirpath); dir = rb->opendir(dirpath); if (dir) { entry = rb->readdir(dir); while (entry) { if (!(entry->attribute & ATTR_DIRECTORY)) { rb->snprintf(filename,sizeof(filename),"%s%s",dirpath,entry->d_name); test_track(filename); log_text("", true); } /* Read next entry */ entry = rb->readdir(dir); } rb->closedir(dir); } /* process last samples */ if (use_dsp) rb->dsp_flush_limiter_buffer(dspbuffer); } else { /* Just test the file */ res = test_track(parameter); /* process last samples */ if (use_dsp) { int channels = (wavinfo.stereomode == STEREO_MONO) ? 1 : 2; int count = rb->dsp_flush_limiter_buffer(dspbuffer); if (channels == 1) { unsigned char *s = dspbuffer, *d = dspbuffer; int c = count; while (c-- > 0) { *d++ = *s++; *d++ = *s++; s++; s++; } } if (wavinfo.fd >= 0) rb->write(wavinfo.fd, dspbuffer, count * 2 * channels); } /* Close WAV file (if there was one) */ if (wavinfo.fd >= 0) { close_wav(); log_text("Wrote /test.wav",true); } while (rb->button_get(true) != TESTCODEC_EXITBUTTON); } goto show_menu; exit: log_close(); #ifdef HAVE_ADJUSTABLE_CPU_FREQ rb->cpu_boost(false); #endif return res; }