Linux Audio

Check our new training course

Loading...
v6.2
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * tegra20_spdif.c - Tegra20 SPDIF driver
  4 *
  5 * Author: Stephen Warren <swarren@nvidia.com>
  6 * Copyright (C) 2011-2012 - NVIDIA, Inc.
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  7 */
  8
  9#include <linux/clk.h>
 10#include <linux/delay.h>
 11#include <linux/device.h>
 12#include <linux/io.h>
 13#include <linux/module.h>
 14#include <linux/of_device.h>
 15#include <linux/platform_device.h>
 16#include <linux/pm_runtime.h>
 17#include <linux/regmap.h>
 18#include <linux/reset.h>
 19#include <linux/slab.h>
 20#include <sound/core.h>
 21#include <sound/pcm.h>
 22#include <sound/pcm_params.h>
 23#include <sound/soc.h>
 24#include <sound/dmaengine_pcm.h>
 25
 26#include "tegra20_spdif.h"
 27
 28static __maybe_unused int tegra20_spdif_runtime_suspend(struct device *dev)
 
 
 
 29{
 30	struct tegra20_spdif *spdif = dev_get_drvdata(dev);
 
 31
 32	regcache_cache_only(spdif->regmap, true);
 
 
 
 
 
 33
 34	clk_disable_unprepare(spdif->clk_spdif_out);
 
 
 
 
 35
 36	return 0;
 37}
 38
 39static __maybe_unused int tegra20_spdif_runtime_resume(struct device *dev)
 40{
 41	struct tegra20_spdif *spdif = dev_get_drvdata(dev);
 42	int ret;
 43
 44	ret = reset_control_assert(spdif->reset);
 45	if (ret)
 46		return ret;
 47
 48	ret = clk_prepare_enable(spdif->clk_spdif_out);
 49	if (ret) {
 50		dev_err(dev, "clk_enable failed: %d\n", ret);
 51		return ret;
 52	}
 53
 54	usleep_range(10, 100);
 55
 56	ret = reset_control_deassert(spdif->reset);
 57	if (ret)
 58		goto disable_clocks;
 59
 60	regcache_cache_only(spdif->regmap, false);
 61	regcache_mark_dirty(spdif->regmap);
 62
 63	ret = regcache_sync(spdif->regmap);
 64	if (ret)
 65		goto disable_clocks;
 66
 67	return 0;
 68
 69disable_clocks:
 70	clk_disable_unprepare(spdif->clk_spdif_out);
 71
 72	return ret;
 73}
 74
 75static int tegra20_spdif_hw_params(struct snd_pcm_substream *substream,
 76				   struct snd_pcm_hw_params *params,
 77				   struct snd_soc_dai *dai)
 78{
 79	struct tegra20_spdif *spdif = dev_get_drvdata(dai->dev);
 80	unsigned int mask = 0, val = 0;
 81	int ret, spdifclock;
 82	long rate;
 83
 84	mask |= TEGRA20_SPDIF_CTRL_PACK |
 85		TEGRA20_SPDIF_CTRL_BIT_MODE_MASK;
 86	switch (params_format(params)) {
 87	case SNDRV_PCM_FORMAT_S16_LE:
 88		val |= TEGRA20_SPDIF_CTRL_PACK |
 89		       TEGRA20_SPDIF_CTRL_BIT_MODE_16BIT;
 90		break;
 91	default:
 92		return -EINVAL;
 93	}
 94
 95	regmap_update_bits(spdif->regmap, TEGRA20_SPDIF_CTRL, mask, val);
 96
 97	/*
 98	 * FIFO trigger level must be bigger than DMA burst or equal to it,
 99	 * otherwise data is discarded on overflow.
100	 */
101	regmap_update_bits(spdif->regmap, TEGRA20_SPDIF_DATA_FIFO_CSR,
102			   TEGRA20_SPDIF_DATA_FIFO_CSR_TX_ATN_LVL_MASK,
103			   TEGRA20_SPDIF_DATA_FIFO_CSR_TX_ATN_LVL_TU4_WORD_FULL);
104
105	switch (params_rate(params)) {
106	case 32000:
107		spdifclock = 4096000;
108		break;
109	case 44100:
110		spdifclock = 5644800;
111		break;
112	case 48000:
113		spdifclock = 6144000;
114		break;
115	case 88200:
116		spdifclock = 11289600;
117		break;
118	case 96000:
119		spdifclock = 12288000;
120		break;
121	case 176400:
122		spdifclock = 22579200;
123		break;
124	case 192000:
125		spdifclock = 24576000;
126		break;
127	default:
128		return -EINVAL;
129	}
130
131	ret = clk_set_rate(spdif->clk_spdif_out, spdifclock);
132	if (ret) {
133		dev_err(dai->dev, "Can't set SPDIF clock rate: %d\n", ret);
134		return ret;
135	}
136
137	rate = clk_get_rate(spdif->clk_spdif_out);
138	if (rate != spdifclock)
139		dev_warn_once(dai->dev,
140			      "SPDIF clock rate %d doesn't match requested rate %lu\n",
141			      spdifclock, rate);
142
143	return 0;
144}
145
146static void tegra20_spdif_start_playback(struct tegra20_spdif *spdif)
147{
148	regmap_update_bits(spdif->regmap, TEGRA20_SPDIF_CTRL,
149			   TEGRA20_SPDIF_CTRL_TX_EN,
150			   TEGRA20_SPDIF_CTRL_TX_EN);
151}
152
153static void tegra20_spdif_stop_playback(struct tegra20_spdif *spdif)
154{
155	regmap_update_bits(spdif->regmap, TEGRA20_SPDIF_CTRL,
156			   TEGRA20_SPDIF_CTRL_TX_EN, 0);
157}
158
159static int tegra20_spdif_trigger(struct snd_pcm_substream *substream, int cmd,
160				 struct snd_soc_dai *dai)
161{
162	struct tegra20_spdif *spdif = dev_get_drvdata(dai->dev);
163
164	switch (cmd) {
165	case SNDRV_PCM_TRIGGER_START:
166	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
167	case SNDRV_PCM_TRIGGER_RESUME:
168		tegra20_spdif_start_playback(spdif);
169		break;
170	case SNDRV_PCM_TRIGGER_STOP:
171	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
172	case SNDRV_PCM_TRIGGER_SUSPEND:
173		tegra20_spdif_stop_playback(spdif);
174		break;
175	default:
176		return -EINVAL;
177	}
178
179	return 0;
180}
181
182static int tegra20_spdif_filter_rates(struct snd_pcm_hw_params *params,
183				      struct snd_pcm_hw_rule *rule)
184{
185	struct snd_interval *r = hw_param_interval(params, rule->var);
186	struct snd_soc_dai *dai = rule->private;
187	struct tegra20_spdif *spdif = dev_get_drvdata(dai->dev);
188	struct clk *parent = clk_get_parent(spdif->clk_spdif_out);
189	static const unsigned int rates[] = { 32000, 44100, 48000 };
190	long i, parent_rate, valid_rates = 0;
191
192	parent_rate = clk_get_rate(parent);
193	if (parent_rate <= 0) {
194		dev_err(dai->dev, "Can't get parent clock rate: %ld\n",
195			parent_rate);
196		return parent_rate ?: -EINVAL;
197	}
198
199	for (i = 0; i < ARRAY_SIZE(rates); i++) {
200		if (parent_rate % (rates[i] * 128) == 0)
201			valid_rates |= BIT(i);
202	}
203
204	/*
205	 * At least one rate must be valid, otherwise the parent clock isn't
206	 * audio PLL. Nothing should be filtered in this case.
207	 */
208	if (!valid_rates)
209		valid_rates = BIT(ARRAY_SIZE(rates)) - 1;
210
211	return snd_interval_list(r, ARRAY_SIZE(rates), rates, valid_rates);
212}
213
214static int tegra20_spdif_startup(struct snd_pcm_substream *substream,
215				 struct snd_soc_dai *dai)
216{
217	if (!device_property_read_bool(dai->dev, "nvidia,fixed-parent-rate"))
218		return 0;
219
220	/*
221	 * SPDIF and I2S share audio PLL. HDMI takes audio packets from SPDIF
222	 * and audio may not work on some TVs if clock rate isn't precise.
223	 *
224	 * PLL rate is controlled by I2S side. Filter out audio rates that
225	 * don't match PLL rate at the start of stream to allow both SPDIF
226	 * and I2S work simultaneously, assuming that PLL rate won't be
227	 * changed later on.
228	 */
229	return snd_pcm_hw_rule_add(substream->runtime, 0,
230				   SNDRV_PCM_HW_PARAM_RATE,
231				   tegra20_spdif_filter_rates, dai,
232				   SNDRV_PCM_HW_PARAM_RATE, -1);
233}
234
235static int tegra20_spdif_probe(struct snd_soc_dai *dai)
236{
237	struct tegra20_spdif *spdif = dev_get_drvdata(dai->dev);
238
239	dai->capture_dma_data = NULL;
240	dai->playback_dma_data = &spdif->playback_dma_data;
241
242	return 0;
243}
244
245static const struct snd_soc_dai_ops tegra20_spdif_dai_ops = {
246	.hw_params = tegra20_spdif_hw_params,
247	.trigger = tegra20_spdif_trigger,
248	.startup = tegra20_spdif_startup,
249};
250
251static struct snd_soc_dai_driver tegra20_spdif_dai = {
252	.name = "tegra20-spdif",
253	.probe = tegra20_spdif_probe,
254	.playback = {
255		.stream_name = "Playback",
256		.channels_min = 2,
257		.channels_max = 2,
258		.rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
259			 SNDRV_PCM_RATE_48000,
260		.formats = SNDRV_PCM_FMTBIT_S16_LE,
261	},
262	.ops = &tegra20_spdif_dai_ops,
263};
264
265static const struct snd_soc_component_driver tegra20_spdif_component = {
266	.name = "tegra20-spdif",
267	.legacy_dai_naming = 1,
268};
269
270static bool tegra20_spdif_wr_rd_reg(struct device *dev, unsigned int reg)
271{
272	switch (reg) {
273	case TEGRA20_SPDIF_CTRL:
274	case TEGRA20_SPDIF_STATUS:
275	case TEGRA20_SPDIF_STROBE_CTRL:
276	case TEGRA20_SPDIF_DATA_FIFO_CSR:
277	case TEGRA20_SPDIF_DATA_OUT:
278	case TEGRA20_SPDIF_DATA_IN:
279	case TEGRA20_SPDIF_CH_STA_RX_A:
280	case TEGRA20_SPDIF_CH_STA_RX_B:
281	case TEGRA20_SPDIF_CH_STA_RX_C:
282	case TEGRA20_SPDIF_CH_STA_RX_D:
283	case TEGRA20_SPDIF_CH_STA_RX_E:
284	case TEGRA20_SPDIF_CH_STA_RX_F:
285	case TEGRA20_SPDIF_CH_STA_TX_A:
286	case TEGRA20_SPDIF_CH_STA_TX_B:
287	case TEGRA20_SPDIF_CH_STA_TX_C:
288	case TEGRA20_SPDIF_CH_STA_TX_D:
289	case TEGRA20_SPDIF_CH_STA_TX_E:
290	case TEGRA20_SPDIF_CH_STA_TX_F:
291	case TEGRA20_SPDIF_USR_STA_RX_A:
292	case TEGRA20_SPDIF_USR_DAT_TX_A:
293		return true;
294	default:
295		return false;
296	}
297}
298
299static bool tegra20_spdif_volatile_reg(struct device *dev, unsigned int reg)
300{
301	switch (reg) {
302	case TEGRA20_SPDIF_STATUS:
303	case TEGRA20_SPDIF_DATA_FIFO_CSR:
304	case TEGRA20_SPDIF_DATA_OUT:
305	case TEGRA20_SPDIF_DATA_IN:
306	case TEGRA20_SPDIF_CH_STA_RX_A:
307	case TEGRA20_SPDIF_CH_STA_RX_B:
308	case TEGRA20_SPDIF_CH_STA_RX_C:
309	case TEGRA20_SPDIF_CH_STA_RX_D:
310	case TEGRA20_SPDIF_CH_STA_RX_E:
311	case TEGRA20_SPDIF_CH_STA_RX_F:
312	case TEGRA20_SPDIF_USR_STA_RX_A:
313	case TEGRA20_SPDIF_USR_DAT_TX_A:
314		return true;
315	default:
316		return false;
317	}
318}
319
320static bool tegra20_spdif_precious_reg(struct device *dev, unsigned int reg)
321{
322	switch (reg) {
323	case TEGRA20_SPDIF_DATA_OUT:
324	case TEGRA20_SPDIF_DATA_IN:
325	case TEGRA20_SPDIF_USR_STA_RX_A:
326	case TEGRA20_SPDIF_USR_DAT_TX_A:
327		return true;
328	default:
329		return false;
330	}
331}
332
333static const struct regmap_config tegra20_spdif_regmap_config = {
334	.reg_bits = 32,
335	.reg_stride = 4,
336	.val_bits = 32,
337	.max_register = TEGRA20_SPDIF_USR_DAT_TX_A,
338	.writeable_reg = tegra20_spdif_wr_rd_reg,
339	.readable_reg = tegra20_spdif_wr_rd_reg,
340	.volatile_reg = tegra20_spdif_volatile_reg,
341	.precious_reg = tegra20_spdif_precious_reg,
342	.cache_type = REGCACHE_FLAT,
343};
344
345static int tegra20_spdif_platform_probe(struct platform_device *pdev)
346{
347	struct tegra20_spdif *spdif;
348	struct resource *mem;
349	void __iomem *regs;
350	int ret;
351
352	spdif = devm_kzalloc(&pdev->dev, sizeof(struct tegra20_spdif),
353			     GFP_KERNEL);
354	if (!spdif)
355		return -ENOMEM;
356
357	dev_set_drvdata(&pdev->dev, spdif);
358
359	spdif->reset = devm_reset_control_get_exclusive(&pdev->dev, NULL);
360	if (IS_ERR(spdif->reset)) {
361		dev_err(&pdev->dev, "Can't retrieve spdif reset\n");
362		return PTR_ERR(spdif->reset);
363	}
 
364
365	spdif->clk_spdif_out = devm_clk_get(&pdev->dev, "out");
366	if (IS_ERR(spdif->clk_spdif_out)) {
367		dev_err(&pdev->dev, "Could not retrieve spdif clock\n");
368		return PTR_ERR(spdif->clk_spdif_out);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
369	}
370
371	regs = devm_platform_get_and_ioremap_resource(pdev, 0, &mem);
372	if (IS_ERR(regs))
373		return PTR_ERR(regs);
374
375	spdif->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
376					      &tegra20_spdif_regmap_config);
377	if (IS_ERR(spdif->regmap)) {
378		dev_err(&pdev->dev, "regmap init failed\n");
379		return PTR_ERR(spdif->regmap);
 
380	}
381
382	spdif->playback_dma_data.addr = mem->start + TEGRA20_SPDIF_DATA_OUT;
383	spdif->playback_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
384	spdif->playback_dma_data.maxburst = 4;
385
386	ret = devm_pm_runtime_enable(&pdev->dev);
387	if (ret)
388		return ret;
 
 
 
 
389
390	ret = devm_snd_soc_register_component(&pdev->dev,
391					      &tegra20_spdif_component,
392					      &tegra20_spdif_dai, 1);
393	if (ret) {
394		dev_err(&pdev->dev, "Could not register DAI: %d\n", ret);
395		return ret;
 
396	}
397
398	ret = devm_tegra_pcm_platform_register(&pdev->dev);
399	if (ret) {
400		dev_err(&pdev->dev, "Could not register PCM: %d\n", ret);
401		return ret;
402	}
403
404	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
405}
406
407static const struct dev_pm_ops tegra20_spdif_pm_ops = {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
408	SET_RUNTIME_PM_OPS(tegra20_spdif_runtime_suspend,
409			   tegra20_spdif_runtime_resume, NULL)
410	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
411				pm_runtime_force_resume)
412};
413
414static const struct of_device_id tegra20_spdif_of_match[] = {
415	{ .compatible = "nvidia,tegra20-spdif", },
416	{},
417};
418MODULE_DEVICE_TABLE(of, tegra20_spdif_of_match);
419
420static struct platform_driver tegra20_spdif_driver = {
421	.driver = {
422		.name = "tegra20-spdif",
 
423		.pm = &tegra20_spdif_pm_ops,
424		.of_match_table = tegra20_spdif_of_match,
425	},
426	.probe = tegra20_spdif_platform_probe,
 
427};
 
