/************************************************************************** * i2c.c * * * * Copyright (c) 1999 Jake Janovetz * ************************************************************************** * This source code is property of Jake Janovetz. No permission is given * * to use or reuse this code in any other form. * * Description: * * * * The public routines contained in this file are: * * configure_ports -- Configures the ports on the CPU. * * STA_Reset -- Performs a hard reset of the MP3 decoder. * * STA_StartDecoder -- Soft resets decoder and unmutes the DAC. * * STA_StopDecoder -- Stops the decoder and mutes the DAC. * * STA_PauseDecoder -- Pauses the decoder. * * STA_ResumeDecoder -- Unpauses the decoder. * * STA_QueryMP3Header * * STA_QueryFrameCount * * STA_QueryAverageBitrate * * STA_SetVolumeMatrix * * STA_SetBassFrequency * * STA_SetBassEnhance * * STA_SetTrebleFrequency * * STA_SetTrebleEnhance * * STA_GetVolume * * STA_GetBassEnhance * * STA_GetTrebleEnhance * * STA_VolumeChange * * STA_BassChange * * STA_TrebleChange * * STA_MuteToggle * * * * * * The private routines contained in this file are: * * I2C_SendByte * * I2C_ReadByte * * I2C_Start * * I2C_Stop * * I2C_NoACK * * DAC_Mute * * DAC_UnMute * * STA_ReadRegister * * STA_WriteRegister * * STA_DownloadUpdate -- Download firmware updates. * * STA_ReadToneControls -- Reads all tone controls from the decoder. * * STA_WriteToneControls -- Writes all tone controls to the decoder. * * * * * ************************************************************************** * Change History: * * 03/01/1999 - Creation (JWJ) * *************************************************************************/ #include #include #include "m68360.h" #include "monitor.h" #include "i2c.h" #include "mp3.h" #define I2C_DATA (1<<0) #define I2C_CLK (1<<1) #define MPEG_RESET (1<<2) #define DAC_MUTE_L (1<<3) #define DAC_MUTE_R (1<<4) #define DAC_AUTOMUTE (1<<5) #define VOLUME_SDATAI (1<<6) #define VOLUME_SCLK (1<<7) #define VOLUME_MUTE (1<<8) #define MPEG_DATA (1<<3) #define MPEG_CLK (1<<10) #define MPEG_ENABLE (1<<1) #define MPEG_DEMAND (1<<6) #define I2C_DELAY 16 /************************************************************************** * STA013 * Register Defines *************************************************************************/ #define STA_REG_VERSION 0x00 #define STA_REG_IDENT 0x01 #define STA_REG_PLLCTL_1 0x05 #define STA_REG_PLLCTL_2 0x06 #define STA_REG_PLLCTL_3 0x07 #define STA_REG_REQ_POL 0x0c #define STA_REG_SCLK_POL 0x0d #define STA_REG_ERROR_CODE 0x0f #define STA_REG_SOFT_RESET 0x10 #define STA_REG_PLAY 0x13 #define STA_REG_MUTE 0x14 #define STA_REG_CMD_INTERRUPT 0x16 #define STA_REG_DATA_REQ_ENABLE 0x18 #define STA_REG_SYNCSTATUS 0x40 #define STA_REG_ANCCOUNT_L 0x41 #define STA_REG_ANCCOUNT_H 0x42 #define STA_REG_HEAD_H 0x43 #define STA_REG_HEAD_M 0x44 #define STA_REG_HEAD_L 0x45 #define STA_REG_DLA 0x46 #define STA_REG_DLB 0x47 #define STA_REG_DRA 0x48 #define STA_REG_DRB 0x49 #define STA_REG_MFSDF_441 0x50 #define STA_REG_PLLFRAC_441_L 0x51 #define STA_REG_PLLFRAC_441_H 0x52 #define STA_REG_PCMDIVIDER 0x54 #define STA_REG_PCMCONF 0x55 #define STA_REG_PCMCROSS 0x56 #define STA_REG_ANC_DATA_1 0x59 #define STA_REG_ANC_DATA_2 0x5a #define STA_REG_ANC_DATA_3 0x5b #define STA_REG_ANC_DATA_4 0x5c #define STA_REG_ANC_DATA_5 0x5d #define STA_REG_MFSDF 0x61 #define STA_REG_DAC_CLK_MODE 0x63 #define STA_REG_PLLFRAC_L 0x64 #define STA_REG_PLLFRAC_H 0x65 #define STA_REG_FRAME_CNT_L 0x67 #define STA_REG_FRAME_CNT_M 0x68 #define STA_REG_FRAME_CNT_H 0x69 #define STA_REG_AVERAGE_BITRATE 0x6a #define STA_REG_SOFTVERSION 0x71 #define STA_REG_RUN 0x72 #define STA_REG_TREBLE_FREQUENCY_LOW 0x77 #define STA_REG_TREBLE_FREQUENCY_HIGH 0x78 #define STA_REG_BASS_FREQUENCY_LOW 0x79 #define STA_REG_BASS_FREQUENCY_HIGH 0x7a #define STA_REG_TREBLE_ENHANCE 0x7b #define STA_REG_BASS_ENHANCE 0x7c #define STA_REG_TONE_ATTEN 0x7d #define MIN(a,b) ((ab)?(a):(b)) #define MIN_VOLUME_ATTENUATION 0 #define MAX_VOLUME_ATTENUATION 96 #define MIN_TONE_ATTENUATION 0 #define MAX_TONE_ATTENUATION 96 #define MIN_BASS_FREQUENCY 100 #define MAX_BASS_FREQUENCY 500 #define MIN_TREBLE_FREQUENCY 1000 #define MAX_TREBLE_FREQUENCY 5000 #define SOFTMUTE_VOLUME_CHANGE 20 /************************************************************************** * Prototypes *************************************************************************/ static int STA_ReadToneControls(); static int STA_WriteToneControls(); static struct MP3_ToneControls tone_controls_g; static rtems_id sta_semid_g; static int MP3_Bitrates[] = { 0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160, 0, 0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320, 0}; static int MP3_SamplingFrequencies[] = { 11, 12, 8, 0, /* MPEG 2.5 rates */ 0, 0, 0, 0, /* reserved rates */ 22, 24, 16, 0, /* MPEG 2 rates */ 44, 48, 32, 0 /* MPEG 1 rates */ }; void configure_ports() { rtems_status_code sc; m360.paodr &= ~(MPEG_DATA | MPEG_CLK); /* active outputs */ m360.padir |= MPEG_DATA | MPEG_CLK; /* outputs */ m360.papar &= ~(MPEG_DATA | MPEG_CLK); /* Assign as GPIO */ m360.padat &= ~(MPEG_DATA | MPEG_CLK); m360.pbodr &= ~0x000001ff; /* Configure Port B open drain register */ m360.pbdir |= 0x000001ff; /* Configure Port B as output */ m360.pbpar &= ~0x000001ff; /* Configure Port B as GPIO */ m360.pbdat = 0x000001ff; /* Default outputs */ m360.pcpar &= ~0x42; /* Pins 1,6 are GPIO */ m360.pcdir |= 0x02; /* Pin 1 (MPEG_ENABLE) is an output */ m360.pcdir &= ~0x40; /* Pin 6 (MPEG_DEMAND) is an input */ m360.pcso &= ~0x42; /* Pins 1,6 are GPIO */ m360.pcdat &= ~0x02; /* Clear MPEG_ENABLE */ m360.pcint &= ~(MPEG_DEMAND); /* Interrupt on any change to DEMAND */ m360.pbdat &= ~DAC_AUTOMUTE; /* Turn on DAC automute */ /*********************************************************************** * Create a port semaphore to regulate usage of the STA013 I2C bus. **********************************************************************/ sc = rtems_semaphore_create(rtems_build_name('P', 'R', 'T', 'S'), 1, RTEMS_FIFO | RTEMS_BINARY_SEMAPHORE | RTEMS_NO_INHERIT_PRIORITY | RTEMS_LOCAL | RTEMS_NO_PRIORITY_CEILING, 0, &sta_semid_g); if (sc != RTEMS_SUCCESSFUL) syslog(LOG_ERR, "mp3d: Could not create port semaphore."); } /* * I2C bus protocol: * * Data changes (SDA) occur ONLY when SCL is low. A transition while * SCL is high is defined as either STOP or START. * START is defined as a high-low transition of SDA while SCL is high. * STOP is defined as a low-high transition of SDA while SCL is high. * * Data is shifted out MSB first. * * Acknowledge: the bus master releases the bus after sending 8-bits * of data. During the 9th clock pulse, the receiver pulls the * SDA bus low to acknowledge. */ static int I2C_SendByte(unsigned char b) { int i, j; unsigned long ack; rtems_interrupt_level isr_level; rtems_interrupt_disable(isr_level); for (i=0; i<8; i++) { if (b & 0x80) m360.pbdat |= I2C_DATA; else m360.pbdat &= ~I2C_DATA; for (j=0; j 0) t = (unsigned char)tone_controls_g.bass_enhance; else t = (unsigned char)(tone_controls_g.bass_enhance + 256); STA_WriteRegister(STA_REG_BASS_ENHANCE, t); if (tone_controls_g.treble_enhance > 0) t = (unsigned char)tone_controls_g.treble_enhance; else t = (unsigned char)(tone_controls_g.treble_enhance + 256); STA_WriteRegister(STA_REG_TREBLE_ENHANCE, t); /*********************************************************************** * Tone controls have changed, so notify everyone listening. **********************************************************************/ Status_Command(STATUS_COMMAND_TONECHANGE); return(0); } int STA_StartDecoder() { DAC_Mute(); rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteRegister(STA_REG_SOFT_RESET, 0x01); /* * Mute and configure DAC output. */ STA_WriteRegister(STA_REG_MUTE, 0x01); STA_WriteRegister(STA_REG_PCMDIVIDER, 0x03); STA_WriteRegister(STA_REG_PCMCONF, 0x2b); /* * Configure PLL for MP3 rates. */ STA_WriteRegister(STA_REG_PLLFRAC_441_H, 0xff); STA_WriteRegister(STA_REG_PLLFRAC_441_L, 0xff); STA_WriteRegister(STA_REG_PLLFRAC_H, 0xbb); STA_WriteRegister(STA_REG_PLLFRAC_L, 0x3a); STA_WriteRegister(STA_REG_MFSDF_441, 0x08); STA_WriteRegister(STA_REG_MFSDF, 0x07); /* * Configure interface polarities, etc. */ STA_WriteRegister(STA_REG_PLLCTL_2, 0x0c); STA_WriteRegister(STA_REG_PLLCTL_3, 0x00); STA_WriteRegister(STA_REG_PLLCTL_1, 0x01); STA_WriteRegister(STA_REG_SCLK_POL, 0x00); STA_WriteRegister(STA_REG_REQ_POL, 0x05); STA_WriteRegister(STA_REG_DATA_REQ_ENABLE, 0x04); STA_WriteRegister(STA_REG_PLLCTL_1, 0xa1); STA_WriteToneControls(); /* * Unmute and start running. */ STA_WriteRegister(STA_REG_RUN, 0x01); STA_WriteRegister(STA_REG_PLAY, 0x01); STA_WriteRegister(STA_REG_MUTE, 0x00); rtems_task_wake_after(1); DAC_UnMute(); rtems_semaphore_release(sta_semid_g); return(0); } int STA_StopDecoder() { DAC_Mute(); rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_ReadToneControls(); STA_WriteRegister(STA_REG_MUTE, 0x01); STA_WriteRegister(STA_REG_SOFT_RESET, 0x01); STA_WriteRegister(STA_REG_SOFT_RESET, 0x00); rtems_semaphore_release(sta_semid_g); return(0); } int STA_PauseDecoder() { rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteRegister(STA_REG_PLAY, 0x00); rtems_semaphore_release(sta_semid_g); return(0); } int STA_ResumeDecoder() { rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteRegister(STA_REG_PLAY, 0x01); rtems_semaphore_release(sta_semid_g); return(0); } int STA_QueryMP3Header(struct MP3_Header *hdr) { unsigned long l; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); l = (unsigned long)STA_ReadRegister(STA_REG_HEAD_H) << 16 | (unsigned long)STA_ReadRegister(STA_REG_HEAD_M) << 8 | (unsigned long)STA_ReadRegister(STA_REG_HEAD_L); rtems_semaphore_release(sta_semid_g); hdr->word = l; hdr->emphasis = l & 0x03; hdr->isOriginal = (l >> 2) & 0x01; hdr->isCopyrighted = (l >> 3) & 0x01; hdr->modeExtension = (l >> 4) & 0x03; hdr->mode = (l >> 6) & 0x03; hdr->private = (l >> 8) & 0x01; hdr->padding = (l >> 9) & 0x01; hdr->frequencyIndex = (l >> 10) & 0x03; hdr->bitrateIndex = (l >> 12) & 0x0f; hdr->protection = (l >> 16) & 0x01; hdr->layer = (l >> 17) & 0x03; hdr->ID = (l >> 19) & 0x01; hdr->ID_ex = (l >> 20) & 0x01; hdr->bitrate = MP3_Bitrates[hdr->bitrateIndex + 16*hdr->ID]; hdr->frequency = MP3_SamplingFrequencies[hdr->frequencyIndex + 4*hdr->ID + 8*hdr->ID_ex]; return(0); } unsigned long STA_QueryFrameCount() { unsigned long l; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); l = (unsigned long)STA_ReadRegister(STA_REG_FRAME_CNT_H) << 16 | (unsigned long)STA_ReadRegister(STA_REG_FRAME_CNT_M) << 8 | (unsigned long)STA_ReadRegister(STA_REG_FRAME_CNT_L); rtems_semaphore_release(sta_semid_g); return(l); } int STA_QueryAverageBitrate() { int c; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); c = 2 * (int)STA_ReadRegister(STA_REG_AVERAGE_BITRATE); rtems_semaphore_release(sta_semid_g); return(c); } int STA_SetVolumeMatrix(unsigned char dla, unsigned char dlb, unsigned char dra, unsigned char drb) { if ((dla > 96) || (dlb > 96) || (dra > 96) || (drb > 96)) return(-1); tone_controls_g.volume_dla = dla; tone_controls_g.volume_dlb = dlb; tone_controls_g.volume_dra = dra; tone_controls_g.volume_drb = drb; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteToneControls(); rtems_semaphore_release(sta_semid_g); return(0); } int STA_SetBassFrequency(unsigned short freq) { rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteRegister(STA_REG_BASS_FREQUENCY_HIGH, (freq&0xff00) >> 8); STA_WriteRegister(STA_REG_BASS_FREQUENCY_LOW, freq&0x00ff); rtems_semaphore_release(sta_semid_g); tone_controls_g.bass_freq = freq; return(0); } int STA_SetBassEnhance(int v) { if ((v > 12) || (v < -12)) return(-1); tone_controls_g.bass_enhance = v; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteToneControls(); rtems_semaphore_release(sta_semid_g); return(0); } int STA_SetTrebleFrequency(unsigned short freq) { rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteRegister(STA_REG_TREBLE_FREQUENCY_HIGH, (freq&0xff00) >> 8); STA_WriteRegister(STA_REG_TREBLE_FREQUENCY_LOW, freq&0x00ff); rtems_semaphore_release(sta_semid_g); tone_controls_g.treble_freq = freq; return(0); } int STA_SetTrebleEnhance(int v) { if ((v > 12) || (v < -12)) return(-1); tone_controls_g.treble_enhance = v; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteToneControls(); rtems_semaphore_release(sta_semid_g); return(0); } int STA_GetVolume() { int v; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_ReadToneControls(); v = (int)tone_controls_g.volume_dla; rtems_semaphore_release(sta_semid_g); return(v); } int STA_GetBassEnhance() { int v; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_ReadToneControls(); rtems_semaphore_release(sta_semid_g); v = (int)tone_controls_g.bass_enhance; return(v); } int STA_GetTrebleEnhance() { int v; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_ReadToneControls(); rtems_semaphore_release(sta_semid_g); v = (int)tone_controls_g.treble_enhance; return(v); } int STA_VolumeChange(int v) { tone_controls_g.volume_dla = STA_ReadRegister(STA_REG_DLA); tone_controls_g.volume_dra = STA_ReadRegister(STA_REG_DRA); tone_controls_g.volume_dla = MIN(MAX(tone_controls_g.volume_dla - v, 0), 96); tone_controls_g.volume_dra = MIN(MAX(tone_controls_g.volume_dra - v, 0), 96); rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteToneControls(); rtems_semaphore_release(sta_semid_g); return(0); } int STA_BassChange(int b) { tone_controls_g.bass_enhance = (int)((char)STA_ReadRegister(STA_REG_BASS_ENHANCE)); tone_controls_g.bass_enhance = MIN(MAX(tone_controls_g.bass_enhance + b, -12), 12); rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteToneControls(); rtems_semaphore_release(sta_semid_g); return(0); } int STA_TrebleChange(int t) { tone_controls_g.treble_enhance = (int)((char)STA_ReadRegister(STA_REG_TREBLE_ENHANCE)); tone_controls_g.treble_enhance = MIN(MAX(tone_controls_g.treble_enhance + t, -12), 12); rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); STA_WriteToneControls(); rtems_semaphore_release(sta_semid_g); return(0); } int STA_MuteToggle() { int mute; rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); mute = (int)STA_ReadRegister(STA_REG_MUTE); if (mute == 0) mute = 1; else mute = 0; STA_WriteRegister(STA_REG_MUTE, mute); rtems_semaphore_release(sta_semid_g); return(mute); } int STA_SoftMuteToggle() { rtems_semaphore_obtain(sta_semid_g, RTEMS_WAIT, RTEMS_NO_TIMEOUT); rtems_semaphore_release(sta_semid_g); return(0); }