2011-05-18 19:25:09 +04:00
/*
* ak4641 . c - - AK4641 ALSA Soc Audio driver
*
* Copyright ( C ) 2008 Harald Welte < laforge @ gnufiish . org >
* Copyright ( C ) 2011 Dmitry Artamonow < mad_soft @ inbox . ru >
*
* Based on ak4535 . c by Richard Purdie
*
* This program is free software ; you can redistribute it and / or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation .
*/
# include <linux/module.h>
# include <linux/init.h>
# include <linux/delay.h>
# include <linux/gpio.h>
# include <linux/pm.h>
# include <linux/i2c.h>
# include <linux/platform_device.h>
# include <linux/slab.h>
# include <sound/core.h>
# include <sound/pcm.h>
# include <sound/pcm_params.h>
# include <sound/soc.h>
# include <sound/initval.h>
# include <sound/tlv.h>
# include <sound/ak4641.h>
# include "ak4641.h"
/* codec private data */
struct ak4641_priv {
unsigned int sysclk ;
int deemph ;
int playback_fs ;
} ;
/*
* ak4641 register cache
*/
static const u8 ak4641_reg [ AK4641_CACHEREGNUM ] = {
0x00 , 0x80 , 0x00 , 0x80 ,
0x02 , 0x00 , 0x11 , 0x05 ,
0x00 , 0x00 , 0x36 , 0x10 ,
0x00 , 0x00 , 0x57 , 0x00 ,
0x88 , 0x88 , 0x08 , 0x08
} ;
static const int deemph_settings [ ] = { 44100 , 0 , 48000 , 32000 } ;
static int ak4641_set_deemph ( struct snd_soc_codec * codec )
{
struct ak4641_priv * ak4641 = snd_soc_codec_get_drvdata ( codec ) ;
int i , best = 0 ;
for ( i = 0 ; i < ARRAY_SIZE ( deemph_settings ) ; i + + ) {
/* if deemphasis is on, select the nearest available rate */
if ( ak4641 - > deemph & & deemph_settings [ i ] ! = 0 & &
abs ( deemph_settings [ i ] - ak4641 - > playback_fs ) <
abs ( deemph_settings [ best ] - ak4641 - > playback_fs ) )
best = i ;
if ( ! ak4641 - > deemph & & deemph_settings [ i ] = = 0 )
best = i ;
}
dev_dbg ( codec - > dev , " Set deemphasis %d \n " , best ) ;
return snd_soc_update_bits ( codec , AK4641_DAC , 0x3 , best ) ;
}
static int ak4641_put_deemph ( struct snd_kcontrol * kcontrol ,
struct snd_ctl_elem_value * ucontrol )
{
struct snd_soc_codec * codec = snd_kcontrol_chip ( kcontrol ) ;
struct ak4641_priv * ak4641 = snd_soc_codec_get_drvdata ( codec ) ;
int deemph = ucontrol - > value . enumerated . item [ 0 ] ;
if ( deemph > 1 )
return - EINVAL ;
ak4641 - > deemph = deemph ;
return ak4641_set_deemph ( codec ) ;
}
static int ak4641_get_deemph ( struct snd_kcontrol * kcontrol ,
struct snd_ctl_elem_value * ucontrol )
{
struct snd_soc_codec * codec = snd_kcontrol_chip ( kcontrol ) ;
struct ak4641_priv * ak4641 = snd_soc_codec_get_drvdata ( codec ) ;
ucontrol - > value . enumerated . item [ 0 ] = ak4641 - > deemph ;
return 0 ;
} ;
static const char * ak4641_mono_out [ ] = { " (L + R)/2 " , " Hi-Z " } ;
static const char * ak4641_hp_out [ ] = { " Stereo " , " Mono " } ;
static const char * ak4641_mic_select [ ] = { " Internal " , " External " } ;
static const char * ak4641_mic_or_dac [ ] = { " Microphone " , " Voice DAC " } ;
static const DECLARE_TLV_DB_SCALE ( mono_gain_tlv , - 1700 , 2300 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( mic_boost_tlv , 0 , 2000 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( eq_tlv , - 1050 , 150 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( master_tlv , - 12750 , 50 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( mic_stereo_sidetone_tlv , - 2700 , 300 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( mic_mono_sidetone_tlv , - 400 , 400 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( capture_tlv , - 800 , 50 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( alc_tlv , - 800 , 50 , 0 ) ;
static const DECLARE_TLV_DB_SCALE ( aux_in_tlv , - 2100 , 300 , 0 ) ;
static const struct soc_enum ak4641_mono_out_enum =
SOC_ENUM_SINGLE ( AK4641_SIG1 , 6 , 2 , ak4641_mono_out ) ;
static const struct soc_enum ak4641_hp_out_enum =
SOC_ENUM_SINGLE ( AK4641_MODE2 , 2 , 2 , ak4641_hp_out ) ;
static const struct soc_enum ak4641_mic_select_enum =
SOC_ENUM_SINGLE ( AK4641_MIC , 1 , 2 , ak4641_mic_select ) ;
static const struct soc_enum ak4641_mic_or_dac_enum =
SOC_ENUM_SINGLE ( AK4641_BTIF , 4 , 2 , ak4641_mic_or_dac ) ;
static const struct snd_kcontrol_new ak4641_snd_controls [ ] = {
SOC_ENUM ( " Mono 1 Output " , ak4641_mono_out_enum ) ,
SOC_SINGLE_TLV ( " Mono 1 Gain Volume " , AK4641_SIG1 , 7 , 1 , 1 ,
mono_gain_tlv ) ,
SOC_ENUM ( " Headphone Output " , ak4641_hp_out_enum ) ,
SOC_SINGLE_BOOL_EXT ( " Playback Deemphasis Switch " , 0 ,
ak4641_get_deemph , ak4641_put_deemph ) ,
SOC_SINGLE_TLV ( " Mic Boost Volume " , AK4641_MIC , 0 , 1 , 0 , mic_boost_tlv ) ,
SOC_SINGLE ( " ALC Operation Time " , AK4641_TIMER , 0 , 3 , 0 ) ,
SOC_SINGLE ( " ALC Recovery Time " , AK4641_TIMER , 2 , 3 , 0 ) ,
SOC_SINGLE ( " ALC ZC Time " , AK4641_TIMER , 4 , 3 , 0 ) ,
SOC_SINGLE ( " ALC 1 Switch " , AK4641_ALC1 , 5 , 1 , 0 ) ,
SOC_SINGLE_TLV ( " ALC Volume " , AK4641_ALC2 , 0 , 71 , 0 , alc_tlv ) ,
SOC_SINGLE ( " Left Out Enable Switch " , AK4641_SIG2 , 1 , 1 , 0 ) ,
SOC_SINGLE ( " Right Out Enable Switch " , AK4641_SIG2 , 0 , 1 , 0 ) ,
SOC_SINGLE_TLV ( " Capture Volume " , AK4641_PGA , 0 , 71 , 0 , capture_tlv ) ,
SOC_DOUBLE_R_TLV ( " Master Playback Volume " , AK4641_LATT ,
AK4641_RATT , 0 , 255 , 1 , master_tlv ) ,
SOC_SINGLE_TLV ( " AUX In Volume " , AK4641_VOL , 0 , 15 , 0 , aux_in_tlv ) ,
SOC_SINGLE ( " Equalizer Switch " , AK4641_DAC , 2 , 1 , 0 ) ,
SOC_SINGLE_TLV ( " EQ1 100 Hz Volume " , AK4641_EQLO , 0 , 15 , 1 , eq_tlv ) ,
SOC_SINGLE_TLV ( " EQ2 250 Hz Volume " , AK4641_EQLO , 4 , 15 , 1 , eq_tlv ) ,
SOC_SINGLE_TLV ( " EQ3 1 kHz Volume " , AK4641_EQMID , 0 , 15 , 1 , eq_tlv ) ,
SOC_SINGLE_TLV ( " EQ4 3.5 kHz Volume " , AK4641_EQMID , 4 , 15 , 1 , eq_tlv ) ,
SOC_SINGLE_TLV ( " EQ5 10 kHz Volume " , AK4641_EQHI , 0 , 15 , 1 , eq_tlv ) ,
} ;
/* Mono 1 Mixer */
static const struct snd_kcontrol_new ak4641_mono1_mixer_controls [ ] = {
SOC_DAPM_SINGLE_TLV ( " Mic Mono Sidetone Volume " , AK4641_VOL , 7 , 1 , 0 ,
mic_mono_sidetone_tlv ) ,
SOC_DAPM_SINGLE ( " Mic Mono Sidetone Switch " , AK4641_SIG1 , 4 , 1 , 0 ) ,
SOC_DAPM_SINGLE ( " Mono Playback Switch " , AK4641_SIG1 , 5 , 1 , 0 ) ,
} ;
/* Stereo Mixer */
static const struct snd_kcontrol_new ak4641_stereo_mixer_controls [ ] = {
SOC_DAPM_SINGLE_TLV ( " Mic Sidetone Volume " , AK4641_VOL , 4 , 7 , 0 ,
mic_stereo_sidetone_tlv ) ,
SOC_DAPM_SINGLE ( " Mic Sidetone Switch " , AK4641_SIG2 , 4 , 1 , 0 ) ,
SOC_DAPM_SINGLE ( " Playback Switch " , AK4641_SIG2 , 7 , 1 , 0 ) ,
SOC_DAPM_SINGLE ( " Aux Bypass Switch " , AK4641_SIG2 , 5 , 1 , 0 ) ,
} ;
/* Input Mixer */
static const struct snd_kcontrol_new ak4641_input_mixer_controls [ ] = {
SOC_DAPM_SINGLE ( " Mic Capture Switch " , AK4641_MIC , 2 , 1 , 0 ) ,
SOC_DAPM_SINGLE ( " Aux Capture Switch " , AK4641_MIC , 5 , 1 , 0 ) ,
} ;
/* Mic mux */
static const struct snd_kcontrol_new ak4641_mic_mux_control =
SOC_DAPM_ENUM ( " Mic Select " , ak4641_mic_select_enum ) ;
/* Input mux */
static const struct snd_kcontrol_new ak4641_input_mux_control =
SOC_DAPM_ENUM ( " Input Select " , ak4641_mic_or_dac_enum ) ;
/* mono 2 switch */
static const struct snd_kcontrol_new ak4641_mono2_control =
SOC_DAPM_SINGLE ( " Switch " , AK4641_SIG1 , 0 , 1 , 0 ) ;
/* ak4641 dapm widgets */
static const struct snd_soc_dapm_widget ak4641_dapm_widgets [ ] = {
SND_SOC_DAPM_MIXER ( " Stereo Mixer " , SND_SOC_NOPM , 0 , 0 ,
& ak4641_stereo_mixer_controls [ 0 ] ,
ARRAY_SIZE ( ak4641_stereo_mixer_controls ) ) ,
SND_SOC_DAPM_MIXER ( " Mono1 Mixer " , SND_SOC_NOPM , 0 , 0 ,
& ak4641_mono1_mixer_controls [ 0 ] ,
ARRAY_SIZE ( ak4641_mono1_mixer_controls ) ) ,
SND_SOC_DAPM_MIXER ( " Input Mixer " , SND_SOC_NOPM , 0 , 0 ,
& ak4641_input_mixer_controls [ 0 ] ,
ARRAY_SIZE ( ak4641_input_mixer_controls ) ) ,
SND_SOC_DAPM_MUX ( " Mic Mux " , SND_SOC_NOPM , 0 , 0 ,
& ak4641_mic_mux_control ) ,
SND_SOC_DAPM_MUX ( " Input Mux " , SND_SOC_NOPM , 0 , 0 ,
& ak4641_input_mux_control ) ,
SND_SOC_DAPM_SWITCH ( " Mono 2 Enable " , SND_SOC_NOPM , 0 , 0 ,
& ak4641_mono2_control ) ,
SND_SOC_DAPM_OUTPUT ( " LOUT " ) ,
SND_SOC_DAPM_OUTPUT ( " ROUT " ) ,
SND_SOC_DAPM_OUTPUT ( " MOUT1 " ) ,
SND_SOC_DAPM_OUTPUT ( " MOUT2 " ) ,
SND_SOC_DAPM_OUTPUT ( " MICOUT " ) ,
SND_SOC_DAPM_ADC ( " ADC " , " HiFi Capture " , AK4641_PM1 , 0 , 0 ) ,
SND_SOC_DAPM_PGA ( " Mic " , AK4641_PM1 , 1 , 0 , NULL , 0 ) ,
SND_SOC_DAPM_PGA ( " AUX In " , AK4641_PM1 , 2 , 0 , NULL , 0 ) ,
SND_SOC_DAPM_PGA ( " Mono Out " , AK4641_PM1 , 3 , 0 , NULL , 0 ) ,
SND_SOC_DAPM_PGA ( " Line Out " , AK4641_PM1 , 4 , 0 , NULL , 0 ) ,
SND_SOC_DAPM_DAC ( " DAC " , " HiFi Playback " , AK4641_PM2 , 0 , 0 ) ,
SND_SOC_DAPM_PGA ( " Mono Out 2 " , AK4641_PM2 , 3 , 0 , NULL , 0 ) ,
SND_SOC_DAPM_ADC ( " Voice ADC " , " Voice Capture " , AK4641_BTIF , 0 , 0 ) ,
SND_SOC_DAPM_ADC ( " Voice DAC " , " Voice Playback " , AK4641_BTIF , 1 , 0 ) ,
SND_SOC_DAPM_MICBIAS ( " Mic Int Bias " , AK4641_MIC , 3 , 0 ) ,
SND_SOC_DAPM_MICBIAS ( " Mic Ext Bias " , AK4641_MIC , 4 , 0 ) ,
SND_SOC_DAPM_INPUT ( " MICIN " ) ,
SND_SOC_DAPM_INPUT ( " MICEXT " ) ,
SND_SOC_DAPM_INPUT ( " AUX " ) ,
SND_SOC_DAPM_INPUT ( " AIN " ) ,
} ;
static const struct snd_soc_dapm_route ak4641_audio_map [ ] = {
/* Stereo Mixer */
{ " Stereo Mixer " , " Playback Switch " , " DAC " } ,
{ " Stereo Mixer " , " Mic Sidetone Switch " , " Input Mux " } ,
{ " Stereo Mixer " , " Aux Bypass Switch " , " AUX In " } ,
/* Mono 1 Mixer */
{ " Mono1 Mixer " , " Mic Mono Sidetone Switch " , " Input Mux " } ,
{ " Mono1 Mixer " , " Mono Playback Switch " , " DAC " } ,
/* Mic */
{ " Mic " , NULL , " AIN " } ,
{ " Mic Mux " , " Internal " , " Mic Int Bias " } ,
{ " Mic Mux " , " External " , " Mic Ext Bias " } ,
{ " Mic Int Bias " , NULL , " MICIN " } ,
{ " Mic Ext Bias " , NULL , " MICEXT " } ,
{ " MICOUT " , NULL , " Mic Mux " } ,
/* Input Mux */
{ " Input Mux " , " Microphone " , " Mic " } ,
{ " Input Mux " , " Voice DAC " , " Voice DAC " } ,
/* Line Out */
{ " LOUT " , NULL , " Line Out " } ,
{ " ROUT " , NULL , " Line Out " } ,
{ " Line Out " , NULL , " Stereo Mixer " } ,
/* Mono 1 Out */
{ " MOUT1 " , NULL , " Mono Out " } ,
{ " Mono Out " , NULL , " Mono1 Mixer " } ,
/* Mono 2 Out */
{ " MOUT2 " , NULL , " Mono 2 Enable " } ,
{ " Mono 2 Enable " , " Switch " , " Mono Out 2 " } ,
{ " Mono Out 2 " , NULL , " Stereo Mixer " } ,
{ " Voice ADC " , NULL , " Mono 2 Enable " } ,
/* Aux In */
{ " AUX In " , NULL , " AUX " } ,
/* ADC */
{ " ADC " , NULL , " Input Mixer " } ,
{ " Input Mixer " , " Mic Capture Switch " , " Mic " } ,
{ " Input Mixer " , " Aux Capture Switch " , " AUX In " } ,
} ;
static int ak4641_set_dai_sysclk ( struct snd_soc_dai * codec_dai ,
int clk_id , unsigned int freq , int dir )
{
struct snd_soc_codec * codec = codec_dai - > codec ;
struct ak4641_priv * ak4641 = snd_soc_codec_get_drvdata ( codec ) ;
ak4641 - > sysclk = freq ;
return 0 ;
}
static int ak4641_i2s_hw_params ( struct snd_pcm_substream * substream ,
struct snd_pcm_hw_params * params ,
struct snd_soc_dai * dai )
{
struct snd_soc_pcm_runtime * rtd = substream - > private_data ;
struct snd_soc_codec * codec = rtd - > codec ;
struct ak4641_priv * ak4641 = snd_soc_codec_get_drvdata ( codec ) ;
int rate = params_rate ( params ) , fs = 256 ;
u8 mode2 ;
if ( rate )
fs = ak4641 - > sysclk / rate ;
else
return - EINVAL ;
/* set fs */
switch ( fs ) {
case 1024 :
mode2 = ( 0x2 < < 5 ) ;
break ;
case 512 :
mode2 = ( 0x1 < < 5 ) ;
break ;
case 256 :
mode2 = ( 0x0 < < 5 ) ;
break ;
default :
dev_err ( codec - > dev , " Error: unsupported fs=%d \n " , fs ) ;
return - EINVAL ;
}
snd_soc_update_bits ( codec , AK4641_MODE2 , ( 0x3 < < 5 ) , mode2 ) ;
/* Update de-emphasis filter for the new rate */
if ( substream - > stream = = SNDRV_PCM_STREAM_PLAYBACK ) {
ak4641 - > playback_fs = rate ;
ak4641_set_deemph ( codec ) ;
} ;
return 0 ;
}
static int ak4641_pcm_set_dai_fmt ( struct snd_soc_dai * codec_dai ,
unsigned int fmt )
{
struct snd_soc_codec * codec = codec_dai - > codec ;
u8 btif ;
/* interface format */
switch ( fmt & SND_SOC_DAIFMT_FORMAT_MASK ) {
case SND_SOC_DAIFMT_I2S :
btif = ( 0x3 < < 5 ) ;
break ;
case SND_SOC_DAIFMT_LEFT_J :
btif = ( 0x2 < < 5 ) ;
break ;
case SND_SOC_DAIFMT_DSP_A : /* MSB after FRM */
btif = ( 0x0 < < 5 ) ;
break ;
case SND_SOC_DAIFMT_DSP_B : /* MSB during FRM */
btif = ( 0x1 < < 5 ) ;
break ;
default :
return - EINVAL ;
}
return snd_soc_update_bits ( codec , AK4641_BTIF , ( 0x3 < < 5 ) , btif ) ;
}
static int ak4641_i2s_set_dai_fmt ( struct snd_soc_dai * codec_dai ,
unsigned int fmt )
{
struct snd_soc_codec * codec = codec_dai - > codec ;
u8 mode1 = 0 ;
/* interface format */
switch ( fmt & SND_SOC_DAIFMT_FORMAT_MASK ) {
case SND_SOC_DAIFMT_I2S :
mode1 = 0x02 ;
break ;
case SND_SOC_DAIFMT_LEFT_J :
mode1 = 0x01 ;
break ;
default :
return - EINVAL ;
}
return snd_soc_write ( codec , AK4641_MODE1 , mode1 ) ;
}
static int ak4641_mute ( struct snd_soc_dai * dai , int mute )
{
struct snd_soc_codec * codec = dai - > codec ;
return snd_soc_update_bits ( codec , AK4641_DAC , 0x20 , mute ? 0x20 : 0 ) ;
}
static int ak4641_set_bias_level ( struct snd_soc_codec * codec ,
enum snd_soc_bias_level level )
{
struct ak4641_platform_data * pdata = codec - > dev - > platform_data ;
int ret ;
switch ( level ) {
case SND_SOC_BIAS_ON :
/* unmute */
snd_soc_update_bits ( codec , AK4641_DAC , 0x20 , 0 ) ;
break ;
case SND_SOC_BIAS_PREPARE :
/* mute */
snd_soc_update_bits ( codec , AK4641_DAC , 0x20 , 0x20 ) ;
break ;
case SND_SOC_BIAS_STANDBY :
if ( codec - > dapm . bias_level = = SND_SOC_BIAS_OFF ) {
if ( pdata & & gpio_is_valid ( pdata - > gpio_power ) )
gpio_set_value ( pdata - > gpio_power , 1 ) ;
mdelay ( 1 ) ;
if ( pdata & & gpio_is_valid ( pdata - > gpio_npdn ) )
gpio_set_value ( pdata - > gpio_npdn , 1 ) ;
mdelay ( 1 ) ;
ret = snd_soc_cache_sync ( codec ) ;
if ( ret ) {
dev_err ( codec - > dev ,
" Failed to sync cache: %d \n " , ret ) ;
return ret ;
}
}
snd_soc_update_bits ( codec , AK4641_PM1 , 0x80 , 0x80 ) ;
snd_soc_update_bits ( codec , AK4641_PM2 , 0x80 , 0 ) ;
break ;
case SND_SOC_BIAS_OFF :
snd_soc_update_bits ( codec , AK4641_PM1 , 0x80 , 0 ) ;
if ( pdata & & gpio_is_valid ( pdata - > gpio_npdn ) )
gpio_set_value ( pdata - > gpio_npdn , 0 ) ;
if ( pdata & & gpio_is_valid ( pdata - > gpio_power ) )
gpio_set_value ( pdata - > gpio_power , 0 ) ;
codec - > cache_sync = 1 ;
break ;
}
codec - > dapm . bias_level = level ;
return 0 ;
}
# define AK4641_RATES (SNDRV_PCM_RATE_8000_48000)
# define AK4641_RATES_BT (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
SNDRV_PCM_RATE_16000 )
# define AK4641_FORMATS (SNDRV_PCM_FMTBIT_S16_LE)
static struct snd_soc_dai_ops ak4641_i2s_dai_ops = {
. hw_params = ak4641_i2s_hw_params ,
. set_fmt = ak4641_i2s_set_dai_fmt ,
. digital_mute = ak4641_mute ,
. set_sysclk = ak4641_set_dai_sysclk ,
} ;
static struct snd_soc_dai_ops ak4641_pcm_dai_ops = {
. hw_params = NULL , /* rates are controlled by BT chip */
. set_fmt = ak4641_pcm_set_dai_fmt ,
. digital_mute = ak4641_mute ,
. set_sysclk = ak4641_set_dai_sysclk ,
} ;
2011-06-01 13:10:50 +04:00
static struct snd_soc_dai_driver ak4641_dai [ ] = {
2011-05-18 19:25:09 +04:00
{
. name = " ak4641-hifi " ,
. id = 1 ,
. playback = {
. stream_name = " HiFi Playback " ,
. channels_min = 1 ,
. channels_max = 2 ,
. rates = AK4641_RATES ,
. formats = AK4641_FORMATS ,
} ,
. capture = {
. stream_name = " HiFi Capture " ,
. channels_min = 1 ,
. channels_max = 2 ,
. rates = AK4641_RATES ,
. formats = AK4641_FORMATS ,
} ,
. ops = & ak4641_i2s_dai_ops ,
. symmetric_rates = 1 ,
} ,
{
. name = " ak4641-voice " ,
. id = 1 ,
. playback = {
. stream_name = " Voice Playback " ,
. channels_min = 1 ,
. channels_max = 1 ,
. rates = AK4641_RATES_BT ,
. formats = AK4641_FORMATS ,
} ,
. capture = {
. stream_name = " Voice Capture " ,
. channels_min = 1 ,
. channels_max = 1 ,
. rates = AK4641_RATES_BT ,
. formats = AK4641_FORMATS ,
} ,
. ops = & ak4641_pcm_dai_ops ,
. symmetric_rates = 1 ,
} ,
} ;
static int ak4641_suspend ( struct snd_soc_codec * codec , pm_message_t state )
{
ak4641_set_bias_level ( codec , SND_SOC_BIAS_OFF ) ;
return 0 ;
}
static int ak4641_resume ( struct snd_soc_codec * codec )
{
ak4641_set_bias_level ( codec , SND_SOC_BIAS_STANDBY ) ;
return 0 ;
}
static int ak4641_probe ( struct snd_soc_codec * codec )
{
struct ak4641_platform_data * pdata = codec - > dev - > platform_data ;
int ret ;
if ( pdata ) {
if ( gpio_is_valid ( pdata - > gpio_power ) ) {
ret = gpio_request_one ( pdata - > gpio_power ,
GPIOF_OUT_INIT_LOW , " ak4641 power " ) ;
if ( ret )
goto err_out ;
}
if ( gpio_is_valid ( pdata - > gpio_npdn ) ) {
ret = gpio_request_one ( pdata - > gpio_npdn ,
GPIOF_OUT_INIT_LOW , " ak4641 npdn " ) ;
if ( ret )
goto err_gpio ;
udelay ( 1 ) ; /* > 150 ns */
gpio_set_value ( pdata - > gpio_npdn , 1 ) ;
}
}
ret = snd_soc_codec_set_cache_io ( codec , 8 , 8 , SND_SOC_I2C ) ;
if ( ret ! = 0 ) {
dev_err ( codec - > dev , " Failed to set cache I/O: %d \n " , ret ) ;
goto err_register ;
}
/* power on device */
ak4641_set_bias_level ( codec , SND_SOC_BIAS_STANDBY ) ;
return 0 ;
err_register :
if ( pdata ) {
if ( gpio_is_valid ( pdata - > gpio_power ) )
gpio_set_value ( pdata - > gpio_power , 0 ) ;
if ( gpio_is_valid ( pdata - > gpio_npdn ) )
gpio_free ( pdata - > gpio_npdn ) ;
}
err_gpio :
if ( pdata & & gpio_is_valid ( pdata - > gpio_power ) )
gpio_free ( pdata - > gpio_power ) ;
err_out :
return ret ;
}
static int ak4641_remove ( struct snd_soc_codec * codec )
{
struct ak4641_platform_data * pdata = codec - > dev - > platform_data ;
ak4641_set_bias_level ( codec , SND_SOC_BIAS_OFF ) ;
if ( pdata ) {
if ( gpio_is_valid ( pdata - > gpio_power ) ) {
gpio_set_value ( pdata - > gpio_power , 0 ) ;
gpio_free ( pdata - > gpio_power ) ;
}
if ( gpio_is_valid ( pdata - > gpio_npdn ) )
gpio_free ( pdata - > gpio_npdn ) ;
}
return 0 ;
}
static struct snd_soc_codec_driver soc_codec_dev_ak4641 = {
. probe = ak4641_probe ,
. remove = ak4641_remove ,
. suspend = ak4641_suspend ,
. resume = ak4641_resume ,
. controls = ak4641_snd_controls ,
. num_controls = ARRAY_SIZE ( ak4641_snd_controls ) ,
. dapm_widgets = ak4641_dapm_widgets ,
. num_dapm_widgets = ARRAY_SIZE ( ak4641_dapm_widgets ) ,
. dapm_routes = ak4641_audio_map ,
. num_dapm_routes = ARRAY_SIZE ( ak4641_audio_map ) ,
. set_bias_level = ak4641_set_bias_level ,
. reg_cache_size = ARRAY_SIZE ( ak4641_reg ) ,
. reg_word_size = sizeof ( u8 ) ,
. reg_cache_default = ak4641_reg ,
. reg_cache_step = 1 ,
} ;
static int __devinit ak4641_i2c_probe ( struct i2c_client * i2c ,
const struct i2c_device_id * id )
{
struct ak4641_priv * ak4641 ;
int ret ;
ak4641 = kzalloc ( sizeof ( struct ak4641_priv ) , GFP_KERNEL ) ;
if ( ! ak4641 )
return - ENOMEM ;
i2c_set_clientdata ( i2c , ak4641 ) ;
ret = snd_soc_register_codec ( & i2c - > dev , & soc_codec_dev_ak4641 ,
ak4641_dai , ARRAY_SIZE ( ak4641_dai ) ) ;
if ( ret < 0 )
kfree ( ak4641 ) ;
return ret ;
}
static int __devexit ak4641_i2c_remove ( struct i2c_client * i2c )
{
snd_soc_unregister_codec ( & i2c - > dev ) ;
kfree ( i2c_get_clientdata ( i2c ) ) ;
return 0 ;
}
static const struct i2c_device_id ak4641_i2c_id [ ] = {
{ " ak4641 " , 0 } ,
{ }
} ;
MODULE_DEVICE_TABLE ( i2c , ak4641_i2c_id ) ;
static struct i2c_driver ak4641_i2c_driver = {
. driver = {
. name = " ak4641 " ,
. owner = THIS_MODULE ,
} ,
. probe = ak4641_i2c_probe ,
. remove = __devexit_p ( ak4641_i2c_remove ) ,
. id_table = ak4641_i2c_id ,
} ;
static int __init ak4641_modinit ( void )
{
int ret ;
ret = i2c_add_driver ( & ak4641_i2c_driver ) ;
if ( ret ! = 0 )
pr_err ( " Failed to register AK4641 I2C driver: %d \n " , ret ) ;
return ret ;
}
module_init ( ak4641_modinit ) ;
static void __exit ak4641_exit ( void )
{
i2c_del_driver ( & ak4641_i2c_driver ) ;
}
module_exit ( ak4641_exit ) ;
MODULE_DESCRIPTION ( " SoC AK4641 driver " ) ;
MODULE_AUTHOR ( " Harald Welte <laforge@gnufiish.org> " ) ;
MODULE_LICENSE ( " GPL " ) ;