mirror of
https://github.com/team-infusion-developers/android_kernel_samsung_msm8976.git
synced 2024-10-01 09:16:06 +00:00
dcccdd938e
Unregister the platform device again if the probe was unsuccessful. This restores the behaviour of not loading the driver on probe() failure. Signed-off-by: Rene Herman <rene.herman@keyaccess.nl> Signed-off-by: Takashi Iwai <tiwai@suse.de>
221 lines
6.1 KiB
C
221 lines
6.1 KiB
C
/*
|
|
* Generic driver for AD1848/AD1847/CS4248 chips (0.1 Alpha)
|
|
* Copyright (c) by Tugrul Galatali <galatalt@stuy.edu>,
|
|
* Jaroslav Kysela <perex@suse.cz>
|
|
* Based on card-4232.c by Jaroslav Kysela <perex@suse.cz>
|
|
*
|
|
*
|
|
* 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 <sound/driver.h>
|
|
#include <linux/init.h>
|
|
#include <linux/err.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/time.h>
|
|
#include <linux/wait.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <sound/core.h>
|
|
#include <sound/ad1848.h>
|
|
#include <sound/initval.h>
|
|
|
|
MODULE_AUTHOR("Tugrul Galatali <galatalt@stuy.edu>, Jaroslav Kysela <perex@suse.cz>");
|
|
MODULE_DESCRIPTION("AD1848/AD1847/CS4248");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_SUPPORTED_DEVICE("{{Analog Devices,AD1848},"
|
|
"{Analog Devices,AD1847},"
|
|
"{Crystal Semiconductors,CS4248}}");
|
|
|
|
static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-MAX */
|
|
static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* ID for this card */
|
|
static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE; /* Enable this card */
|
|
static long port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT; /* PnP setup */
|
|
static int irq[SNDRV_CARDS] = SNDRV_DEFAULT_IRQ; /* 5,7,9,11,12,15 */
|
|
static int dma1[SNDRV_CARDS] = SNDRV_DEFAULT_DMA; /* 0,1,3,5,6,7 */
|
|
static int thinkpad[SNDRV_CARDS]; /* Thinkpad special case */
|
|
|
|
module_param_array(index, int, NULL, 0444);
|
|
MODULE_PARM_DESC(index, "Index value for AD1848 soundcard.");
|
|
module_param_array(id, charp, NULL, 0444);
|
|
MODULE_PARM_DESC(id, "ID string for AD1848 soundcard.");
|
|
module_param_array(enable, bool, NULL, 0444);
|
|
MODULE_PARM_DESC(enable, "Enable AD1848 soundcard.");
|
|
module_param_array(port, long, NULL, 0444);
|
|
MODULE_PARM_DESC(port, "Port # for AD1848 driver.");
|
|
module_param_array(irq, int, NULL, 0444);
|
|
MODULE_PARM_DESC(irq, "IRQ # for AD1848 driver.");
|
|
module_param_array(dma1, int, NULL, 0444);
|
|
MODULE_PARM_DESC(dma1, "DMA1 # for AD1848 driver.");
|
|
module_param_array(thinkpad, bool, NULL, 0444);
|
|
MODULE_PARM_DESC(thinkpad, "Enable only for the onboard CS4248 of IBM Thinkpad 360/750/755 series.");
|
|
|
|
static struct platform_device *devices[SNDRV_CARDS];
|
|
|
|
|
|
static int __init snd_ad1848_probe(struct platform_device *pdev)
|
|
{
|
|
int dev = pdev->id;
|
|
struct snd_card *card;
|
|
struct snd_ad1848 *chip;
|
|
struct snd_pcm *pcm;
|
|
int err;
|
|
|
|
if (port[dev] == SNDRV_AUTO_PORT) {
|
|
snd_printk(KERN_ERR "ad1848: specify port\n");
|
|
return -EINVAL;
|
|
}
|
|
if (irq[dev] == SNDRV_AUTO_IRQ) {
|
|
snd_printk(KERN_ERR "ad1848: specify irq\n");
|
|
return -EINVAL;
|
|
}
|
|
if (dma1[dev] == SNDRV_AUTO_DMA) {
|
|
snd_printk(KERN_ERR "ad1848: specify dma1\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
card = snd_card_new(index[dev], id[dev], THIS_MODULE, 0);
|
|
if (card == NULL)
|
|
return -ENOMEM;
|
|
|
|
if ((err = snd_ad1848_create(card, port[dev],
|
|
irq[dev],
|
|
dma1[dev],
|
|
thinkpad[dev] ? AD1848_HW_THINKPAD : AD1848_HW_DETECT,
|
|
&chip)) < 0)
|
|
goto _err;
|
|
card->private_data = chip;
|
|
|
|
if ((err = snd_ad1848_pcm(chip, 0, &pcm)) < 0)
|
|
goto _err;
|
|
|
|
if ((err = snd_ad1848_mixer(chip)) < 0)
|
|
goto _err;
|
|
|
|
strcpy(card->driver, "AD1848");
|
|
strcpy(card->shortname, pcm->name);
|
|
|
|
sprintf(card->longname, "%s at 0x%lx, irq %d, dma %d",
|
|
pcm->name, chip->port, irq[dev], dma1[dev]);
|
|
|
|
if (thinkpad[dev])
|
|
strcat(card->longname, " [Thinkpad]");
|
|
|
|
snd_card_set_dev(card, &pdev->dev);
|
|
|
|
if ((err = snd_card_register(card)) < 0)
|
|
goto _err;
|
|
|
|
platform_set_drvdata(pdev, card);
|
|
return 0;
|
|
|
|
_err:
|
|
snd_card_free(card);
|
|
return err;
|
|
}
|
|
|
|
static int __devexit snd_ad1848_remove(struct platform_device *devptr)
|
|
{
|
|
snd_card_free(platform_get_drvdata(devptr));
|
|
platform_set_drvdata(devptr, NULL);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int snd_ad1848_suspend(struct platform_device *pdev, pm_message_t state)
|
|
{
|
|
struct snd_card *card = platform_get_drvdata(pdev);
|
|
struct snd_ad1848 *chip = card->private_data;
|
|
|
|
snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
|
|
chip->suspend(chip);
|
|
return 0;
|
|
}
|
|
|
|
static int snd_ad1848_resume(struct platform_device *pdev)
|
|
{
|
|
struct snd_card *card = platform_get_drvdata(pdev);
|
|
struct snd_ad1848 *chip = card->private_data;
|
|
|
|
chip->resume(chip);
|
|
snd_power_change_state(card, SNDRV_CTL_POWER_D0);
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
#define SND_AD1848_DRIVER "snd_ad1848"
|
|
|
|
static struct platform_driver snd_ad1848_driver = {
|
|
.probe = snd_ad1848_probe,
|
|
.remove = __devexit_p(snd_ad1848_remove),
|
|
#ifdef CONFIG_PM
|
|
.suspend = snd_ad1848_suspend,
|
|
.resume = snd_ad1848_resume,
|
|
#endif
|
|
.driver = {
|
|
.name = SND_AD1848_DRIVER
|
|
},
|
|
};
|
|
|
|
static void __init_or_module snd_ad1848_unregister_all(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(devices); ++i)
|
|
platform_device_unregister(devices[i]);
|
|
platform_driver_unregister(&snd_ad1848_driver);
|
|
}
|
|
|
|
static int __init alsa_card_ad1848_init(void)
|
|
{
|
|
int i, cards, err;
|
|
|
|
err = platform_driver_register(&snd_ad1848_driver);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
cards = 0;
|
|
for (i = 0; i < SNDRV_CARDS; i++) {
|
|
struct platform_device *device;
|
|
if (! enable[i])
|
|
continue;
|
|
device = platform_device_register_simple(SND_AD1848_DRIVER,
|
|
i, NULL, 0);
|
|
if (IS_ERR(device))
|
|
continue;
|
|
if (!platform_get_drvdata(device)) {
|
|
platform_device_unregister(device);
|
|
continue;
|
|
}
|
|
devices[i] = device;
|
|
cards++;
|
|
}
|
|
if (!cards) {
|
|
#ifdef MODULE
|
|
printk(KERN_ERR "AD1848 soundcard not found or device busy\n");
|
|
#endif
|
|
snd_ad1848_unregister_all();
|
|
return -ENODEV;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void __exit alsa_card_ad1848_exit(void)
|
|
{
|
|
snd_ad1848_unregister_all();
|
|
}
|
|
|
|
module_init(alsa_card_ad1848_init)
|
|
module_exit(alsa_card_ad1848_exit)
|