sound/soc/rockchip/rk_hdmi_spdif.c

   1 /*$_FOR_ROCKCHIP_RBOX_$*/
   2 /*$_rbox_$_modify_$_huangzhibao for spdif output*/
   3
   4 /*
   5  * smdk_spdif.c  --  S/PDIF audio for SMDK
   6  *
   7  * Copyright 2010 Samsung Electronics Co. Ltd.
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License as
  11  * published by the Free Software Foundation; either version 2 of the
  12  * License, or (at your option) any later version.
  13  *
  14  */
  15
  16 #include <linux/module.h>
  17 #include <linux/device.h>
  18 #include <linux/of.h>
  19 #include <linux/of_gpio.h>
  20 #include <linux/clk.h>
  21 #include <sound/core.h>
  22 #include <sound/pcm.h>
  23 #include <sound/soc.h>
  24 #include <sound/soc-dapm.h>
  25
  26 #include "card_info.h"
  27 #include "rk_pcm.h"
  28
  29
  30 #if 0
  31 #define RK_SPDIF_DBG(x...) printk(KERN_INFO "rk_hdmi_spdif:"x)
  32 #else
  33 #define RK_SPDIF_DBG(x...) do { } while (0)
  34 #endif
  35
  36
  37 static int set_audio_clock_rate(unsigned long pll_rate,
  38                                 unsigned long audio_rate)
  39 {
  40         struct clk *sclk_spdif;
  41 #if defined (CONFIG_ARCH_RK30) || defined (CONFIG_ARCH_RK3188)
  42         struct clk *hclk_spdif;
  43 #endif
  44
  45 #if defined (CONFIG_ARCH_RK30) || defined (CONFIG_ARCH_RK3188)
  46         hclk_spdif = clk_get(NULL, "hclk_spdif");
  47         if (IS_ERR(hclk_spdif)) {
  48                 printk(KERN_ERR "spdif:failed to get hclk_spdif\n");
  49                 return -ENOENT;
  50         }
  51
  52         clk_set_rate(hclk_spdif, pll_rate);
  53         clk_put(hclk_spdif);
  54 #endif
  55
  56         sclk_spdif = clk_get(NULL, "spdif");
  57         if (IS_ERR(sclk_spdif)) {
  58                 printk(KERN_ERR "spdif:failed to get sclk_spdif\n");
  59                 return -ENOENT;
  60         }
  61
  62         clk_set_rate(sclk_spdif, audio_rate);
  63         clk_put(sclk_spdif);
  64
  65         return 0;
  66 }
  67
  68 static int rk_hw_params(struct snd_pcm_substream *substream,
  69                 struct snd_pcm_hw_params *params)
  70 {
  71         struct snd_soc_pcm_runtime *rtd = substream->private_data;
  72         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
  73         struct snd_soc_dai *codec_dai = rtd->codec_dai;
  74         unsigned long pll_out, rclk_rate, dai_fmt = rtd->dai_link->dai_fmt;
  75         int ret, ratio;
  76
  77         RK_SPDIF_DBG("spdif:Entered %s\n", __func__);
  78
  79         return 0;
  80
  81         /* set codec DAI configuration */
  82         ret = snd_soc_dai_set_fmt(codec_dai, dai_fmt);
  83         if (ret < 0) {
  84                 printk("%s():failed to set the format for codec side\n", __func__);
  85                 return ret;
  86         }
  87
  88         /* set cpu DAI configuration */
  89         ret = snd_soc_dai_set_fmt(cpu_dai, dai_fmt);
  90         if (ret < 0) {
  91                 printk("%s():failed to set the format for cpu side\n", __func__);
  92                 return ret;
  93         }
  94
  95         switch (params_rate(params)) {
  96         case 44100:
  97                 pll_out = 11289600;
  98                 break;
  99         case 32000:
 100                 pll_out = 8192000;
 101                 break;
 102         case 48000:
 103                 pll_out = 12288000;
 104                 break;
 105         case 96000:
 106                 pll_out = 24576000;
 107                 break;
 108         default:
 109                 printk("rk_spdif: params not support\n");
 110                 return -EINVAL;
 111         }
 112
 113         ratio = 256;
 114         rclk_rate = params_rate(params) * ratio;
 115
 116         /* Set audio source clock rates */
 117         ret = set_audio_clock_rate(pll_out, rclk_rate);
 118         if (ret < 0)
 119                 return ret;
 120
 121         /* Set S/PDIF uses internal source clock */
 122         //ret = snd_soc_dai_set_sysclk(cpu_dai, SND_SOC_SPDIF_INT_MCLK,
 123                                         //rclk_rate, SND_SOC_CLOCK_IN);
 124         //if (ret < 0)
 125                 //return ret;
 126
 127         return ret;
 128 }
 129
 130 static struct snd_soc_ops rk_spdif_ops = {
 131         .hw_params = rk_hw_params,
 132 };
 133
 134 static struct snd_soc_dai_link rk_dai = {
 135         .name = "SPDIF",
 136         .stream_name = "SPDIF PCM Playback",
 137         .codec_dai_name = "rk-hdmi-spdif-hifi",
 138         .ops = &rk_spdif_ops,
 139 };
 140
 141 static struct snd_soc_card rockchip_hdmi_spdif_snd_card = {
 142         .name = "RK-HDMI-SPDIF",
 143         .dai_link = &rk_dai,
 144         .num_links = 1,
 145 };
 146
 147 static int rockchip_hdmi_spdif_audio_probe(struct platform_device *pdev)
 148 {
 149         int ret;
 150         struct snd_soc_card *card = &rockchip_hdmi_spdif_snd_card;
 151
 152         card->dev = &pdev->dev;
 153
 154         ret = rockchip_of_get_sound_card_info_(card, false);
 155         if (ret) {
 156                 printk("%s() get sound card info failed:%d\n", __FUNCTION__, ret);
 157                 return ret;
 158         }
 159
 160         ret = snd_soc_register_card(card);
 161
 162         if (ret)
 163                 printk("%s() register card failed:%d\n", __FUNCTION__, ret);
 164
 165         return ret;
 166 }
 167
 168 static int rockchip_hdmi_spdif_audio_remove(struct platform_device *pdev)
 169 {
 170         struct snd_soc_card *card = platform_get_drvdata(pdev);
 171
 172         snd_soc_unregister_card(card);
 173
 174         return 0;
 175 }
 176
 177 #ifdef CONFIG_OF
 178 static const struct of_device_id rockchip_hdmi_spdif_of_match[] = {
 179         { .compatible = "rockchip-hdmi-spdif"},
 180         {},
 181 };
 182 MODULE_DEVICE_TABLE(of, rockchip_hdmi_spdif_of_match);
 183 #endif /* CONFIG_OF */
 184
 185 static struct platform_driver rockchip_hdmi_spdif_audio_driver = {
 186         .driver         = {
 187                 .name   = "rockchip-hdmi-spdif",
 188                 .owner  = THIS_MODULE,
 189                 .pm = &snd_soc_pm_ops,
 190                 .of_match_table = of_match_ptr(rockchip_hdmi_spdif_of_match),
 191         },
 192         .probe          = rockchip_hdmi_spdif_audio_probe,
 193         .remove         = rockchip_hdmi_spdif_audio_remove,
 194 };
 195
 196 module_platform_driver(rockchip_hdmi_spdif_audio_driver);
 197
 198 MODULE_AUTHOR("hzb, <hzb@rock-chips.com>");
 199 MODULE_DESCRIPTION("ALSA SoC RK+S/PDIF");
 200 MODULE_LICENSE("GPL");