satip-axe/kernel/sound/stm/stx7100.c

207 lines
5.3 KiB
C
Raw Normal View History

/*
* STMicrolectronics STx7100/STx7109 audio glue driver
*
* Copyright (c) 2005-2011 STMicroelectronics Limited
*
* Author: Pawel Moll <pawel.moll@st.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.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*
*/
#include <linux/init.h>
#include <linux/module.h>
#include <linux/io.h>
#include <sound/core.h>
#include "common.h"
static int snd_stm_debug_level;
module_param_named(debug, snd_stm_debug_level, int, S_IRUGO | S_IWUSR);
/*
* Audio glue driver implementation
*/
#define IO_CTRL(base) ((base) + 0x00)
#define PCM_CLK_EN 0
#define PCM_CLK_EN__INPUT (0 << PCM_CLK_EN)
#define PCM_CLK_EN__OUTPUT (1 << PCM_CLK_EN)
#define DATA0_EN 1
#define DATA0_EN__INPUT (0 << DATA0_EN)
#define DATA0_EN__OUTPUT (1 << DATA0_EN)
#define DATA1_EN 2
#define DATA1_EN__INPUT (0 << DATA1_EN)
#define DATA1_EN__OUTPUT (1 << DATA1_EN)
#define SPDIN_EN 3
#define SPDIF_EN__DISABLE (0 << SPDIN_EN)
#define SPDIF_EN__ENABLE (1 << SPDIN_EN)
struct snd_stm_stx7100_glue {
struct resource *mem_region;
void *base;
struct snd_info_entry *proc_entry;
snd_stm_magic_field;
};
static void snd_stm_stx7100_glue_dump_registers(struct snd_info_entry *entry,
struct snd_info_buffer *buffer)
{
struct snd_stm_stx7100_glue *stx7100_glue = entry->private_data;
BUG_ON(!stx7100_glue);
BUG_ON(!snd_stm_magic_valid(stx7100_glue));
snd_iprintf(buffer, "--- snd_stx7100_glue ---\n");
snd_iprintf(buffer, "IO_CTRL (0x%p) = 0x%08x\n",
IO_CTRL(stx7100_glue->base),
readl(IO_CTRL(stx7100_glue->base)));
snd_iprintf(buffer, "\n");
}
static int __init snd_stm_stx7100_glue_probe(struct platform_device *pdev)
{
int result = 0;
struct snd_stm_stx7100_glue *stx7100_glue;
snd_stm_printd(0, "%s('%s')\n", __func__, dev_name(&pdev->dev));
stx7100_glue = kzalloc(sizeof(*stx7100_glue), GFP_KERNEL);
if (!stx7100_glue) {
snd_stm_printe("Can't allocate memory "
"for a device description!\n");
result = -ENOMEM;
goto error_alloc;
}
snd_stm_magic_set(stx7100_glue);
result = snd_stm_memory_request(pdev, &stx7100_glue->mem_region,
&stx7100_glue->base);
if (result < 0) {
snd_stm_printe("Memory region request failed!\n");
goto error_memory_request;
}
/* Enable audio outputs */
writel(SPDIF_EN__ENABLE | DATA1_EN__OUTPUT | DATA0_EN__OUTPUT |
PCM_CLK_EN__OUTPUT, IO_CTRL(stx7100_glue->base));
/* Additional procfs info */
snd_stm_info_register(&stx7100_glue->proc_entry, "stx7100_glue",
snd_stm_stx7100_glue_dump_registers, stx7100_glue);
platform_set_drvdata(pdev, stx7100_glue);
return result;
error_memory_request:
snd_stm_magic_clear(stx7100_glue);
kfree(stx7100_glue);
error_alloc:
return result;
}
static int __exit snd_stm_stx7100_glue_remove(struct platform_device *pdev)
{
struct snd_stm_stx7100_glue *stx7100_glue =
platform_get_drvdata(pdev);
snd_stm_printd(0, "%s('%s')\n", __func__, dev_name(&pdev->dev));
BUG_ON(!stx7100_glue);
BUG_ON(!snd_stm_magic_valid(stx7100_glue));
/* Remove procfs entry */
snd_stm_info_unregister(stx7100_glue->proc_entry);
/* Disable audio outputs */
writel(SPDIF_EN__DISABLE | DATA1_EN__INPUT | DATA0_EN__INPUT |
PCM_CLK_EN__INPUT, IO_CTRL(stx7100_glue->base));
snd_stm_memory_release(stx7100_glue->mem_region, stx7100_glue->base);
snd_stm_magic_clear(stx7100_glue);
kfree(stx7100_glue);
return 0;
}
static struct platform_driver snd_stm_stx7100_glue_driver = {
.driver.name = "snd_stx7100_glue",
.probe = snd_stm_stx7100_glue_probe,
.remove = snd_stm_stx7100_glue_remove,
};
/*
* Audio initialization
*/
static int __init snd_stm_stx7100_init(void)
{
int result;
snd_stm_printd(0, "%s()\n", __func__);
if (cpu_data->type != CPU_STX7100 && cpu_data->type != CPU_STX7109) {
snd_stm_printe("Not supported (other than STx7100 or STx7109)"
" SOC detected!\n");
result = -EINVAL;
goto error_soc_type;
}
result = platform_driver_register(&snd_stm_stx7100_glue_driver);
if (result != 0) {
snd_stm_printe("Failed to register audio glue driver!\n");
goto error_glue_driver_register;
}
result = snd_stm_card_register();
if (result != 0) {
snd_stm_printe("Failed to register ALSA cards!\n");
goto error_card_register;
}
return 0;
error_card_register:
platform_driver_unregister(&snd_stm_stx7100_glue_driver);
error_glue_driver_register:
error_soc_type:
return result;
}
static void __exit snd_stm_stx7100_exit(void)
{
snd_stm_printd(0, "%s()\n", __func__);
platform_driver_unregister(&snd_stm_stx7100_glue_driver);
}
MODULE_AUTHOR("Pawel Moll <pawel.moll@st.com>");
MODULE_DESCRIPTION("STMicroelectronics STx7100/STx7109 audio driver");
MODULE_LICENSE("GPL");
module_init(snd_stm_stx7100_init);
module_exit(snd_stm_stx7100_exit);