1 /* 2 * tegra20_spdif.c - Tegra20 SPDIF driver 3 * 4 * Author: Stephen Warren <swarren@nvidia.com> 5 * Copyright (C) 2011-2012 - NVIDIA, Inc. 6 * 7 * This program is free software; you can redistribute it and/or 8 * modify it under the terms of the GNU General Public License 9 * version 2 as published by the Free Software Foundation. 10 * 11 * This program is distributed in the hope that it will be useful, but 12 * WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 14 * General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, write to the Free Software 18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 19 * 02110-1301 USA 20 * 21 */ 22 23 #include <linux/clk.h> 24 #include <linux/device.h> 25 #include <linux/io.h> 26 #include <linux/module.h> 27 #include <linux/platform_device.h> 28 #include <linux/pm_runtime.h> 29 #include <linux/regmap.h> 30 #include <linux/slab.h> 31 #include <sound/core.h> 32 #include <sound/pcm.h> 33 #include <sound/pcm_params.h> 34 #include <sound/soc.h> 35 #include <sound/dmaengine_pcm.h> 36 37 #include "tegra20_spdif.h" 38 39 #define DRV_NAME "tegra20-spdif" 40 41 static int tegra20_spdif_runtime_suspend(struct device *dev) 42 { 43 struct tegra20_spdif *spdif = dev_get_drvdata(dev); 44 45 clk_disable_unprepare(spdif->clk_spdif_out); 46 47 return 0; 48 } 49 50 static int tegra20_spdif_runtime_resume(struct device *dev) 51 { 52 struct tegra20_spdif *spdif = dev_get_drvdata(dev); 53 int ret; 54 55 ret = clk_prepare_enable(spdif->clk_spdif_out); 56 if (ret) { 57 dev_err(dev, "clk_enable failed: %d\n", ret); 58 return ret; 59 } 60 61 return 0; 62 } 63 64 static int tegra20_spdif_hw_params(struct snd_pcm_substream *substream, 65 struct snd_pcm_hw_params *params, 66 struct snd_soc_dai *dai) 67 { 68 struct device *dev = dai->dev; 69 struct tegra20_spdif *spdif = snd_soc_dai_get_drvdata(dai); 70 unsigned int mask = 0, val = 0; 71 int ret, spdifclock; 72 73 mask |= TEGRA20_SPDIF_CTRL_PACK | 74 TEGRA20_SPDIF_CTRL_BIT_MODE_MASK; 75 switch (params_format(params)) { 76 case SNDRV_PCM_FORMAT_S16_LE: 77 val |= TEGRA20_SPDIF_CTRL_PACK | 78 TEGRA20_SPDIF_CTRL_BIT_MODE_16BIT; 79 break; 80 default: 81 return -EINVAL; 82 } 83 84 regmap_update_bits(spdif->regmap, TEGRA20_SPDIF_CTRL, mask, val); 85 86 switch (params_rate(params)) { 87 case 32000: 88 spdifclock = 4096000; 89 break; 90 case 44100: 91 spdifclock = 5644800; 92 break; 93 case 48000: 94 spdifclock = 6144000; 95 break; 96 case 88200: 97 spdifclock = 11289600; 98 break; 99 case 96000: 100 spdifclock = 12288000; 101 break; 102 case 176400: 103 spdifclock = 22579200; 104 break; 105 case 192000: 106 spdifclock = 24576000; 107 break; 108 default: 109 return -EINVAL; 110 } 111 112 ret = clk_set_rate(spdif->clk_spdif_out, spdifclock); 113 if (ret) { 114 dev_err(dev, "Can't set SPDIF clock rate: %d\n", ret); 115 return ret; 116 } 117 118 return 0; 119 } 120 121 static void tegra20_spdif_start_playback(struct tegra20_spdif *spdif) 122 { 123 regmap_update_bits(spdif->regmap, TEGRA20_SPDIF_CTRL, 124 TEGRA20_SPDIF_CTRL_TX_EN, 125 TEGRA20_SPDIF_CTRL_TX_EN); 126 } 127 128 static void tegra20_spdif_stop_playback(struct tegra20_spdif *spdif) 129 { 130 regmap_update_bits(spdif->regmap, TEGRA20_SPDIF_CTRL, 131 TEGRA20_SPDIF_CTRL_TX_EN, 0); 132 } 133 134 static int tegra20_spdif_trigger(struct snd_pcm_substream *substream, int cmd, 135 struct snd_soc_dai *dai) 136 { 137 struct tegra20_spdif *spdif = snd_soc_dai_get_drvdata(dai); 138 139 switch (cmd) { 140 case SNDRV_PCM_TRIGGER_START: 141 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 142 case SNDRV_PCM_TRIGGER_RESUME: 143 tegra20_spdif_start_playback(spdif); 144 break; 145 case SNDRV_PCM_TRIGGER_STOP: 146 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 147 case SNDRV_PCM_TRIGGER_SUSPEND: 148 tegra20_spdif_stop_playback(spdif); 149 break; 150 default: 151 return -EINVAL; 152 } 153 154 return 0; 155 } 156 157 static int tegra20_spdif_probe(struct snd_soc_dai *dai) 158 { 159 struct tegra20_spdif *spdif = snd_soc_dai_get_drvdata(dai); 160 161 dai->capture_dma_data = NULL; 162 dai->playback_dma_data = &spdif->playback_dma_data; 163 164 return 0; 165 } 166 167 static const struct snd_soc_dai_ops tegra20_spdif_dai_ops = { 168 .hw_params = tegra20_spdif_hw_params, 169 .trigger = tegra20_spdif_trigger, 170 }; 171 172 static struct snd_soc_dai_driver tegra20_spdif_dai = { 173 .name = DRV_NAME, 174 .probe = tegra20_spdif_probe, 175 .playback = { 176 .stream_name = "Playback", 177 .channels_min = 2, 178 .channels_max = 2, 179 .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | 180 SNDRV_PCM_RATE_48000, 181 .formats = SNDRV_PCM_FMTBIT_S16_LE, 182 }, 183 .ops = &tegra20_spdif_dai_ops, 184 }; 185 186 static const struct snd_soc_component_driver tegra20_spdif_component = { 187 .name = DRV_NAME, 188 }; 189 190 static bool tegra20_spdif_wr_rd_reg(struct device *dev, unsigned int reg) 191 { 192 switch (reg) { 193 case TEGRA20_SPDIF_CTRL: 194 case TEGRA20_SPDIF_STATUS: 195 case TEGRA20_SPDIF_STROBE_CTRL: 196 case TEGRA20_SPDIF_DATA_FIFO_CSR: 197 case TEGRA20_SPDIF_DATA_OUT: 198 case TEGRA20_SPDIF_DATA_IN: 199 case TEGRA20_SPDIF_CH_STA_RX_A: 200 case TEGRA20_SPDIF_CH_STA_RX_B: 201 case TEGRA20_SPDIF_CH_STA_RX_C: 202 case TEGRA20_SPDIF_CH_STA_RX_D: 203 case TEGRA20_SPDIF_CH_STA_RX_E: 204 case TEGRA20_SPDIF_CH_STA_RX_F: 205 case TEGRA20_SPDIF_CH_STA_TX_A: 206 case TEGRA20_SPDIF_CH_STA_TX_B: 207 case TEGRA20_SPDIF_CH_STA_TX_C: 208 case TEGRA20_SPDIF_CH_STA_TX_D: 209 case TEGRA20_SPDIF_CH_STA_TX_E: 210 case TEGRA20_SPDIF_CH_STA_TX_F: 211 case TEGRA20_SPDIF_USR_STA_RX_A: 212 case TEGRA20_SPDIF_USR_DAT_TX_A: 213 return true; 214 default: 215 return false; 216 } 217 } 218 219 static bool tegra20_spdif_volatile_reg(struct device *dev, unsigned int reg) 220 { 221 switch (reg) { 222 case TEGRA20_SPDIF_STATUS: 223 case TEGRA20_SPDIF_DATA_FIFO_CSR: 224 case TEGRA20_SPDIF_DATA_OUT: 225 case TEGRA20_SPDIF_DATA_IN: 226 case TEGRA20_SPDIF_CH_STA_RX_A: 227 case TEGRA20_SPDIF_CH_STA_RX_B: 228 case TEGRA20_SPDIF_CH_STA_RX_C: 229 case TEGRA20_SPDIF_CH_STA_RX_D: 230 case TEGRA20_SPDIF_CH_STA_RX_E: 231 case TEGRA20_SPDIF_CH_STA_RX_F: 232 case TEGRA20_SPDIF_USR_STA_RX_A: 233 case TEGRA20_SPDIF_USR_DAT_TX_A: 234 return true; 235 default: 236 return false; 237 } 238 } 239 240 static bool tegra20_spdif_precious_reg(struct device *dev, unsigned int reg) 241 { 242 switch (reg) { 243 case TEGRA20_SPDIF_DATA_OUT: 244 case TEGRA20_SPDIF_DATA_IN: 245 case TEGRA20_SPDIF_USR_STA_RX_A: 246 case TEGRA20_SPDIF_USR_DAT_TX_A: 247 return true; 248 default: 249 return false; 250 } 251 } 252 253 static const struct regmap_config tegra20_spdif_regmap_config = { 254 .reg_bits = 32, 255 .reg_stride = 4, 256 .val_bits = 32, 257 .max_register = TEGRA20_SPDIF_USR_DAT_TX_A, 258 .writeable_reg = tegra20_spdif_wr_rd_reg, 259 .readable_reg = tegra20_spdif_wr_rd_reg, 260 .volatile_reg = tegra20_spdif_volatile_reg, 261 .precious_reg = tegra20_spdif_precious_reg, 262 .cache_type = REGCACHE_RBTREE, 263 }; 264 265 static int tegra20_spdif_platform_probe(struct platform_device *pdev) 266 { 267 struct tegra20_spdif *spdif; 268 struct resource *mem, *memregion, *dmareq; 269 void __iomem *regs; 270 int ret; 271 272 spdif = devm_kzalloc(&pdev->dev, sizeof(struct tegra20_spdif), 273 GFP_KERNEL); 274 if (!spdif) { 275 dev_err(&pdev->dev, "Can't allocate tegra20_spdif\n"); 276 ret = -ENOMEM; 277 goto err; 278 } 279 dev_set_drvdata(&pdev->dev, spdif); 280 281 spdif->clk_spdif_out = clk_get(&pdev->dev, "spdif_out"); 282 if (IS_ERR(spdif->clk_spdif_out)) { 283 pr_err("Can't retrieve spdif clock\n"); 284 ret = PTR_ERR(spdif->clk_spdif_out); 285 goto err; 286 } 287 288 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 289 if (!mem) { 290 dev_err(&pdev->dev, "No memory resource\n"); 291 ret = -ENODEV; 292 goto err_clk_put; 293 } 294 295 dmareq = platform_get_resource(pdev, IORESOURCE_DMA, 0); 296 if (!dmareq) { 297 dev_err(&pdev->dev, "No DMA resource\n"); 298 ret = -ENODEV; 299 goto err_clk_put; 300 } 301 302 memregion = devm_request_mem_region(&pdev->dev, mem->start, 303 resource_size(mem), DRV_NAME); 304 if (!memregion) { 305 dev_err(&pdev->dev, "Memory region already claimed\n"); 306 ret = -EBUSY; 307 goto err_clk_put; 308 } 309 310 regs = devm_ioremap(&pdev->dev, mem->start, resource_size(mem)); 311 if (!regs) { 312 dev_err(&pdev->dev, "ioremap failed\n"); 313 ret = -ENOMEM; 314 goto err_clk_put; 315 } 316 317 spdif->regmap = devm_regmap_init_mmio(&pdev->dev, regs, 318 &tegra20_spdif_regmap_config); 319 if (IS_ERR(spdif->regmap)) { 320 dev_err(&pdev->dev, "regmap init failed\n"); 321 ret = PTR_ERR(spdif->regmap); 322 goto err_clk_put; 323 } 324 325 spdif->playback_dma_data.addr = mem->start + TEGRA20_SPDIF_DATA_OUT; 326 spdif->playback_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; 327 spdif->playback_dma_data.maxburst = 4; 328 spdif->playback_dma_data.slave_id = dmareq->start; 329 330 pm_runtime_enable(&pdev->dev); 331 if (!pm_runtime_enabled(&pdev->dev)) { 332 ret = tegra20_spdif_runtime_resume(&pdev->dev); 333 if (ret) 334 goto err_pm_disable; 335 } 336 337 ret = snd_soc_register_component(&pdev->dev, &tegra20_spdif_component, 338 &tegra20_spdif_dai, 1); 339 if (ret) { 340 dev_err(&pdev->dev, "Could not register DAI: %d\n", ret); 341 ret = -ENOMEM; 342 goto err_suspend; 343 } 344 345 ret = tegra_pcm_platform_register(&pdev->dev); 346 if (ret) { 347 dev_err(&pdev->dev, "Could not register PCM: %d\n", ret); 348 goto err_unregister_component; 349 } 350 351 return 0; 352 353 err_unregister_component: 354 snd_soc_unregister_component(&pdev->dev); 355 err_suspend: 356 if (!pm_runtime_status_suspended(&pdev->dev)) 357 tegra20_spdif_runtime_suspend(&pdev->dev); 358 err_pm_disable: 359 pm_runtime_disable(&pdev->dev); 360 err_clk_put: 361 clk_put(spdif->clk_spdif_out); 362 err: 363 return ret; 364 } 365 366 static int tegra20_spdif_platform_remove(struct platform_device *pdev) 367 { 368 struct tegra20_spdif *spdif = dev_get_drvdata(&pdev->dev); 369 370 pm_runtime_disable(&pdev->dev); 371 if (!pm_runtime_status_suspended(&pdev->dev)) 372 tegra20_spdif_runtime_suspend(&pdev->dev); 373 374 tegra_pcm_platform_unregister(&pdev->dev); 375 snd_soc_unregister_component(&pdev->dev); 376 377 clk_put(spdif->clk_spdif_out); 378 379 return 0; 380 } 381 382 static const struct dev_pm_ops tegra20_spdif_pm_ops = { 383 SET_RUNTIME_PM_OPS(tegra20_spdif_runtime_suspend, 384 tegra20_spdif_runtime_resume, NULL) 385 }; 386 387 static struct platform_driver tegra20_spdif_driver = { 388 .driver = { 389 .name = DRV_NAME, 390 .owner = THIS_MODULE, 391 .pm = &tegra20_spdif_pm_ops, 392 }, 393 .probe = tegra20_spdif_platform_probe, 394 .remove = tegra20_spdif_platform_remove, 395 }; 396 397 module_platform_driver(tegra20_spdif_driver); 398 399 MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>"); 400 MODULE_DESCRIPTION("Tegra20 SPDIF ASoC driver"); 401 MODULE_LICENSE("GPL"); 402 MODULE_ALIAS("platform:" DRV_NAME); 403