mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-09 01:28:05 -04:00
Fixed MTP to work with TWRP
This commit is contained in:
awab228
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
411
sound/soc/samsung/visualizercap-dummydai.c
Normal file
411
sound/soc/samsung/visualizercap-dummydai.c
Normal file
|
|
@ -0,0 +1,411 @@
|
|||
/*
|
||||
* ALSA SoC dummy cpu & platform dai driver
|
||||
*
|
||||
* This driver provides one dummy dai.
|
||||
*
|
||||
* Copyright (c) 2014 Samsung Electronics
|
||||
* http://www.samsungsemi.com/
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/dma/dma-pl330.h>
|
||||
#include <linux/dma-mapping.h>
|
||||
#include <linux/kthread.h>
|
||||
#include <sound/soc.h>
|
||||
#include <sound/pcm.h>
|
||||
#include <sound/initval.h>
|
||||
#include <sound/pcm_params.h>
|
||||
|
||||
#define PERIOD_MIN 4
|
||||
|
||||
static DECLARE_WAIT_QUEUE_HEAD(compr_cap_wq);
|
||||
extern ssize_t esa_copy(unsigned long hwbuf, ssize_t size);
|
||||
extern int esa_compr_running(void);
|
||||
extern void esa_compr_ctrl_fxintr(bool fxon);
|
||||
|
||||
static const struct snd_pcm_hardware dma_hardware = {
|
||||
.info = SNDRV_PCM_INFO_INTERLEAVED |
|
||||
SNDRV_PCM_INFO_BLOCK_TRANSFER |
|
||||
SNDRV_PCM_INFO_MMAP |
|
||||
SNDRV_PCM_INFO_MMAP_VALID,
|
||||
.formats = SNDRV_PCM_FMTBIT_S16_LE |
|
||||
SNDRV_PCM_FMTBIT_U16_LE |
|
||||
SNDRV_PCM_FMTBIT_U8 |
|
||||
SNDRV_PCM_FMTBIT_S8,
|
||||
.channels_min = 1,
|
||||
.channels_max = 8,
|
||||
.buffer_bytes_max = 256*1024,
|
||||
.period_bytes_min = 128,
|
||||
.period_bytes_max = 32*1024,
|
||||
.periods_min = 2,
|
||||
.periods_max = 128,
|
||||
.fifo_size = 32,
|
||||
};
|
||||
|
||||
struct runtime_data {
|
||||
spinlock_t lock;
|
||||
int state;
|
||||
unsigned int dma_loaded;
|
||||
unsigned int dma_period;
|
||||
unsigned long buf_start;
|
||||
unsigned long buf_pos;
|
||||
unsigned long buf_end;
|
||||
unsigned long period_bytes;
|
||||
struct snd_pcm_hardware hw;
|
||||
struct snd_pcm_substream *substream;
|
||||
struct task_struct *compr_cap_kthread;
|
||||
bool running;
|
||||
bool opened;
|
||||
bool dram_used;
|
||||
} rd;
|
||||
|
||||
static int dummy_dma_hw_params(struct snd_pcm_substream *substream,
|
||||
struct snd_pcm_hw_params *params)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
struct runtime_data *prtd = runtime->private_data;
|
||||
unsigned long totbytes = params_buffer_bytes(params);
|
||||
|
||||
pr_debug("Entered %s\n", __func__);
|
||||
|
||||
snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
|
||||
|
||||
runtime->dma_bytes = totbytes;
|
||||
|
||||
spin_lock_irq(&prtd->lock);
|
||||
prtd->dma_loaded = 0;
|
||||
prtd->dma_period = params_period_bytes(params);
|
||||
prtd->buf_start = (unsigned long)runtime->dma_area;
|
||||
prtd->buf_pos = prtd->buf_start;
|
||||
prtd->buf_end = prtd->buf_start + totbytes;
|
||||
while ((totbytes / prtd->dma_period) < PERIOD_MIN)
|
||||
prtd->dma_period >>= 1;
|
||||
spin_unlock_irq(&prtd->lock);
|
||||
|
||||
pr_info("Dummy DMA:%s:Addr=@0x%lx Total=%d PrdSz=%d(%d) #Prds=%d \n",
|
||||
(substream->stream == SNDRV_PCM_STREAM_PLAYBACK) ? "P" : "C",
|
||||
prtd->buf_start, (u32)runtime->dma_bytes,
|
||||
params_period_bytes(params),(u32) prtd->dma_period,
|
||||
params_periods(params));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dummy_dma_hw_free(struct snd_pcm_substream *substream)
|
||||
{
|
||||
snd_pcm_set_runtime_buffer(substream, NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dummy_dma_prepare(struct snd_pcm_substream *substream)
|
||||
{
|
||||
struct runtime_data *prtd = substream->runtime->private_data;
|
||||
int ret = 0;
|
||||
|
||||
pr_debug("Entered %s +\n", __func__);
|
||||
|
||||
prtd->dma_loaded = 0;
|
||||
prtd->buf_pos = prtd->buf_start;
|
||||
|
||||
pr_debug("Entered %s -\n", __func__);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static snd_pcm_uframes_t dummy_dma_pointer(struct snd_pcm_substream *substream)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
struct runtime_data *prtd = runtime->private_data;
|
||||
unsigned long res;
|
||||
|
||||
pr_debug("Entered %s\n", __func__);
|
||||
res = prtd->buf_pos - prtd->buf_start;
|
||||
|
||||
pr_debug("%s res = %lx\n", __func__, res);
|
||||
|
||||
return bytes_to_frames(substream->runtime, res);
|
||||
}
|
||||
|
||||
static int dummy_dma_open(struct snd_pcm_substream *substream)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
|
||||
pr_info("Entered %s\n", __func__);
|
||||
|
||||
if (rd.opened)
|
||||
return -EBUSY;
|
||||
|
||||
if (!esa_compr_running())
|
||||
return -ENODEV;
|
||||
|
||||
spin_lock_init(&rd.lock);
|
||||
|
||||
memcpy(&rd.hw, &dma_hardware, sizeof(struct snd_pcm_hardware));
|
||||
|
||||
snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
|
||||
runtime->private_data = &rd;
|
||||
snd_soc_set_runtime_hwparams(substream, &rd.hw);
|
||||
|
||||
rd.opened = true;
|
||||
|
||||
pr_info("%s: prtd = %p\n", __func__, &rd);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dummy_dma_close(struct snd_pcm_substream *substream)
|
||||
{
|
||||
pr_info("Entered %s\n", __func__);
|
||||
|
||||
rd.opened = false;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dummy_dma_copy(struct snd_pcm_substream *substream, int channel,
|
||||
snd_pcm_uframes_t pos, void __user *buf, snd_pcm_uframes_t count)
|
||||
{
|
||||
struct snd_pcm_runtime *runtime = substream->runtime;
|
||||
char *hwbuf = runtime->dma_area + frames_to_bytes(runtime, pos);
|
||||
|
||||
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
||||
if (copy_from_user(hwbuf, buf, frames_to_bytes(runtime, count)))
|
||||
return -EFAULT;
|
||||
} else {
|
||||
if (copy_to_user(buf, hwbuf, frames_to_bytes(runtime, count)))
|
||||
return -EFAULT;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dummy_dma_trigger(struct snd_pcm_substream *substream, int cmd)
|
||||
{
|
||||
struct runtime_data *prtd = substream->runtime->private_data;
|
||||
int ret = 0;
|
||||
|
||||
pr_info("Entered %s\n", __func__);
|
||||
|
||||
spin_lock(&prtd->lock);
|
||||
|
||||
switch (cmd) {
|
||||
case SNDRV_PCM_TRIGGER_START:
|
||||
/* Enable seiren firmware effect Fx external interrupt
|
||||
to capture offload's PCM data from firmware */
|
||||
esa_compr_ctrl_fxintr(true);
|
||||
rd.running = true;
|
||||
if (waitqueue_active(&compr_cap_wq))
|
||||
wake_up_interruptible(&compr_cap_wq);
|
||||
break;
|
||||
|
||||
case SNDRV_PCM_TRIGGER_STOP:
|
||||
rd.running = false;
|
||||
/* Disable seiren firmware effect Fx externalinterrupt */
|
||||
esa_compr_ctrl_fxintr(false);
|
||||
break;
|
||||
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
spin_unlock(&prtd->lock);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static struct snd_pcm_ops dummy_dma_ops = {
|
||||
.open = dummy_dma_open,
|
||||
.close = dummy_dma_close,
|
||||
.ioctl = snd_pcm_lib_ioctl,
|
||||
.hw_params = dummy_dma_hw_params,
|
||||
.hw_free = dummy_dma_hw_free,
|
||||
.prepare = dummy_dma_prepare,
|
||||
.trigger = dummy_dma_trigger,
|
||||
.pointer = dummy_dma_pointer,
|
||||
.copy = dummy_dma_copy,
|
||||
};
|
||||
|
||||
static int compr_cap_kthr(void *p)
|
||||
{
|
||||
struct runtime_data *prtd = (struct runtime_data *)p;
|
||||
int ret = 0;
|
||||
|
||||
|
||||
while (!kthread_should_stop()) {
|
||||
wait_event_interruptible(compr_cap_wq, rd.running);
|
||||
|
||||
ret = esa_copy(prtd->buf_pos, prtd->dma_period);
|
||||
if (ret < 0) {
|
||||
pr_err("Failed to get f/w decoded pcm data\n");
|
||||
rd.running = false;
|
||||
continue;
|
||||
}
|
||||
|
||||
prtd->buf_pos = prtd->buf_pos + prtd->dma_period;
|
||||
if (prtd->buf_pos >= prtd->buf_end)
|
||||
prtd->buf_pos = prtd->buf_start;
|
||||
snd_pcm_period_elapsed(rd.substream);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int preallocate_dma_buffer_of(struct snd_pcm *pcm, int stream,
|
||||
struct device_node *np)
|
||||
{
|
||||
struct snd_pcm_substream *substream = pcm->streams[stream].substream;
|
||||
struct snd_dma_buffer *buf = &substream->dma_buffer;
|
||||
dma_addr_t dma_addr;
|
||||
size_t size = dma_hardware.buffer_bytes_max;
|
||||
|
||||
pr_debug("Entered %s\n", __func__);
|
||||
|
||||
buf->dev.type = SNDRV_DMA_TYPE_DEV;
|
||||
buf->dev.dev = pcm->card->dev;
|
||||
buf->private_data = NULL;
|
||||
|
||||
buf->area = dma_alloc_coherent(pcm->card->dev, size, &dma_addr, GFP_KERNEL);
|
||||
if (!buf->area)
|
||||
return -ENOMEM;
|
||||
|
||||
buf->addr = dma_addr;
|
||||
buf->bytes = size;
|
||||
|
||||
rd.substream = substream;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void dummy_dma_free_dma_buffers(struct snd_pcm *pcm)
|
||||
{
|
||||
struct snd_pcm_substream *substream;
|
||||
struct snd_dma_buffer *buf;
|
||||
|
||||
pr_debug("Entered %s\n", __func__);
|
||||
|
||||
substream = pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream;
|
||||
if (!substream)
|
||||
return;
|
||||
|
||||
buf = &substream->dma_buffer;
|
||||
if (!buf->area)
|
||||
return;
|
||||
|
||||
dma_free_coherent(pcm->card->dev, buf->bytes, buf->area, buf->addr);
|
||||
buf->area = NULL;
|
||||
}
|
||||
|
||||
static u64 dma_mask = DMA_BIT_MASK(32);
|
||||
|
||||
static int dummy_dma_new(struct snd_soc_pcm_runtime *rtd)
|
||||
{
|
||||
struct snd_card *card = rtd->card->snd_card;
|
||||
struct snd_pcm *pcm = rtd->pcm;
|
||||
struct device_node *np = rtd->cpu_dai->dev->of_node;
|
||||
struct sched_param param = { .sched_priority = 0 };
|
||||
struct task_struct *ret_task;
|
||||
int ret = 0;
|
||||
|
||||
pr_debug("Entered %s\n", __func__);
|
||||
|
||||
if (!card->dev->dma_mask)
|
||||
card->dev->dma_mask = &dma_mask;
|
||||
if (!card->dev->coherent_dma_mask)
|
||||
card->dev->coherent_dma_mask = DMA_BIT_MASK(32);
|
||||
|
||||
if (pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream) {
|
||||
ret = 0;
|
||||
if (np)
|
||||
ret = preallocate_dma_buffer_of(pcm,
|
||||
SNDRV_PCM_STREAM_CAPTURE, np);
|
||||
if (ret)
|
||||
goto out;
|
||||
}
|
||||
|
||||
ret_task = kthread_run(compr_cap_kthr, &rd, "compr_cap_kthr");
|
||||
if (IS_ERR(ret_task)) {
|
||||
pr_info("%s: failed to create compr_cap thread(%ld)\n",
|
||||
__func__, PTR_ERR(ret_task));
|
||||
ret = PTR_ERR(ret_task);
|
||||
} else {
|
||||
sched_setscheduler(ret_task, SCHED_NORMAL, ¶m);
|
||||
}
|
||||
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static struct snd_soc_platform_driver dummy_asoc_platform = {
|
||||
.ops = &dummy_dma_ops,
|
||||
.pcm_new = dummy_dma_new,
|
||||
.pcm_free = dummy_dma_free_dma_buffers,
|
||||
};
|
||||
|
||||
#define SAMSUNG_I2S_RATES SNDRV_PCM_RATE_8000_192000
|
||||
|
||||
#define SAMSUNG_I2S_FMTS (SNDRV_PCM_FMTBIT_S8 | \
|
||||
SNDRV_PCM_FMTBIT_S16_LE | \
|
||||
SNDRV_PCM_FMTBIT_S24_LE)
|
||||
|
||||
static struct snd_soc_dai_driver dummy_i2s_dai_drv = {
|
||||
.name = "dummy-i2s-dai-driver",
|
||||
};
|
||||
|
||||
static const struct snd_soc_component_driver dummy_i2s_component = {
|
||||
.name = "dummy-i2s",
|
||||
};
|
||||
|
||||
static int dummy_cpu_probe(struct platform_device *pdev)
|
||||
{
|
||||
dummy_i2s_dai_drv.symmetric_rates = 1;
|
||||
dummy_i2s_dai_drv.capture.channels_min = 1;
|
||||
dummy_i2s_dai_drv.capture.channels_max = 2;
|
||||
dummy_i2s_dai_drv.capture.rates = SAMSUNG_I2S_RATES;
|
||||
dummy_i2s_dai_drv.capture.formats = SAMSUNG_I2S_FMTS;
|
||||
|
||||
snd_soc_register_component(&pdev->dev, &dummy_i2s_component,
|
||||
&dummy_i2s_dai_drv, 1);
|
||||
|
||||
snd_soc_register_platform(&pdev->dev, &dummy_asoc_platform);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dummy_cpu_remove(struct platform_device *pdev)
|
||||
{
|
||||
snd_soc_unregister_component(&pdev->dev);
|
||||
snd_soc_unregister_platform(&pdev->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id dummy_cpu_of_match[] = {
|
||||
{ .compatible = "samsung,dummy-i2s", },
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, dummy_cpu_of_match);
|
||||
|
||||
static struct platform_driver dummy_cpu_driver = {
|
||||
.probe = dummy_cpu_probe,
|
||||
.remove = dummy_cpu_remove,
|
||||
.driver = {
|
||||
.name = "dummy-i2s",
|
||||
.owner = THIS_MODULE,
|
||||
.of_match_table = of_match_ptr(dummy_cpu_of_match),
|
||||
},
|
||||
};
|
||||
|
||||
module_platform_driver(dummy_cpu_driver);
|
||||
|
||||
MODULE_AUTHOR("Hyunwoong Kim <khw0178.kim@samsung.com>");
|
||||
MODULE_DESCRIPTION("Dummy dai driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
Loading…
Add table
Add a link
Reference in a new issue