428module_platform_driver(tegra20_spdif_driver);
429
430MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
431MODULE_DESCRIPTION("Tegra20 SPDIF ASoC driver");
432MODULE_LICENSE("GPL");
v3.5.6
 
  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
 36#include "tegra20_spdif.h"
 37
 38#define DRV_NAME "tegra20-spdif"
 39
 40static inline void tegra20_spdif_write(struct tegra20_spdif *spdif, u32 reg,
 41					u32 val)
 42{
 43	regmap_write(spdif->regmap, reg, val);
 44}
 45
 46static inline u32 tegra20_spdif_read(struct tegra20_spdif *spdif, u32 reg)
 47{
 48	u32 val;
 49	regmap_read(spdif->regmap, reg, &val);
 50	return val;
 51}
 52
 53static int tegra20_spdif_runtime_suspend(struct device *dev)
 54{
 55	struct tegra20_spdif *spdif = dev_get_drvdata(dev);
 56
 57	clk_disable(spdif->clk_spdif_out);
 58
 59	return 0;
 60}
 61
 62static int tegra20_spdif_runtime_resume(struct device *dev)
 63{
 64	struct tegra20_spdif *spdif = dev_get_drvdata(dev);
 65	int ret;
 66
 67	ret = clk_enable(spdif->clk_spdif_out);
 
 
 
 
 68	if (ret) {
 69		dev_err(dev, "clk_enable failed: %d\n", ret);
 70		return ret;
 71	}
 72
 
 
 
 
 
 
 
 
 
 
 
 
 
 73	return 0;
 
 
 
 
 
 74}
 75
 76static int tegra20_spdif_hw_params(struct snd_pcm_substream *substream,
 77				struct snd_pcm_hw_params *params,
 78				struct snd_soc_dai *dai)
 79{
 80	struct device *dev = substream->pcm->card->dev;
 81	struct tegra20_spdif *spdif = snd_soc_dai_get_drvdata(dai);
 82	int ret, spdifclock;
 
 83
 84	spdif->reg_ctrl &= ~TEGRA20_SPDIF_CTRL_PACK;
 85	spdif->reg_ctrl &= ~TEGRA20_SPDIF_CTRL_BIT_MODE_MASK;
 86	switch (params_format(params)) {
 87	case SNDRV_PCM_FORMAT_S16_LE:
 88		spdif->reg_ctrl |= TEGRA20_SPDIF_CTRL_PACK;
 89		spdif->reg_ctrl |= TEGRA20_SPDIF_CTRL_BIT_MODE_16BIT;
 90		break;
 91	default:
 92		return -EINVAL;
 93	}
 94
 
 
 
 
 
 
 
 
 
 
 95	switch (params_rate(params)) {
 96	case 32000:
 97		spdifclock = 4096000;
 98		break;
 99	case 44100:
100		spdifclock = 5644800;
101		break;
102	case 48000:
103		spdifclock = 6144000;
104		break;
105	case 88200:
106		spdifclock = 11289600;
107		break;
108	case 96000:
109		spdifclock = 12288000;
110		break;
111	case 176400:
112		spdifclock = 22579200;
113		break;
114	case 192000:
115		spdifclock = 24576000;
116		break;
117	default:
118		return -EINVAL;
119	}
120
121	ret = clk_set_rate(spdif->clk_spdif_out, spdifclock);
122	if (ret) {
123		dev_err(dev, "Can't set SPDIF clock rate: %d\n", ret);
124		return ret;
125	}
126
 
 
 
 
 
 
127	return 0;
128}
129
130static void tegra20_spdif_start_playback(struct tegra20_spdif *spdif)
131{
132	spdif->reg_ctrl |= TEGRA20_SPDIF_CTRL_TX_EN;
133	tegra20_spdif_write(spdif, TEGRA20_SPDIF_CTRL, spdif->reg_ctrl);
 
134}
135
136static void tegra20_spdif_stop_playback(struct tegra20_spdif *spdif)
137{
138	spdif->reg_ctrl &= ~TEGRA20_SPDIF_CTRL_TX_EN;
139	tegra20_spdif_write(spdif, TEGRA20_SPDIF_CTRL, spdif->reg_ctrl);
140}
141
142static int tegra20_spdif_trigger(struct snd_pcm_substream *substream, int cmd,
143				struct snd_soc_dai *dai)
144{
145	struct tegra20_spdif *spdif = snd_soc_dai_get_drvdata(dai);
146
147	switch (cmd) {
148	case SNDRV_PCM_TRIGGER_START:
149	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
150	case SNDRV_PCM_TRIGGER_RESUME:
151		tegra20_spdif_start_playback(spdif);
152		break;
153	case SNDRV_PCM_TRIGGER_STOP:
154	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
155	case SNDRV_PCM_TRIGGER_SUSPEND:
156		tegra20_spdif_stop_playback(spdif);
157		break;
158	default:
159		return -EINVAL;
160	}
161
162	return 0;
163}
164
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
165static int tegra20_spdif_probe(struct snd_soc_dai *dai)
166{
167	struct tegra20_spdif *spdif = snd_soc_dai_get_drvdata(dai);
168
169	dai->capture_dma_data = NULL;
170	dai->playback_dma_data = &spdif->playback_dma_data;
171
172	return 0;
173}
174
175static const struct snd_soc_dai_ops tegra20_spdif_dai_ops = {
176	.hw_params	= tegra20_spdif_hw_params,
177	.trigger	= tegra20_spdif_trigger,
 
178};
179
180static struct snd_soc_dai_driver tegra20_spdif_dai = {
181	.name = DRV_NAME,
182	.probe = tegra20_spdif_probe,
183	.playback = {
 
184		.channels_min = 2,
185		.channels_max = 2,
186		.rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
187				SNDRV_PCM_RATE_48000,
188		.formats = SNDRV_PCM_FMTBIT_S16_LE,
189	},
190	.ops = &tegra20_spdif_dai_ops,
191};
192
 
 
 
 
 
