diff options
Diffstat (limited to 'sound/soc/codecs/wm8974.c')
| -rw-r--r-- | sound/soc/codecs/wm8974.c | 36 |
1 files changed, 15 insertions, 21 deletions
diff --git a/sound/soc/codecs/wm8974.c b/sound/soc/codecs/wm8974.c index 98d663afc97d..81c57b5c591c 100644 --- a/sound/soc/codecs/wm8974.c +++ b/sound/soc/codecs/wm8974.c | |||
| @@ -276,41 +276,42 @@ static int wm8974_add_widgets(struct snd_soc_codec *codec) | |||
| 276 | 276 | ||
| 277 | snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map)); | 277 | snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map)); |
| 278 | 278 | ||
| 279 | snd_soc_dapm_new_widgets(codec); | ||
| 280 | return 0; | 279 | return 0; |
| 281 | } | 280 | } |
| 282 | 281 | ||
| 283 | struct pll_ { | 282 | struct pll_ { |
| 284 | unsigned int pre_div:4; /* prescale - 1 */ | 283 | unsigned int pre_div:1; |
| 285 | unsigned int n:4; | 284 | unsigned int n:4; |
| 286 | unsigned int k; | 285 | unsigned int k; |
| 287 | }; | 286 | }; |
| 288 | 287 | ||
| 289 | static struct pll_ pll_div; | ||
| 290 | |||
| 291 | /* The size in bits of the pll divide multiplied by 10 | 288 | /* The size in bits of the pll divide multiplied by 10 |
| 292 | * to allow rounding later */ | 289 | * to allow rounding later */ |
| 293 | #define FIXED_PLL_SIZE ((1 << 24) * 10) | 290 | #define FIXED_PLL_SIZE ((1 << 24) * 10) |
| 294 | 291 | ||
| 295 | static void pll_factors(unsigned int target, unsigned int source) | 292 | static void pll_factors(struct pll_ *pll_div, |
| 293 | unsigned int target, unsigned int source) | ||
| 296 | { | 294 | { |
| 297 | unsigned long long Kpart; | 295 | unsigned long long Kpart; |
| 298 | unsigned int K, Ndiv, Nmod; | 296 | unsigned int K, Ndiv, Nmod; |
| 299 | 297 | ||
| 298 | /* There is a fixed divide by 4 in the output path */ | ||
| 299 | target *= 4; | ||
| 300 | |||
| 300 | Ndiv = target / source; | 301 | Ndiv = target / source; |
| 301 | if (Ndiv < 6) { | 302 | if (Ndiv < 6) { |
| 302 | source >>= 1; | 303 | source /= 2; |
| 303 | pll_div.pre_div = 1; | 304 | pll_div->pre_div = 1; |
| 304 | Ndiv = target / source; | 305 | Ndiv = target / source; |
| 305 | } else | 306 | } else |
| 306 | pll_div.pre_div = 0; | 307 | pll_div->pre_div = 0; |
| 307 | 308 | ||
| 308 | if ((Ndiv < 6) || (Ndiv > 12)) | 309 | if ((Ndiv < 6) || (Ndiv > 12)) |
| 309 | printk(KERN_WARNING | 310 | printk(KERN_WARNING |
| 310 | "WM8974 N value %u outwith recommended range!\n", | 311 | "WM8974 N value %u outwith recommended range!\n", |
| 311 | Ndiv); | 312 | Ndiv); |
| 312 | 313 | ||
| 313 | pll_div.n = Ndiv; | 314 | pll_div->n = Ndiv; |
| 314 | Nmod = target % source; | 315 | Nmod = target % source; |
| 315 | Kpart = FIXED_PLL_SIZE * (long long)Nmod; | 316 | Kpart = FIXED_PLL_SIZE * (long long)Nmod; |
| 316 | 317 | ||
| @@ -325,13 +326,14 @@ static void pll_factors(unsigned int target, unsigned int source) | |||
| 325 | /* Move down to proper range now rounding is done */ | 326 | /* Move down to proper range now rounding is done */ |
| 326 | K /= 10; | 327 | K /= 10; |
| 327 | 328 | ||
| 328 | pll_div.k = K; | 329 | pll_div->k = K; |
| 329 | } | 330 | } |
| 330 | 331 | ||
| 331 | static int wm8974_set_dai_pll(struct snd_soc_dai *codec_dai, | 332 | static int wm8974_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id, |
| 332 | int pll_id, unsigned int freq_in, unsigned int freq_out) | 333 | int source, unsigned int freq_in, unsigned int freq_out) |
| 333 | { | 334 | { |
| 334 | struct snd_soc_codec *codec = codec_dai->codec; | 335 | struct snd_soc_codec *codec = codec_dai->codec; |
| 336 | struct pll_ pll_div; | ||
| 335 | u16 reg; | 337 | u16 reg; |
| 336 | 338 | ||
| 337 | if (freq_in == 0 || freq_out == 0) { | 339 | if (freq_in == 0 || freq_out == 0) { |
| @@ -345,7 +347,7 @@ static int wm8974_set_dai_pll(struct snd_soc_dai *codec_dai, | |||
| 345 | return 0; | 347 | return 0; |
| 346 | } | 348 | } |
| 347 | 349 | ||
| 348 | pll_factors(freq_out*4, freq_in); | 350 | pll_factors(&pll_div, freq_out, freq_in); |
| 349 | 351 | ||
| 350 | snd_soc_write(codec, WM8974_PLLN, (pll_div.pre_div << 4) | pll_div.n); | 352 | snd_soc_write(codec, WM8974_PLLN, (pll_div.pre_div << 4) | pll_div.n); |
| 351 | snd_soc_write(codec, WM8974_PLLK1, pll_div.k >> 18); | 353 | snd_soc_write(codec, WM8974_PLLK1, pll_div.k >> 18); |
| @@ -638,17 +640,9 @@ static int wm8974_probe(struct platform_device *pdev) | |||
| 638 | snd_soc_add_controls(codec, wm8974_snd_controls, | 640 | snd_soc_add_controls(codec, wm8974_snd_controls, |
| 639 | ARRAY_SIZE(wm8974_snd_controls)); | 641 | ARRAY_SIZE(wm8974_snd_controls)); |
| 640 | wm8974_add_widgets(codec); | 642 | wm8974_add_widgets(codec); |
| 641 | ret = snd_soc_init_card(socdev); | ||
| 642 | if (ret < 0) { | ||
| 643 | dev_err(codec->dev, "failed to register card: %d\n", ret); | ||
| 644 | goto card_err; | ||
| 645 | } | ||
| 646 | 643 | ||
| 647 | return ret; | 644 | return ret; |
| 648 | 645 | ||
| 649 | card_err: | ||
| 650 | snd_soc_free_pcms(socdev); | ||
| 651 | snd_soc_dapm_free(socdev); | ||
| 652 | pcm_err: | 646 | pcm_err: |
| 653 | return ret; | 647 | return ret; |
| 654 | } | 648 | } |
