/****************************************************************************
Copyright (C) Cambridge Silicon Radio Ltd. 2004-2006
Part of BlueLab 3.6.2-release

FILE NAME
    headset_codec.c

DESCRIPTION
    Deals with all codec configuration

*/


/****************************************************************************
    Header files
*/
#include <codec.h>
#include <panic.h>
#include <pcm.h>
#include <stream.h>

#include "headset_codec.h"
#include "headset_private.h"

#ifdef DEBUG_AVSTREAM
#define AVSTREAM_DEBUG(x) DEBUG(x)
#else
#define AVSTREAM_DEBUG(x) 
#endif

#ifdef WOLFSON_CODEC_WM8731
static void configure_wolfson_codec(headsetTaskData *app) 
{
    const codec_config_params wolfsonCodecConfigParams 
            = {mic_input,OUTPUT_DAC,sample48kHz,sample48kHz};
    CodecConfigure(app->codec_task,&wolfsonCodecConfigParams);
}
#endif




/**************************************************************************/
void codec_configure_AvStream(headsetTaskData *app)
{
   uint32 sampleRate = app->rate;
   
   AVSTREAM_DEBUG(("AV: Configure Codec\n"));
   
#ifdef WOLFSON_CODEC_WM8731
   if (sampleRate == 44100)
       sampleRate = 44118;
#endif
    /* Set both ports to none to allow reassigning of internal DACs */
   /* Disconnect anything already connected to PCM slots 0 and 1 */
	StreamDisconnect(StreamPcmSource(0), StreamPcmSink(0));
	StreamDisconnect(StreamPcmSource(1), StreamPcmSink(1));

   (void) PanicFalse(PcmClearRouting(0));
   (void) PanicFalse(PcmClearRouting(1));
   /* Is it mono playback? */
   if (app->channel_mode == a2dp_mono)
   {
       /* Mono - Set both DACs to play the output of port 0. */
#ifdef WOLFSON_CODEC_WM8731
      (void) PanicFalse(PcmRateAndRoute(0, PCM_NO_SYNC, sampleRate, sampleRate, VM_PCM_EXTERNAL_I2S));
      configure_wolfson_codec(app);
#else
      (void) PanicFalse(PcmRateAndRoute(0, PCM_NO_SYNC, sampleRate, (uint32) 8000, VM_PCM_INTERNAL_A_AND_B));
#endif
   }
   else
   {
      /*
         Stereo - Configure port 0 and 1 to be left and right channels
         and synchronise buffer offsets for stereo playback.
      */
#ifdef WOLFSON_CODEC_WM8731
      (void) PanicFalse(PcmRateAndRoute(0, PCM_NO_SYNC, sampleRate, sampleRate, VM_PCM_EXTERNAL_I2S));
      (void) PanicFalse(PcmRateAndRoute(1, 0, sampleRate, sampleRate, VM_PCM_EXTERNAL_I2S));
      configure_wolfson_codec(app);
#else
      (void) PanicFalse(PcmRateAndRoute(0, PCM_NO_SYNC, sampleRate, (uint32) 8000, VM_PCM_INTERNAL_A));
      (void) PanicFalse(PcmRateAndRoute(1, 0, sampleRate, (uint32) 8000, VM_PCM_INTERNAL_B));
#endif
   }
}