mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-10-29 23:28:52 +01:00
Fixed MTP to work with TWRP
This commit is contained in:
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
17
sound/soc/kirkwood/Kconfig
Normal file
17
sound/soc/kirkwood/Kconfig
Normal file
|
|
@ -0,0 +1,17 @@
|
|||
config SND_KIRKWOOD_SOC
|
||||
tristate "SoC Audio for the Marvell Kirkwood and Dove chips"
|
||||
depends on ARCH_DOVE || ARCH_MVEBU || COMPILE_TEST
|
||||
help
|
||||
Say Y or M if you want to add support for codecs attached to
|
||||
the Kirkwood I2S interface. You will also need to select the
|
||||
audio interfaces to support below.
|
||||
|
||||
config SND_KIRKWOOD_SOC_ARMADA370_DB
|
||||
tristate "SoC Audio support for Armada 370 DB"
|
||||
depends on SND_KIRKWOOD_SOC && (ARCH_MVEBU || COMPILE_TEST) && I2C
|
||||
select SND_SOC_CS42L51
|
||||
select SND_SOC_SPDIF
|
||||
help
|
||||
Say Y if you want to add support for SoC audio on
|
||||
the Armada 370 Development Board.
|
||||
|
||||
7
sound/soc/kirkwood/Makefile
Normal file
7
sound/soc/kirkwood/Makefile
Normal file
|
|
@ -0,0 +1,7 @@
|
|||
snd-soc-kirkwood-objs := kirkwood-dma.o kirkwood-i2s.o
|
||||
|
||||
obj-$(CONFIG_SND_KIRKWOOD_SOC) += snd-soc-kirkwood.o
|
||||
|
||||
snd-soc-armada-370-db-objs := armada-370-db.o
|
||||
|
||||
obj-$(CONFIG_SND_KIRKWOOD_SOC_ARMADA370_DB) += snd-soc-armada-370-db.o
|
||||
148
sound/soc/kirkwood/armada-370-db.c
Normal file
148
sound/soc/kirkwood/armada-370-db.c
Normal file
|
|
@ -0,0 +1,148 @@
|
|||
/*
|
||||
* Copyright (C) 2014 Marvell
|
||||
*
|
||||
* Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or
|
||||
* modify it under the terms of the GNU General Public License as
|
||||
* published by the Free Software Foundation; either version 2 of the
|
||||
* License, or (at your option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/slab.h>
|
||||
#include <sound/soc.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/platform_data/asoc-kirkwood.h>
|
||||
#include "../codecs/cs42l51.h"
|
||||
|
||||
static int a370db_hw_params(struct snd_pcm_substream *substream,
|
||||
struct snd_pcm_hw_params *params)
|
||||
{
|
||||
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
||||
struct snd_soc_dai *codec_dai = rtd->codec_dai;
|
||||
unsigned int freq;
|
||||
|
||||
switch (params_rate(params)) {
|
||||
default:
|
||||
case 44100:
|
||||
freq = 11289600;
|
||||
break;
|
||||
case 48000:
|
||||
freq = 12288000;
|
||||
break;
|
||||
case 96000:
|
||||
freq = 24576000;
|
||||
break;
|
||||
}
|
||||
|
||||
return snd_soc_dai_set_sysclk(codec_dai, 0, freq, SND_SOC_CLOCK_IN);
|
||||
}
|
||||
|
||||
static struct snd_soc_ops a370db_ops = {
|
||||
.hw_params = a370db_hw_params,
|
||||
};
|
||||
|
||||
static const struct snd_soc_dapm_widget a370db_dapm_widgets[] = {
|
||||
SND_SOC_DAPM_HP("Out Jack", NULL),
|
||||
SND_SOC_DAPM_LINE("In Jack", NULL),
|
||||
};
|
||||
|
||||
static const struct snd_soc_dapm_route a370db_route[] = {
|
||||
{ "Out Jack", NULL, "HPL" },
|
||||
{ "Out Jack", NULL, "HPR" },
|
||||
{ "AIN1L", NULL, "In Jack" },
|
||||
{ "AIN1L", NULL, "In Jack" },
|
||||
};
|
||||
|
||||
static struct snd_soc_dai_link a370db_dai[] = {
|
||||
{
|
||||
.name = "CS42L51",
|
||||
.stream_name = "analog",
|
||||
.cpu_dai_name = "i2s",
|
||||
.codec_dai_name = "cs42l51-hifi",
|
||||
.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_CBS_CFS,
|
||||
.ops = &a370db_ops,
|
||||
},
|
||||
{
|
||||
.name = "S/PDIF out",
|
||||
.stream_name = "spdif-out",
|
||||
.cpu_dai_name = "spdif",
|
||||
.codec_dai_name = "dit-hifi",
|
||||
.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_CBS_CFS,
|
||||
},
|
||||
{
|
||||
.name = "S/PDIF in",
|
||||
.stream_name = "spdif-in",
|
||||
.cpu_dai_name = "spdif",
|
||||
.codec_dai_name = "dir-hifi",
|
||||
.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_CBS_CFS,
|
||||
},
|
||||
};
|
||||
|
||||
static struct snd_soc_card a370db = {
|
||||
.name = "a370db",
|
||||
.owner = THIS_MODULE,
|
||||
.dai_link = a370db_dai,
|
||||
.num_links = ARRAY_SIZE(a370db_dai),
|
||||
.dapm_widgets = a370db_dapm_widgets,
|
||||
.num_dapm_widgets = ARRAY_SIZE(a370db_dapm_widgets),
|
||||
.dapm_routes = a370db_route,
|
||||
.num_dapm_routes = ARRAY_SIZE(a370db_route),
|
||||
};
|
||||
|
||||
static int a370db_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct snd_soc_card *card = &a370db;
|
||||
|
||||
card->dev = &pdev->dev;
|
||||
|
||||
a370db_dai[0].cpu_of_node =
|
||||
of_parse_phandle(pdev->dev.of_node,
|
||||
"marvell,audio-controller", 0);
|
||||
a370db_dai[0].platform_of_node = a370db_dai[0].cpu_of_node;
|
||||
|
||||
a370db_dai[0].codec_of_node =
|
||||
of_parse_phandle(pdev->dev.of_node,
|
||||
"marvell,audio-codec", 0);
|
||||
|
||||
a370db_dai[1].cpu_of_node = a370db_dai[0].cpu_of_node;
|
||||
a370db_dai[1].platform_of_node = a370db_dai[0].cpu_of_node;
|
||||
|
||||
a370db_dai[1].codec_of_node =
|
||||
of_parse_phandle(pdev->dev.of_node,
|
||||
"marvell,audio-codec", 1);
|
||||
|
||||
a370db_dai[2].cpu_of_node = a370db_dai[0].cpu_of_node;
|
||||
a370db_dai[2].platform_of_node = a370db_dai[0].cpu_of_node;
|
||||
|
||||
a370db_dai[2].codec_of_node =
|
||||
of_parse_phandle(pdev->dev.of_node,
|
||||
"marvell,audio-codec", 2);
|
||||
|
||||
return devm_snd_soc_register_card(card->dev, card);
|
||||
}
|
||||
|
||||
static const struct of_device_id a370db_dt_ids[] = {
|
||||
{ .compatible = "marvell,a370db-audio" },
|
||||
{ },
|
||||
};
|
||||
|
||||
static struct platform_driver a370db_driver = {
|
||||
.driver = {
|
||||
.name = "a370db-audio",
|
||||
.owner = THIS_MODULE,
|
||||
.of_match_table = of_match_ptr(a370db_dt_ids),
|
||||
},
|
||||
.probe = a370db_probe,
|
||||
};
|
||||
|
||||
module_platform_driver(a370db_driver);
|
||||
|
||||
MODULE_AUTHOR("Thomas Petazzoni <thomas.petazzoni@free-electrons.com>");
|
||||
MODULE_DESCRIPTION("ALSA SoC a370db audio client");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_ALIAS("platform:a370db-audio");
|
||||
321
sound/soc/kirkwood/kirkwood-dma.c
Normal file
321
sound/soc/kirkwood/kirkwood-dma.c
Normal file
|
|
@ -0,0 +1,321 @@
|
|||
/*
|
||||
* kirkwood-dma.c
|
||||
*
|
||||
* (c) 2010 Arnaud Patard <apatard@mandriva.com>
|
||||
* (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/dma-mapping.h>
|
||||
#include <linux/mbus.h>
|
||||
#include <sound/soc.h>
|
||||
#include "kirkwood.h"
|
||||
|
||||
static struct kirkwood_dma_data *kirkwood_priv(struct snd_pcm_substream *subs)
|
||||
{
|
||||
struct snd_soc_pcm_runtime *soc_runtime = subs->private_data;
|
||||
return snd_soc_dai_get_drvdata(soc_runtime->cpu_dai);
|
||||
}
|
||||
|
||||
static struct snd_pcm_hardware kirkwood_dma_snd_hw = {
|
||||
.info = SNDRV_PCM_INFO_INTERLEAVED |
|
||||
SNDRV_PCM_INFO_MMAP |
|
||||
SNDRV_PCM_INFO_MMAP_VALID |
|
||||
SNDRV_PCM_INFO_BLOCK_TRANSFER |
|
||||
SNDRV_PCM_INFO_PAUSE |
|
||||
SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,
|
||||
.buffer_bytes_max = KIRKWOOD_SND_MAX_BUFFER_BYTES,
|
||||
.period_bytes_min = KIRKWOOD_SND_MIN_PERIOD_BYTES,
|
||||
.period_bytes_max = KIRKWOOD_SND_MAX_PERIOD_BYTES,
|
||||
.periods_min = KIRKWOOD_SND_MIN_PERIODS,
|
||||
.periods_max = KIRKWOOD_SND_MAX_PERIODS,
|
||||
.fifo_size = 0,
|
||||
};
|
||||
|
||||
static irqreturn_t kirkwood_dma_irq(int irq, void *dev_id)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = dev_id;
|
||||
unsigned long mask, status, cause;
|
||||
|
||||
mask = readl(priv->io + KIRKWOOD_INT_MASK);
|
||||
status = readl(priv->io + KIRKWOOD_INT_CAUSE) & mask;
|
||||
|
||||
cause = readl(priv->io + KIRKWOOD_ERR_CAUSE);
|
||||
if (unlikely(cause)) {
|
||||
printk(KERN_WARNING "%s: got err interrupt 0x%lx\n",
|
||||
__func__, cause);
|
||||
writel(cause, priv->io + KIRKWOOD_ERR_CAUSE);
|
||||
}
|
||||
|
||||
/* we've enabled only bytes interrupts ... */
|
||||
if (status & ~(KIRKWOOD_INT_CAUSE_PLAY_BYTES | \
|
||||
KIRKWOOD_INT_CAUSE_REC_BYTES)) {
|
||||
printk(KERN_WARNING "%s: unexpected interrupt %lx\n",
|
||||
__func__, status);
|
||||
return IRQ_NONE;
|
||||
}
|
||||
|
||||
/* ack int */
|
||||
writel(status, priv->io + KIRKWOOD_INT_CAUSE);
|
||||
|
||||
if (status & KIRKWOOD_INT_CAUSE_PLAY_BYTES)
|
||||
snd_pcm_period_elapsed(priv->substream_play);
|
||||
|
||||
if (status & KIRKWOOD_INT_CAUSE_REC_BYTES)
|
||||
snd_pcm_period_elapsed(priv->substream_rec);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static void
|
||||
kirkwood_dma_conf_mbus_windows(void __iomem *base, int win,
|
||||
unsigned long dma,
|
||||
const struct mbus_dram_target_info *dram)
|
||||
{
|
||||
int i;
|
||||
|
||||
/* First disable and clear windows */
|
||||
writel(0, base + KIRKWOOD_AUDIO_WIN_CTRL_REG(win));
|
||||
writel(0, base + KIRKWOOD_AUDIO_WIN_BASE_REG(win));
|
||||
|
||||
/* try to find matching cs for current dma address */
|
||||
for (i = 0; i < dram->num_cs; i++) {
|
||||
const struct mbus_dram_window *cs = dram->cs + i;
|
||||
if ((cs->base & 0xffff0000) < (dma & 0xffff0000)) {
|
||||
writel(cs->base & 0xffff0000,
|
||||
base + KIRKWOOD_AUDIO_WIN_BASE_REG(win));
|
||||
writel(((cs->size - 1) & 0xffff0000) |
|
||||
(cs->mbus_attr << 8) |
|
||||
(dram->mbus_dram_target_id << 4) | 1,
|
||||
base + KIRKWOOD_AUDIO_WIN_CTRL_REG(win));
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static int kirkwood_dma_open(struct snd_pcm_substream *substream)
|
||||
{
|
||||
int err;
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
struct kirkwood_dma_data *priv = kirkwood_priv(substream);
|
||||
const struct mbus_dram_target_info *dram;
|
||||
unsigned long addr;
|
||||
|
||||
snd_soc_set_runtime_hwparams(substream, &kirkwood_dma_snd_hw);
|
||||
|
||||
/* Ensure that all constraints linked to dma burst are fulfilled */
|
||||
err = snd_pcm_hw_constraint_minmax(runtime,
|
||||
SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
|
||||
priv->burst * 2,
|
||||
KIRKWOOD_AUDIO_BUF_MAX-1);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
err = snd_pcm_hw_constraint_step(runtime, 0,
|
||||
SNDRV_PCM_HW_PARAM_BUFFER_BYTES,
|
||||
priv->burst);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
err = snd_pcm_hw_constraint_step(substream->runtime, 0,
|
||||
SNDRV_PCM_HW_PARAM_PERIOD_BYTES,
|
||||
priv->burst);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
if (!priv->substream_play && !priv->substream_rec) {
|
||||
err = request_irq(priv->irq, kirkwood_dma_irq, IRQF_SHARED,
|
||||
"kirkwood-i2s", priv);
|
||||
if (err)
|
||||
return -EBUSY;
|
||||
|
||||
/*
|
||||
* Enable Error interrupts. We're only ack'ing them but
|
||||
* it's useful for diagnostics
|
||||
*/
|
||||
writel((unsigned int)-1, priv->io + KIRKWOOD_ERR_MASK);
|
||||
}
|
||||
|
||||
dram = mv_mbus_dram_info();
|
||||
addr = substream->dma_buffer.addr;
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
||||
priv->substream_play = substream;
|
||||
kirkwood_dma_conf_mbus_windows(priv->io,
|
||||
KIRKWOOD_PLAYBACK_WIN, addr, dram);
|
||||
} else {
|
||||
priv->substream_rec = substream;
|
||||
kirkwood_dma_conf_mbus_windows(priv->io,
|
||||
KIRKWOOD_RECORD_WIN, addr, dram);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_dma_close(struct snd_pcm_substream *substream)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = kirkwood_priv(substream);
|
||||
|
||||
if (!priv)
|
||||
return 0;
|
||||
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
||||
priv->substream_play = NULL;
|
||||
else
|
||||
priv->substream_rec = NULL;
|
||||
|
||||
if (!priv->substream_play && !priv->substream_rec) {
|
||||
writel(0, priv->io + KIRKWOOD_ERR_MASK);
|
||||
free_irq(priv->irq, priv);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_dma_hw_params(struct snd_pcm_substream *substream,
|
||||
struct snd_pcm_hw_params *params)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
|
||||
snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
|
||||
runtime->dma_bytes = params_buffer_bytes(params);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_dma_hw_free(struct snd_pcm_substream *substream)
|
||||
{
|
||||
snd_pcm_set_runtime_buffer(substream, NULL);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_dma_prepare(struct snd_pcm_substream *substream)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
struct kirkwood_dma_data *priv = kirkwood_priv(substream);
|
||||
unsigned long size, count;
|
||||
|
||||
/* compute buffer size in term of "words" as requested in specs */
|
||||
size = frames_to_bytes(runtime, runtime->buffer_size);
|
||||
size = (size>>2)-1;
|
||||
count = snd_pcm_lib_period_bytes(substream);
|
||||
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
||||
writel(count, priv->io + KIRKWOOD_PLAY_BYTE_INT_COUNT);
|
||||
writel(runtime->dma_addr, priv->io + KIRKWOOD_PLAY_BUF_ADDR);
|
||||
writel(size, priv->io + KIRKWOOD_PLAY_BUF_SIZE);
|
||||
} else {
|
||||
writel(count, priv->io + KIRKWOOD_REC_BYTE_INT_COUNT);
|
||||
writel(runtime->dma_addr, priv->io + KIRKWOOD_REC_BUF_ADDR);
|
||||
writel(size, priv->io + KIRKWOOD_REC_BUF_SIZE);
|
||||
}
|
||||
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static snd_pcm_uframes_t kirkwood_dma_pointer(struct snd_pcm_substream
|
||||
*substream)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = kirkwood_priv(substream);
|
||||
snd_pcm_uframes_t count;
|
||||
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
||||
count = bytes_to_frames(substream->runtime,
|
||||
readl(priv->io + KIRKWOOD_PLAY_BYTE_COUNT));
|
||||
else
|
||||
count = bytes_to_frames(substream->runtime,
|
||||
readl(priv->io + KIRKWOOD_REC_BYTE_COUNT));
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static struct snd_pcm_ops kirkwood_dma_ops = {
|
||||
.open = kirkwood_dma_open,
|
||||
.close = kirkwood_dma_close,
|
||||
.ioctl = snd_pcm_lib_ioctl,
|
||||
.hw_params = kirkwood_dma_hw_params,
|
||||
.hw_free = kirkwood_dma_hw_free,
|
||||
.prepare = kirkwood_dma_prepare,
|
||||
.pointer = kirkwood_dma_pointer,
|
||||
};
|
||||
|
||||
static int kirkwood_dma_preallocate_dma_buffer(struct snd_pcm *pcm,
|
||||
int stream)
|
||||
{
|
||||
struct snd_pcm_substream *substream = pcm->streams[stream].substream;
|
||||
struct snd_dma_buffer *buf = &substream->dma_buffer;
|
||||
size_t size = kirkwood_dma_snd_hw.buffer_bytes_max;
|
||||
|
||||
buf->dev.type = SNDRV_DMA_TYPE_DEV;
|
||||
buf->dev.dev = pcm->card->dev;
|
||||
buf->area = dma_alloc_coherent(pcm->card->dev, size,
|
||||
&buf->addr, GFP_KERNEL);
|
||||
if (!buf->area)
|
||||
return -ENOMEM;
|
||||
buf->bytes = size;
|
||||
buf->private_data = NULL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_dma_new(struct snd_soc_pcm_runtime *rtd)
|
||||
{
|
||||
struct snd_card *card = rtd->card->snd_card;
|
||||
struct snd_pcm *pcm = rtd->pcm;
|
||||
int ret;
|
||||
|
||||
ret = dma_coerce_mask_and_coherent(card->dev, DMA_BIT_MASK(32));
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream) {
|
||||
ret = kirkwood_dma_preallocate_dma_buffer(pcm,
|
||||
SNDRV_PCM_STREAM_PLAYBACK);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream) {
|
||||
ret = kirkwood_dma_preallocate_dma_buffer(pcm,
|
||||
SNDRV_PCM_STREAM_CAPTURE);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void kirkwood_dma_free_dma_buffers(struct snd_pcm *pcm)
|
||||
{
|
||||
struct snd_pcm_substream *substream;
|
||||
struct snd_dma_buffer *buf;
|
||||
int stream;
|
||||
|
||||
for (stream = 0; stream < 2; stream++) {
|
||||
substream = pcm->streams[stream].substream;
|
||||
if (!substream)
|
||||
continue;
|
||||
buf = &substream->dma_buffer;
|
||||
if (!buf->area)
|
||||
continue;
|
||||
|
||||
dma_free_coherent(pcm->card->dev, buf->bytes,
|
||||
buf->area, buf->addr);
|
||||
buf->area = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
struct snd_soc_platform_driver kirkwood_soc_platform = {
|
||||
.ops = &kirkwood_dma_ops,
|
||||
.pcm_new = kirkwood_dma_new,
|
||||
.pcm_free = kirkwood_dma_free_dma_buffers,
|
||||
};
|
||||
671
sound/soc/kirkwood/kirkwood-i2s.c
Normal file
671
sound/soc/kirkwood/kirkwood-i2s.c
Normal file
|
|
@ -0,0 +1,671 @@
|
|||
/*
|
||||
* kirkwood-i2s.c
|
||||
*
|
||||
* (c) 2010 Arnaud Patard <apatard@mandriva.com>
|
||||
* (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/mbus.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/clk.h>
|
||||
#include <sound/pcm.h>
|
||||
#include <sound/pcm_params.h>
|
||||
#include <sound/soc.h>
|
||||
#include <linux/platform_data/asoc-kirkwood.h>
|
||||
#include <linux/of.h>
|
||||
|
||||
#include "kirkwood.h"
|
||||
|
||||
#define DRV_NAME "mvebu-audio"
|
||||
|
||||
#define KIRKWOOD_I2S_FORMATS \
|
||||
(SNDRV_PCM_FMTBIT_S16_LE | \
|
||||
SNDRV_PCM_FMTBIT_S24_LE | \
|
||||
SNDRV_PCM_FMTBIT_S32_LE)
|
||||
|
||||
#define KIRKWOOD_SPDIF_FORMATS \
|
||||
(SNDRV_PCM_FMTBIT_S16_LE | \
|
||||
SNDRV_PCM_FMTBIT_S24_LE)
|
||||
|
||||
static int kirkwood_i2s_set_fmt(struct snd_soc_dai *cpu_dai,
|
||||
unsigned int fmt)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(cpu_dai);
|
||||
unsigned long mask;
|
||||
unsigned long value;
|
||||
|
||||
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
||||
case SND_SOC_DAIFMT_RIGHT_J:
|
||||
mask = KIRKWOOD_I2S_CTL_RJ;
|
||||
break;
|
||||
case SND_SOC_DAIFMT_LEFT_J:
|
||||
mask = KIRKWOOD_I2S_CTL_LJ;
|
||||
break;
|
||||
case SND_SOC_DAIFMT_I2S:
|
||||
mask = KIRKWOOD_I2S_CTL_I2S;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/*
|
||||
* Set same format for playback and record
|
||||
* This avoids some troubles.
|
||||
*/
|
||||
value = readl(priv->io+KIRKWOOD_I2S_PLAYCTL);
|
||||
value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
|
||||
value |= mask;
|
||||
writel(value, priv->io+KIRKWOOD_I2S_PLAYCTL);
|
||||
|
||||
value = readl(priv->io+KIRKWOOD_I2S_RECCTL);
|
||||
value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
|
||||
value |= mask;
|
||||
writel(value, priv->io+KIRKWOOD_I2S_RECCTL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static inline void kirkwood_set_dco(void __iomem *io, unsigned long rate)
|
||||
{
|
||||
unsigned long value;
|
||||
|
||||
value = KIRKWOOD_DCO_CTL_OFFSET_0;
|
||||
switch (rate) {
|
||||
default:
|
||||
case 44100:
|
||||
value |= KIRKWOOD_DCO_CTL_FREQ_11;
|
||||
break;
|
||||
case 48000:
|
||||
value |= KIRKWOOD_DCO_CTL_FREQ_12;
|
||||
break;
|
||||
case 96000:
|
||||
value |= KIRKWOOD_DCO_CTL_FREQ_24;
|
||||
break;
|
||||
}
|
||||
writel(value, io + KIRKWOOD_DCO_CTL);
|
||||
|
||||
/* wait for dco locked */
|
||||
do {
|
||||
cpu_relax();
|
||||
value = readl(io + KIRKWOOD_DCO_SPCR_STATUS);
|
||||
value &= KIRKWOOD_DCO_SPCR_STATUS_DCO_LOCK;
|
||||
} while (value == 0);
|
||||
}
|
||||
|
||||
static void kirkwood_set_rate(struct snd_soc_dai *dai,
|
||||
struct kirkwood_dma_data *priv, unsigned long rate)
|
||||
{
|
||||
uint32_t clks_ctrl;
|
||||
|
||||
if (IS_ERR(priv->extclk)) {
|
||||
/* use internal dco for the supported rates
|
||||
* defined in kirkwood_i2s_dai */
|
||||
dev_dbg(dai->dev, "%s: dco set rate = %lu\n",
|
||||
__func__, rate);
|
||||
kirkwood_set_dco(priv->io, rate);
|
||||
|
||||
clks_ctrl = KIRKWOOD_MCLK_SOURCE_DCO;
|
||||
} else {
|
||||
/* use the external clock for the other rates
|
||||
* defined in kirkwood_i2s_dai_extclk */
|
||||
dev_dbg(dai->dev, "%s: extclk set rate = %lu -> %lu\n",
|
||||
__func__, rate, 256 * rate);
|
||||
clk_set_rate(priv->extclk, 256 * rate);
|
||||
|
||||
clks_ctrl = KIRKWOOD_MCLK_SOURCE_EXTCLK;
|
||||
}
|
||||
writel(clks_ctrl, priv->io + KIRKWOOD_CLOCKS_CTRL);
|
||||
}
|
||||
|
||||
static int kirkwood_i2s_startup(struct snd_pcm_substream *substream,
|
||||
struct snd_soc_dai *dai)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
|
||||
|
||||
snd_soc_dai_set_dma_data(dai, substream, priv);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_i2s_hw_params(struct snd_pcm_substream *substream,
|
||||
struct snd_pcm_hw_params *params,
|
||||
struct snd_soc_dai *dai)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
|
||||
uint32_t ctl_play, ctl_rec;
|
||||
unsigned int i2s_reg;
|
||||
unsigned long i2s_value;
|
||||
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
||||
i2s_reg = KIRKWOOD_I2S_PLAYCTL;
|
||||
} else {
|
||||
i2s_reg = KIRKWOOD_I2S_RECCTL;
|
||||
}
|
||||
|
||||
kirkwood_set_rate(dai, priv, params_rate(params));
|
||||
|
||||
i2s_value = readl(priv->io+i2s_reg);
|
||||
i2s_value &= ~KIRKWOOD_I2S_CTL_SIZE_MASK;
|
||||
|
||||
/*
|
||||
* Size settings in play/rec i2s control regs and play/rec control
|
||||
* regs must be the same.
|
||||
*/
|
||||
switch (params_format(params)) {
|
||||
case SNDRV_PCM_FORMAT_S16_LE:
|
||||
i2s_value |= KIRKWOOD_I2S_CTL_SIZE_16;
|
||||
ctl_play = KIRKWOOD_PLAYCTL_SIZE_16_C |
|
||||
KIRKWOOD_PLAYCTL_I2S_EN |
|
||||
KIRKWOOD_PLAYCTL_SPDIF_EN;
|
||||
ctl_rec = KIRKWOOD_RECCTL_SIZE_16_C |
|
||||
KIRKWOOD_RECCTL_I2S_EN |
|
||||
KIRKWOOD_RECCTL_SPDIF_EN;
|
||||
break;
|
||||
/*
|
||||
* doesn't work... S20_3LE != kirkwood 20bit format ?
|
||||
*
|
||||
case SNDRV_PCM_FORMAT_S20_3LE:
|
||||
i2s_value |= KIRKWOOD_I2S_CTL_SIZE_20;
|
||||
ctl_play = KIRKWOOD_PLAYCTL_SIZE_20 |
|
||||
KIRKWOOD_PLAYCTL_I2S_EN;
|
||||
ctl_rec = KIRKWOOD_RECCTL_SIZE_20 |
|
||||
KIRKWOOD_RECCTL_I2S_EN;
|
||||
break;
|
||||
*/
|
||||
case SNDRV_PCM_FORMAT_S24_LE:
|
||||
i2s_value |= KIRKWOOD_I2S_CTL_SIZE_24;
|
||||
ctl_play = KIRKWOOD_PLAYCTL_SIZE_24 |
|
||||
KIRKWOOD_PLAYCTL_I2S_EN |
|
||||
KIRKWOOD_PLAYCTL_SPDIF_EN;
|
||||
ctl_rec = KIRKWOOD_RECCTL_SIZE_24 |
|
||||
KIRKWOOD_RECCTL_I2S_EN |
|
||||
KIRKWOOD_RECCTL_SPDIF_EN;
|
||||
break;
|
||||
case SNDRV_PCM_FORMAT_S32_LE:
|
||||
i2s_value |= KIRKWOOD_I2S_CTL_SIZE_32;
|
||||
ctl_play = KIRKWOOD_PLAYCTL_SIZE_32 |
|
||||
KIRKWOOD_PLAYCTL_I2S_EN;
|
||||
ctl_rec = KIRKWOOD_RECCTL_SIZE_32 |
|
||||
KIRKWOOD_RECCTL_I2S_EN;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
||||
if (params_channels(params) == 1)
|
||||
ctl_play |= KIRKWOOD_PLAYCTL_MONO_BOTH;
|
||||
else
|
||||
ctl_play |= KIRKWOOD_PLAYCTL_MONO_OFF;
|
||||
|
||||
priv->ctl_play &= ~(KIRKWOOD_PLAYCTL_MONO_MASK |
|
||||
KIRKWOOD_PLAYCTL_ENABLE_MASK |
|
||||
KIRKWOOD_PLAYCTL_SIZE_MASK);
|
||||
priv->ctl_play |= ctl_play;
|
||||
} else {
|
||||
priv->ctl_rec &= ~(KIRKWOOD_RECCTL_ENABLE_MASK |
|
||||
KIRKWOOD_RECCTL_SIZE_MASK);
|
||||
priv->ctl_rec |= ctl_rec;
|
||||
}
|
||||
|
||||
writel(i2s_value, priv->io+i2s_reg);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static unsigned kirkwood_i2s_play_mute(unsigned ctl)
|
||||
{
|
||||
if (!(ctl & KIRKWOOD_PLAYCTL_I2S_EN))
|
||||
ctl |= KIRKWOOD_PLAYCTL_I2S_MUTE;
|
||||
if (!(ctl & KIRKWOOD_PLAYCTL_SPDIF_EN))
|
||||
ctl |= KIRKWOOD_PLAYCTL_SPDIF_MUTE;
|
||||
return ctl;
|
||||
}
|
||||
|
||||
static int kirkwood_i2s_play_trigger(struct snd_pcm_substream *substream,
|
||||
int cmd, struct snd_soc_dai *dai)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
|
||||
uint32_t ctl, value;
|
||||
|
||||
ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
|
||||
if ((ctl & KIRKWOOD_PLAYCTL_ENABLE_MASK) == 0) {
|
||||
unsigned timeout = 5000;
|
||||
/*
|
||||
* The Armada510 spec says that if we enter pause mode, the
|
||||
* busy bit must be read back as clear _twice_. Make sure
|
||||
* we respect that otherwise we get DMA underruns.
|
||||
*/
|
||||
do {
|
||||
value = ctl;
|
||||
ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
|
||||
if (!((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY))
|
||||
break;
|
||||
udelay(1);
|
||||
} while (timeout--);
|
||||
|
||||
if ((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY)
|
||||
dev_notice(dai->dev, "timed out waiting for busy to deassert: %08x\n",
|
||||
ctl);
|
||||
}
|
||||
|
||||
switch (cmd) {
|
||||
case SNDRV_PCM_TRIGGER_START:
|
||||
/* configure */
|
||||
ctl = priv->ctl_play;
|
||||
if (dai->id == 0)
|
||||
ctl &= ~KIRKWOOD_PLAYCTL_SPDIF_EN; /* i2s */
|
||||
else
|
||||
ctl &= ~KIRKWOOD_PLAYCTL_I2S_EN; /* spdif */
|
||||
ctl = kirkwood_i2s_play_mute(ctl);
|
||||
value = ctl & ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
|
||||
writel(value, priv->io + KIRKWOOD_PLAYCTL);
|
||||
|
||||
/* enable interrupts */
|
||||
if (!runtime->no_period_wakeup) {
|
||||
value = readl(priv->io + KIRKWOOD_INT_MASK);
|
||||
value |= KIRKWOOD_INT_CAUSE_PLAY_BYTES;
|
||||
writel(value, priv->io + KIRKWOOD_INT_MASK);
|
||||
}
|
||||
|
||||
/* enable playback */
|
||||
writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
|
||||
break;
|
||||
|
||||
case SNDRV_PCM_TRIGGER_STOP:
|
||||
/* stop audio, disable interrupts */
|
||||
ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
|
||||
KIRKWOOD_PLAYCTL_SPDIF_MUTE;
|
||||
writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
|
||||
|
||||
value = readl(priv->io + KIRKWOOD_INT_MASK);
|
||||
value &= ~KIRKWOOD_INT_CAUSE_PLAY_BYTES;
|
||||
writel(value, priv->io + KIRKWOOD_INT_MASK);
|
||||
|
||||
/* disable all playbacks */
|
||||
ctl &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
|
||||
writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
|
||||
break;
|
||||
|
||||
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
||||
case SNDRV_PCM_TRIGGER_SUSPEND:
|
||||
ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
|
||||
KIRKWOOD_PLAYCTL_SPDIF_MUTE;
|
||||
writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
|
||||
break;
|
||||
|
||||
case SNDRV_PCM_TRIGGER_RESUME:
|
||||
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
||||
ctl &= ~(KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
|
||||
KIRKWOOD_PLAYCTL_SPDIF_MUTE);
|
||||
ctl = kirkwood_i2s_play_mute(ctl);
|
||||
writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
|
||||
break;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_i2s_rec_trigger(struct snd_pcm_substream *substream,
|
||||
int cmd, struct snd_soc_dai *dai)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
|
||||
uint32_t ctl, value;
|
||||
|
||||
value = readl(priv->io + KIRKWOOD_RECCTL);
|
||||
|
||||
switch (cmd) {
|
||||
case SNDRV_PCM_TRIGGER_START:
|
||||
/* configure */
|
||||
ctl = priv->ctl_rec;
|
||||
if (dai->id == 0)
|
||||
ctl &= ~KIRKWOOD_RECCTL_SPDIF_EN; /* i2s */
|
||||
else
|
||||
ctl &= ~KIRKWOOD_RECCTL_I2S_EN; /* spdif */
|
||||
|
||||
value = ctl & ~KIRKWOOD_RECCTL_ENABLE_MASK;
|
||||
writel(value, priv->io + KIRKWOOD_RECCTL);
|
||||
|
||||
/* enable interrupts */
|
||||
value = readl(priv->io + KIRKWOOD_INT_MASK);
|
||||
value |= KIRKWOOD_INT_CAUSE_REC_BYTES;
|
||||
writel(value, priv->io + KIRKWOOD_INT_MASK);
|
||||
|
||||
/* enable record */
|
||||
writel(ctl, priv->io + KIRKWOOD_RECCTL);
|
||||
break;
|
||||
|
||||
case SNDRV_PCM_TRIGGER_STOP:
|
||||
/* stop audio, disable interrupts */
|
||||
value = readl(priv->io + KIRKWOOD_RECCTL);
|
||||
value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
|
||||
writel(value, priv->io + KIRKWOOD_RECCTL);
|
||||
|
||||
value = readl(priv->io + KIRKWOOD_INT_MASK);
|
||||
value &= ~KIRKWOOD_INT_CAUSE_REC_BYTES;
|
||||
writel(value, priv->io + KIRKWOOD_INT_MASK);
|
||||
|
||||
/* disable all records */
|
||||
value = readl(priv->io + KIRKWOOD_RECCTL);
|
||||
value &= ~KIRKWOOD_RECCTL_ENABLE_MASK;
|
||||
writel(value, priv->io + KIRKWOOD_RECCTL);
|
||||
break;
|
||||
|
||||
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
|
||||
case SNDRV_PCM_TRIGGER_SUSPEND:
|
||||
value = readl(priv->io + KIRKWOOD_RECCTL);
|
||||
value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
|
||||
writel(value, priv->io + KIRKWOOD_RECCTL);
|
||||
break;
|
||||
|
||||
case SNDRV_PCM_TRIGGER_RESUME:
|
||||
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
|
||||
value = readl(priv->io + KIRKWOOD_RECCTL);
|
||||
value &= ~(KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE);
|
||||
writel(value, priv->io + KIRKWOOD_RECCTL);
|
||||
break;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
|
||||
struct snd_soc_dai *dai)
|
||||
{
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
||||
return kirkwood_i2s_play_trigger(substream, cmd, dai);
|
||||
else
|
||||
return kirkwood_i2s_rec_trigger(substream, cmd, dai);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int kirkwood_i2s_init(struct kirkwood_dma_data *priv)
|
||||
{
|
||||
unsigned long value;
|
||||
unsigned int reg_data;
|
||||
|
||||
/* put system in a "safe" state : */
|
||||
/* disable audio interrupts */
|
||||
writel(0xffffffff, priv->io + KIRKWOOD_INT_CAUSE);
|
||||
writel(0, priv->io + KIRKWOOD_INT_MASK);
|
||||
|
||||
reg_data = readl(priv->io + 0x1200);
|
||||
reg_data &= (~(0x333FF8));
|
||||
reg_data |= 0x111D18;
|
||||
writel(reg_data, priv->io + 0x1200);
|
||||
|
||||
msleep(500);
|
||||
|
||||
reg_data = readl(priv->io + 0x1200);
|
||||
reg_data &= (~(0x333FF8));
|
||||
reg_data |= 0x111D18;
|
||||
writel(reg_data, priv->io + 0x1200);
|
||||
|
||||
/* disable playback/record */
|
||||
value = readl(priv->io + KIRKWOOD_PLAYCTL);
|
||||
value &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
|
||||
writel(value, priv->io + KIRKWOOD_PLAYCTL);
|
||||
|
||||
value = readl(priv->io + KIRKWOOD_RECCTL);
|
||||
value &= ~KIRKWOOD_RECCTL_ENABLE_MASK;
|
||||
writel(value, priv->io + KIRKWOOD_RECCTL);
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
static const struct snd_soc_dai_ops kirkwood_i2s_dai_ops = {
|
||||
.startup = kirkwood_i2s_startup,
|
||||
.trigger = kirkwood_i2s_trigger,
|
||||
.hw_params = kirkwood_i2s_hw_params,
|
||||
.set_fmt = kirkwood_i2s_set_fmt,
|
||||
};
|
||||
|
||||
static struct snd_soc_dai_driver kirkwood_i2s_dai[2] = {
|
||||
{
|
||||
.name = "i2s",
|
||||
.id = 0,
|
||||
.playback = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
|
||||
SNDRV_PCM_RATE_96000,
|
||||
.formats = KIRKWOOD_I2S_FORMATS,
|
||||
},
|
||||
.capture = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
|
||||
SNDRV_PCM_RATE_96000,
|
||||
.formats = KIRKWOOD_I2S_FORMATS,
|
||||
},
|
||||
.ops = &kirkwood_i2s_dai_ops,
|
||||
},
|
||||
{
|
||||
.name = "spdif",
|
||||
.id = 1,
|
||||
.playback = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
|
||||
SNDRV_PCM_RATE_96000,
|
||||
.formats = KIRKWOOD_SPDIF_FORMATS,
|
||||
},
|
||||
.capture = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
|
||||
SNDRV_PCM_RATE_96000,
|
||||
.formats = KIRKWOOD_SPDIF_FORMATS,
|
||||
},
|
||||
.ops = &kirkwood_i2s_dai_ops,
|
||||
},
|
||||
};
|
||||
|
||||
static struct snd_soc_dai_driver kirkwood_i2s_dai_extclk[2] = {
|
||||
{
|
||||
.name = "i2s",
|
||||
.id = 0,
|
||||
.playback = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_CONTINUOUS,
|
||||
.rate_min = 5512,
|
||||
.rate_max = 192000,
|
||||
.formats = KIRKWOOD_I2S_FORMATS,
|
||||
},
|
||||
.capture = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_CONTINUOUS,
|
||||
.rate_min = 5512,
|
||||
.rate_max = 192000,
|
||||
.formats = KIRKWOOD_I2S_FORMATS,
|
||||
},
|
||||
.ops = &kirkwood_i2s_dai_ops,
|
||||
},
|
||||
{
|
||||
.name = "spdif",
|
||||
.id = 1,
|
||||
.playback = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_CONTINUOUS,
|
||||
.rate_min = 5512,
|
||||
.rate_max = 192000,
|
||||
.formats = KIRKWOOD_SPDIF_FORMATS,
|
||||
},
|
||||
.capture = {
|
||||
.channels_min = 1,
|
||||
.channels_max = 2,
|
||||
.rates = SNDRV_PCM_RATE_CONTINUOUS,
|
||||
.rate_min = 5512,
|
||||
.rate_max = 192000,
|
||||
.formats = KIRKWOOD_SPDIF_FORMATS,
|
||||
},
|
||||
.ops = &kirkwood_i2s_dai_ops,
|
||||
},
|
||||
};
|
||||
|
||||
static const struct snd_soc_component_driver kirkwood_i2s_component = {
|
||||
.name = DRV_NAME,
|
||||
};
|
||||
|
||||
static int kirkwood_i2s_dev_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct kirkwood_asoc_platform_data *data = pdev->dev.platform_data;
|
||||
struct snd_soc_dai_driver *soc_dai = kirkwood_i2s_dai;
|
||||
struct kirkwood_dma_data *priv;
|
||||
struct resource *mem;
|
||||
struct device_node *np = pdev->dev.of_node;
|
||||
int err;
|
||||
|
||||
priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
|
||||
if (!priv) {
|
||||
dev_err(&pdev->dev, "allocation failed\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
dev_set_drvdata(&pdev->dev, priv);
|
||||
|
||||
mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
priv->io = devm_ioremap_resource(&pdev->dev, mem);
|
||||
if (IS_ERR(priv->io))
|
||||
return PTR_ERR(priv->io);
|
||||
|
||||
priv->irq = platform_get_irq(pdev, 0);
|
||||
if (priv->irq <= 0) {
|
||||
dev_err(&pdev->dev, "platform_get_irq failed\n");
|
||||
return -ENXIO;
|
||||
}
|
||||
|
||||
if (np) {
|
||||
priv->burst = 128; /* might be 32 or 128 */
|
||||
} else if (data) {
|
||||
priv->burst = data->burst;
|
||||
} else {
|
||||
dev_err(&pdev->dev, "no DT nor platform data ?!\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
priv->clk = devm_clk_get(&pdev->dev, np ? "internal" : NULL);
|
||||
if (IS_ERR(priv->clk)) {
|
||||
dev_err(&pdev->dev, "no clock\n");
|
||||
return PTR_ERR(priv->clk);
|
||||
}
|
||||
|
||||
err = clk_prepare_enable(priv->clk);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
priv->extclk = devm_clk_get(&pdev->dev, "extclk");
|
||||
if (IS_ERR(priv->extclk)) {
|
||||
if (PTR_ERR(priv->extclk) == -EPROBE_DEFER)
|
||||
return -EPROBE_DEFER;
|
||||
} else {
|
||||
if (priv->extclk == priv->clk) {
|
||||
devm_clk_put(&pdev->dev, priv->extclk);
|
||||
priv->extclk = ERR_PTR(-EINVAL);
|
||||
} else {
|
||||
dev_info(&pdev->dev, "found external clock\n");
|
||||
clk_prepare_enable(priv->extclk);
|
||||
soc_dai = kirkwood_i2s_dai_extclk;
|
||||
}
|
||||
}
|
||||
|
||||
/* Some sensible defaults - this reflects the powerup values */
|
||||
priv->ctl_play = KIRKWOOD_PLAYCTL_SIZE_24;
|
||||
priv->ctl_rec = KIRKWOOD_RECCTL_SIZE_24;
|
||||
|
||||
/* Select the burst size */
|
||||
if (priv->burst == 32) {
|
||||
priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_32;
|
||||
priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_32;
|
||||
} else {
|
||||
priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_128;
|
||||
priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_128;
|
||||
}
|
||||
|
||||
err = snd_soc_register_component(&pdev->dev, &kirkwood_i2s_component,
|
||||
soc_dai, 2);
|
||||
if (err) {
|
||||
dev_err(&pdev->dev, "snd_soc_register_component failed\n");
|
||||
goto err_component;
|
||||
}
|
||||
|
||||
err = snd_soc_register_platform(&pdev->dev, &kirkwood_soc_platform);
|
||||
if (err) {
|
||||
dev_err(&pdev->dev, "snd_soc_register_platform failed\n");
|
||||
goto err_platform;
|
||||
}
|
||||
|
||||
kirkwood_i2s_init(priv);
|
||||
|
||||
return 0;
|
||||
err_platform:
|
||||
snd_soc_unregister_component(&pdev->dev);
|
||||
err_component:
|
||||
if (!IS_ERR(priv->extclk))
|
||||
clk_disable_unprepare(priv->extclk);
|
||||
clk_disable_unprepare(priv->clk);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int kirkwood_i2s_dev_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct kirkwood_dma_data *priv = dev_get_drvdata(&pdev->dev);
|
||||
|
||||
snd_soc_unregister_platform(&pdev->dev);
|
||||
snd_soc_unregister_component(&pdev->dev);
|
||||
|
||||
if (!IS_ERR(priv->extclk))
|
||||
clk_disable_unprepare(priv->extclk);
|
||||
clk_disable_unprepare(priv->clk);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_OF
|
||||
static struct of_device_id mvebu_audio_of_match[] = {
|
||||
{ .compatible = "marvell,kirkwood-audio" },
|
||||
{ .compatible = "marvell,dove-audio" },
|
||||
{ .compatible = "marvell,armada370-audio" },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, mvebu_audio_of_match);
|
||||
#endif
|
||||
|
||||
static struct platform_driver kirkwood_i2s_driver = {
|
||||
.probe = kirkwood_i2s_dev_probe,
|
||||
.remove = kirkwood_i2s_dev_remove,
|
||||
.driver = {
|
||||
.name = DRV_NAME,
|
||||
.owner = THIS_MODULE,
|
||||
.of_match_table = of_match_ptr(mvebu_audio_of_match),
|
||||
},
|
||||
};
|
||||
|
||||
module_platform_driver(kirkwood_i2s_driver);
|
||||
|
||||
/* Module information */
|
||||
MODULE_AUTHOR("Arnaud Patard, <arnaud.patard@rtp-net.org>");
|
||||
MODULE_DESCRIPTION("Kirkwood I2S SoC Interface");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_ALIAS("platform:mvebu-audio");
|
||||
148
sound/soc/kirkwood/kirkwood.h
Normal file
148
sound/soc/kirkwood/kirkwood.h
Normal file
|
|
@ -0,0 +1,148 @@
|
|||
/*
|
||||
* kirkwood.h
|
||||
*
|
||||
* (c) 2010 Arnaud Patard <apatard@mandriva.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#ifndef _KIRKWOOD_AUDIO_H
|
||||
#define _KIRKWOOD_AUDIO_H
|
||||
|
||||
#define KIRKWOOD_RECORD_WIN 0
|
||||
#define KIRKWOOD_PLAYBACK_WIN 1
|
||||
#define KIRKWOOD_MAX_AUDIO_WIN 2
|
||||
|
||||
#define KIRKWOOD_AUDIO_WIN_BASE_REG(win) (0xA00 + ((win)<<3))
|
||||
#define KIRKWOOD_AUDIO_WIN_CTRL_REG(win) (0xA04 + ((win)<<3))
|
||||
|
||||
|
||||
#define KIRKWOOD_RECCTL 0x1000
|
||||
#define KIRKWOOD_RECCTL_SPDIF_EN (1<<11)
|
||||
#define KIRKWOOD_RECCTL_I2S_EN (1<<10)
|
||||
#define KIRKWOOD_RECCTL_PAUSE (1<<9)
|
||||
#define KIRKWOOD_RECCTL_MUTE (1<<8)
|
||||
#define KIRKWOOD_RECCTL_BURST_MASK (3<<5)
|
||||
#define KIRKWOOD_RECCTL_BURST_128 (2<<5)
|
||||
#define KIRKWOOD_RECCTL_BURST_32 (1<<5)
|
||||
#define KIRKWOOD_RECCTL_MONO (1<<4)
|
||||
#define KIRKWOOD_RECCTL_MONO_CHAN_RIGHT (1<<3)
|
||||
#define KIRKWOOD_RECCTL_MONO_CHAN_LEFT (0<<3)
|
||||
#define KIRKWOOD_RECCTL_SIZE_MASK (7<<0)
|
||||
#define KIRKWOOD_RECCTL_SIZE_16 (7<<0)
|
||||
#define KIRKWOOD_RECCTL_SIZE_16_C (3<<0)
|
||||
#define KIRKWOOD_RECCTL_SIZE_20 (2<<0)
|
||||
#define KIRKWOOD_RECCTL_SIZE_24 (1<<0)
|
||||
#define KIRKWOOD_RECCTL_SIZE_32 (0<<0)
|
||||
|
||||
#define KIRKWOOD_RECCTL_ENABLE_MASK (KIRKWOOD_RECCTL_SPDIF_EN | \
|
||||
KIRKWOOD_RECCTL_I2S_EN)
|
||||
|
||||
#define KIRKWOOD_REC_BUF_ADDR 0x1004
|
||||
#define KIRKWOOD_REC_BUF_SIZE 0x1008
|
||||
#define KIRKWOOD_REC_BYTE_COUNT 0x100C
|
||||
|
||||
#define KIRKWOOD_PLAYCTL 0x1100
|
||||
#define KIRKWOOD_PLAYCTL_PLAY_BUSY (1<<16)
|
||||
#define KIRKWOOD_PLAYCTL_BURST_MASK (3<<11)
|
||||
#define KIRKWOOD_PLAYCTL_BURST_128 (2<<11)
|
||||
#define KIRKWOOD_PLAYCTL_BURST_32 (1<<11)
|
||||
#define KIRKWOOD_PLAYCTL_PAUSE (1<<9)
|
||||
#define KIRKWOOD_PLAYCTL_SPDIF_MUTE (1<<8)
|
||||
#define KIRKWOOD_PLAYCTL_MONO_MASK (3<<5)
|
||||
#define KIRKWOOD_PLAYCTL_MONO_BOTH (3<<5)
|
||||
#define KIRKWOOD_PLAYCTL_MONO_OFF (0<<5)
|
||||
#define KIRKWOOD_PLAYCTL_I2S_MUTE (1<<7)
|
||||
#define KIRKWOOD_PLAYCTL_SPDIF_EN (1<<4)
|
||||
#define KIRKWOOD_PLAYCTL_I2S_EN (1<<3)
|
||||
#define KIRKWOOD_PLAYCTL_SIZE_MASK (7<<0)
|
||||
#define KIRKWOOD_PLAYCTL_SIZE_16 (7<<0)
|
||||
#define KIRKWOOD_PLAYCTL_SIZE_16_C (3<<0)
|
||||
#define KIRKWOOD_PLAYCTL_SIZE_20 (2<<0)
|
||||
#define KIRKWOOD_PLAYCTL_SIZE_24 (1<<0)
|
||||
#define KIRKWOOD_PLAYCTL_SIZE_32 (0<<0)
|
||||
|
||||
#define KIRKWOOD_PLAYCTL_ENABLE_MASK (KIRKWOOD_PLAYCTL_SPDIF_EN | \
|
||||
KIRKWOOD_PLAYCTL_I2S_EN)
|
||||
|
||||
#define KIRKWOOD_PLAY_BUF_ADDR 0x1104
|
||||
#define KIRKWOOD_PLAY_BUF_SIZE 0x1108
|
||||
#define KIRKWOOD_PLAY_BYTE_COUNT 0x110C
|
||||
|
||||
#define KIRKWOOD_DCO_CTL 0x1204
|
||||
#define KIRKWOOD_DCO_CTL_OFFSET_MASK (0xFFF<<2)
|
||||
#define KIRKWOOD_DCO_CTL_OFFSET_0 (0x800<<2)
|
||||
#define KIRKWOOD_DCO_CTL_FREQ_MASK (3<<0)
|
||||
#define KIRKWOOD_DCO_CTL_FREQ_11 (0<<0)
|
||||
#define KIRKWOOD_DCO_CTL_FREQ_12 (1<<0)
|
||||
#define KIRKWOOD_DCO_CTL_FREQ_24 (2<<0)
|
||||
|
||||
#define KIRKWOOD_DCO_SPCR_STATUS 0x120c
|
||||
#define KIRKWOOD_DCO_SPCR_STATUS_DCO_LOCK (1<<16)
|
||||
|
||||
#define KIRKWOOD_CLOCKS_CTRL 0x1230
|
||||
#define KIRKWOOD_MCLK_SOURCE_MASK (3<<0)
|
||||
#define KIRKWOOD_MCLK_SOURCE_DCO (0<<0)
|
||||
#define KIRKWOOD_MCLK_SOURCE_EXTCLK (3<<0)
|
||||
|
||||
#define KIRKWOOD_ERR_CAUSE 0x1300
|
||||
#define KIRKWOOD_ERR_MASK 0x1304
|
||||
|
||||
#define KIRKWOOD_INT_CAUSE 0x1308
|
||||
#define KIRKWOOD_INT_MASK 0x130C
|
||||
#define KIRKWOOD_INT_CAUSE_PLAY_BYTES (1<<14)
|
||||
#define KIRKWOOD_INT_CAUSE_REC_BYTES (1<<13)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_PLAY_END (1<<7)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_PLAY_3Q (1<<6)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_PLAY_HALF (1<<5)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_PLAY_1Q (1<<4)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_REC_END (1<<3)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_REC_3Q (1<<2)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_REC_HALF (1<<1)
|
||||
#define KIRKWOOD_INT_CAUSE_DMA_REC_1Q (1<<0)
|
||||
|
||||
#define KIRKWOOD_REC_BYTE_INT_COUNT 0x1310
|
||||
#define KIRKWOOD_PLAY_BYTE_INT_COUNT 0x1314
|
||||
#define KIRKWOOD_BYTE_INT_COUNT_MASK 0xffffff
|
||||
|
||||
#define KIRKWOOD_I2S_PLAYCTL 0x2508
|
||||
#define KIRKWOOD_I2S_RECCTL 0x2408
|
||||
#define KIRKWOOD_I2S_CTL_JUST_MASK (0xf<<26)
|
||||
#define KIRKWOOD_I2S_CTL_LJ (0<<26)
|
||||
#define KIRKWOOD_I2S_CTL_I2S (5<<26)
|
||||
#define KIRKWOOD_I2S_CTL_RJ (8<<26)
|
||||
#define KIRKWOOD_I2S_CTL_SIZE_MASK (3<<30)
|
||||
#define KIRKWOOD_I2S_CTL_SIZE_16 (3<<30)
|
||||
#define KIRKWOOD_I2S_CTL_SIZE_20 (2<<30)
|
||||
#define KIRKWOOD_I2S_CTL_SIZE_24 (1<<30)
|
||||
#define KIRKWOOD_I2S_CTL_SIZE_32 (0<<30)
|
||||
|
||||
#define KIRKWOOD_AUDIO_BUF_MAX (16*1024*1024)
|
||||
|
||||
/* Theses values come from the marvell alsa driver */
|
||||
/* need to find where they come from */
|
||||
#define KIRKWOOD_SND_MIN_PERIODS 2
|
||||
#define KIRKWOOD_SND_MAX_PERIODS 16
|
||||
#define KIRKWOOD_SND_MIN_PERIOD_BYTES 256
|
||||
#define KIRKWOOD_SND_MAX_PERIOD_BYTES 0x8000
|
||||
#define KIRKWOOD_SND_MAX_BUFFER_BYTES (KIRKWOOD_SND_MAX_PERIOD_BYTES \
|
||||
* KIRKWOOD_SND_MAX_PERIODS)
|
||||
|
||||
struct kirkwood_dma_data {
|
||||
void __iomem *io;
|
||||
struct clk *clk;
|
||||
struct clk *extclk;
|
||||
uint32_t ctl_play;
|
||||
uint32_t ctl_rec;
|
||||
struct snd_pcm_substream *substream_play;
|
||||
struct snd_pcm_substream *substream_rec;
|
||||
int irq;
|
||||
int burst;
|
||||
};
|
||||
|
||||
extern struct snd_soc_platform_driver kirkwood_soc_platform;
|
||||
|
||||
#endif
|
||||
Loading…
Add table
Add a link
Reference in a new issue