193static bool tegra20_spdif_wr_rd_reg(struct device *dev, unsigned int reg)
194{
195	switch (reg) {
196	case TEGRA20_SPDIF_CTRL:
197	case TEGRA20_SPDIF_STATUS:
198	case TEGRA20_SPDIF_STROBE_CTRL:
199	case TEGRA20_SPDIF_DATA_FIFO_CSR:
200	case TEGRA20_SPDIF_DATA_OUT:
201	case TEGRA20_SPDIF_DATA_IN:
202	case TEGRA20_SPDIF_CH_STA_RX_A:
203	case TEGRA20_SPDIF_CH_STA_RX_B:
204	case TEGRA20_SPDIF_CH_STA_RX_C:
205	case TEGRA20_SPDIF_CH_STA_RX_D:
206	case TEGRA20_SPDIF_CH_STA_RX_E:
207	case TEGRA20_SPDIF_CH_STA_RX_F:
208	case TEGRA20_SPDIF_CH_STA_TX_A:
209	case TEGRA20_SPDIF_CH_STA_TX_B:
210	case TEGRA20_SPDIF_CH_STA_TX_C:
211	case TEGRA20_SPDIF_CH_STA_TX_D:
212	case TEGRA20_SPDIF_CH_STA_TX_E:
213	case TEGRA20_SPDIF_CH_STA_TX_F:
214	case TEGRA20_SPDIF_USR_STA_RX_A:
215	case TEGRA20_SPDIF_USR_DAT_TX_A:
216		return true;
217	default:
218		return false;
219	};
220}
221
222static bool tegra20_spdif_volatile_reg(struct device *dev, unsigned int reg)
223{
224	switch (reg) {
225	case TEGRA20_SPDIF_STATUS:
226	case TEGRA20_SPDIF_DATA_FIFO_CSR:
227	case TEGRA20_SPDIF_DATA_OUT:
228	case TEGRA20_SPDIF_DATA_IN:
229	case TEGRA20_SPDIF_CH_STA_RX_A:
230	case TEGRA20_SPDIF_CH_STA_RX_B:
231	case TEGRA20_SPDIF_CH_STA_RX_C:
232	case TEGRA20_SPDIF_CH_STA_RX_D:
233	case TEGRA20_SPDIF_CH_STA_RX_E:
234	case TEGRA20_SPDIF_CH_STA_RX_F:
235	case TEGRA20_SPDIF_USR_STA_RX_A:
236	case TEGRA20_SPDIF_USR_DAT_TX_A:
237		return true;
238	default:
239		return false;
240	};
241}
242
243static bool tegra20_spdif_precious_reg(struct device *dev, unsigned int reg)
244{
245	switch (reg) {
246	case TEGRA20_SPDIF_DATA_OUT:
247	case TEGRA20_SPDIF_DATA_IN:
248	case TEGRA20_SPDIF_USR_STA_RX_A:
249	case TEGRA20_SPDIF_USR_DAT_TX_A:
250		return true;
251	default:
252		return false;
253	};
254}
255
256static const struct regmap_config tegra20_spdif_regmap_config = {
257	.reg_bits = 32,
258	.reg_stride = 4,
259	.val_bits = 32,
260	.max_register = TEGRA20_SPDIF_USR_DAT_TX_A,
261	.writeable_reg = tegra20_spdif_wr_rd_reg,
262	.readable_reg = tegra20_spdif_wr_rd_reg,
263	.volatile_reg = tegra20_spdif_volatile_reg,
264	.precious_reg = tegra20_spdif_precious_reg,
265	.cache_type = REGCACHE_RBTREE,
266};
267
268static __devinit int tegra20_spdif_platform_probe(struct platform_device *pdev)
269{
270	struct tegra20_spdif *spdif;
271	struct resource *mem, *memregion, *dmareq;
272	void __iomem *regs;
273	int ret;
274
275	spdif = devm_kzalloc(&pdev->dev, sizeof(struct tegra20_spdif),
276			     GFP_KERNEL);
277	if (!spdif) {
278		dev_err(&pdev->dev, "Can't allocate tegra20_spdif\n");
279		ret = -ENOMEM;
280		goto err;
 
 
 
 
 
281	}
282	dev_set_drvdata(&pdev->dev, spdif);
283
284	spdif->clk_spdif_out = clk_get(&pdev->dev, "spdif_out");
285	if (IS_ERR(spdif->clk_spdif_out)) {
286		pr_err("Can't retrieve spdif clock\n");
287		ret = PTR_ERR(spdif->clk_spdif_out);
288		goto err;
289	}
290
291	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
292	if (!mem) {
293		dev_err(&pdev->dev, "No memory resource\n");
294		ret = -ENODEV;
295		goto err_clk_put;
296	}
297
298	dmareq = platform_get_resource(pdev, IORESOURCE_DMA, 0);
299	if (!dmareq) {
300		dev_err(&pdev->dev, "No DMA resource\n");
301		ret = -ENODEV;
302		goto err_clk_put;
303	}
304
305	memregion = devm_request_mem_region(&pdev->dev, mem->start,
306					    resource_size(mem), DRV_NAME);
307	if (!memregion) {
308		dev_err(&pdev->dev, "Memory region already claimed\n");
309		ret = -EBUSY;
310		goto err_clk_put;
311	}
312
313	regs = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
314	if (!regs) {
315		dev_err(&pdev->dev, "ioremap failed\n");
316		ret = -ENOMEM;
317		goto err_clk_put;
318	}
319
 
 
 
 
320	spdif->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
321					    &tegra20_spdif_regmap_config);
322	if (IS_ERR(spdif->regmap)) {
323		dev_err(&pdev->dev, "regmap init failed\n");
324		ret = PTR_ERR(spdif->regmap);
325		goto err_clk_put;
326	}
327
328	spdif->playback_dma_data.addr = mem->start + TEGRA20_SPDIF_DATA_OUT;
329	spdif->playback_dma_data.wrap = 4;
330	spdif->playback_dma_data.width = 32;
331	spdif->playback_dma_data.req_sel = dmareq->start;
332
333	pm_runtime_enable(&pdev->dev);
334	if (!pm_runtime_enabled(&pdev->dev)) {
335		ret = tegra20_spdif_runtime_resume(&pdev->dev);
336		if (ret)
337			goto err_pm_disable;
338	}
339
340	ret = snd_soc_register_dai(&pdev->dev, &tegra20_spdif_dai);
 
 
341	if (ret) {
342		dev_err(&pdev->dev, "Could not register DAI: %d\n", ret);
343		ret = -ENOMEM;
344		goto err_suspend;
345	}
346
347	ret = tegra_pcm_platform_register(&pdev->dev);
348	if (ret) {
349		dev_err(&pdev->dev, "Could not register PCM: %d\n", ret);
350		goto err_unregister_dai;
351	}
352
353	return 0;
354
355err_unregister_dai:
356	snd_soc_unregister_dai(&pdev->dev);
357err_suspend:
358	if (!pm_runtime_status_suspended(&pdev->dev))
359		tegra20_spdif_runtime_suspend(&pdev->dev);
360err_pm_disable:
361	pm_runtime_disable(&pdev->dev);
362err_clk_put:
363	clk_put(spdif->clk_spdif_out);
364err:
365	return ret;
366}
367
368static int __devexit tegra20_spdif_platform_remove(struct platform_device *pdev)
369{
370	struct tegra20_spdif *spdif = dev_get_drvdata(&pdev->dev);
371
372	pm_runtime_disable(&pdev->dev);
373	if (!pm_runtime_status_suspended(&pdev->dev))
374		tegra20_spdif_runtime_suspend(&pdev->dev);
375
376	tegra_pcm_platform_unregister(&pdev->dev);
377	snd_soc_unregister_dai(&pdev->dev);
378
379	clk_put(spdif->clk_spdif_out);
380
381	return 0;
382}
383
384static const struct dev_pm_ops tegra20_spdif_pm_ops __devinitconst = {
385	SET_RUNTIME_PM_OPS(tegra20_spdif_runtime_suspend,
386			   tegra20_spdif_runtime_resume, NULL)
 
 
387};
388
 
 
 
 
 
 
389static struct platform_driver tegra20_spdif_driver = {
390	.driver = {
391		.name = DRV_NAME,
392		.owner = THIS_MODULE,
393		.pm = &tegra20_spdif_pm_ops,
 
394	},
395	.probe = tegra20_spdif_platform_probe,
396	.remove = __devexit_p(tegra20_spdif_platform_remove),
397};
398
399module_platform_driver(tegra20_spdif_driver);
400
401MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
402MODULE_DESCRIPTION("Tegra20 SPDIF ASoC driver");
403MODULE_LICENSE("GPL");
404MODULE_ALIAS("platform:" DRV_NAME);