openkylin
/
platform_kernel-5.15
mirror of https://gitee.com/openkylin/platform_kernel-5.15.git
9
0
Fork 0
Code Issues Projects Releases Wiki Activity

ALSA: es1968: Add radio support for MediaForte M56VAP 

Add support for TEA5757 tuner on MediaForte M56VAP sound+modem+radio card.
The GPIO connection type is automatically detected (like snd-fm801 driver).

Also add a safety subsystem vendor check to skip radio detection if vendor
differs from ESS (so we don't touch GPIOs on laptops).

Tested with SF64-PCE2 and M56VAP cards.

Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Signed-off-by: Takashi Iwai <tiwai@suse.de>
This commit is contained in:
Ondrej Zary 2013-05-30 16:13:09 +02:00 committed by Takashi Iwai
parent f35e839a3c
commit 8e0d70434d
1 changed files with 50 additions and 23 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

73
sound/pci/es1968.c
View File

@ -564,6 +564,7 @@ struct es1968 {
#ifdef CONFIG_SND_ES1968_RADIO #ifdef CONFIG_SND_ES1968_RADIO
struct v4l2_device v4l2_dev; struct v4l2_device v4l2_dev;
struct snd_tea575x tea; struct snd_tea575x tea;
unsigned int tea575x_tuner;
#endif #endif
}; };
@ -2557,37 +2558,47 @@ static int snd_es1968_input_register(struct es1968 *chip)
bits 1=unmask write to given bit */ bits 1=unmask write to given bit */
#define IO_DIR 8 /* direction register offset from GPIO_DATA #define IO_DIR 8 /* direction register offset from GPIO_DATA
bits 0/1=read/write direction */ bits 0/1=read/write direction */
/* mask bits for GPIO lines */
#define STR_DATA 0x0040 /* GPIO6 */ /* GPIO to TEA575x maps */
#define STR_CLK 0x0080 /* GPIO7 */ struct snd_es1968_tea575x_gpio {
#define STR_WREN 0x0100 /* GPIO8 */ u8 data, clk, wren, most;
#define STR_MOST 0x0200 /* GPIO9 */ char *name;
};
static struct snd_es1968_tea575x_gpio snd_es1968_tea575x_gpios[] = {
{ .data = 6, .clk = 7, .wren = 8, .most = 9, .name = "SF64-PCE2" },
{ .data = 7, .clk = 8, .wren = 6, .most = 10, .name = "M56VAP" },
};
#define get_tea575x_gpio(chip) \
(&snd_es1968_tea575x_gpios[(chip)->tea575x_tuner])
static void snd_es1968_tea575x_set_pins(struct snd_tea575x *tea, u8 pins) static void snd_es1968_tea575x_set_pins(struct snd_tea575x *tea, u8 pins)
{ {
struct es1968 *chip = tea->private_data; struct es1968 *chip = tea->private_data;
unsigned long io = chip->io_port + GPIO_DATA; struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
u16 val = 0; u16 val = 0;
val |= (pins & TEA575X_DATA) ? STR_DATA : 0; val |= (pins & TEA575X_DATA) ? (1 << gpio.data) : 0;
val |= (pins & TEA575X_CLK) ? STR_CLK : 0; val |= (pins & TEA575X_CLK) ? (1 << gpio.clk) : 0;
val |= (pins & TEA575X_WREN) ? STR_WREN : 0; val |= (pins & TEA575X_WREN) ? (1 << gpio.wren) : 0;
outw(val, io); outw(val, chip->io_port + GPIO_DATA);
} }
static u8 snd_es1968_tea575x_get_pins(struct snd_tea575x *tea) static u8 snd_es1968_tea575x_get_pins(struct snd_tea575x *tea)
{ {
struct es1968 *chip = tea->private_data; struct es1968 *chip = tea->private_data;
unsigned long io = chip->io_port + GPIO_DATA; struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
u16 val = inw(io); u16 val = inw(chip->io_port + GPIO_DATA);
u8 ret; u8 ret = 0;
ret = 0; if (val & (1 << gpio.data))
if (val & STR_DATA)
ret |= TEA575X_DATA; ret |= TEA575X_DATA;
if (val & STR_MOST) if (val & (1 << gpio.most))
ret |= TEA575X_MOST; ret |= TEA575X_MOST;
return ret; return ret;
} }
@ -2596,13 +2607,18 @@ static void snd_es1968_tea575x_set_direction(struct snd_tea575x *tea, bool outpu
struct es1968 *chip = tea->private_data; struct es1968 *chip = tea->private_data;
unsigned long io = chip->io_port + GPIO_DATA; unsigned long io = chip->io_port + GPIO_DATA;
u16 odir = inw(io + IO_DIR); u16 odir = inw(io + IO_DIR);
struct snd_es1968_tea575x_gpio gpio = *get_tea575x_gpio(chip);
if (output) { if (output) {
outw(~(STR_DATA | STR_CLK | STR_WREN), io + IO_MASK); outw(~((1 << gpio.data) | (1 << gpio.clk) | (1 << gpio.wren)),
outw(odir | STR_DATA | STR_CLK | STR_WREN, io + IO_DIR); io + IO_MASK);
outw(odir | (1 << gpio.data) | (1 << gpio.clk) | (1 << gpio.wren),
io + IO_DIR);
} else { } else {
outw(~(STR_CLK | STR_WREN | STR_DATA | STR_MOST), io + IO_MASK); outw(~((1 << gpio.clk) | (1 << gpio.wren) | (1 << gpio.data) | (1 << gpio.most)),
outw((odir & ~(STR_DATA | STR_MOST)) | STR_CLK | STR_WREN, io + IO_DIR); io + IO_MASK);
outw((odir & ~((1 << gpio.data) | (1 << gpio.most)))
| (1 << gpio.clk) | (1 << gpio.wren), io + IO_DIR);
} }
} }
@ -2772,6 +2788,9 @@ static int snd_es1968_create(struct snd_card *card,
snd_card_set_dev(card, &pci->dev); snd_card_set_dev(card, &pci->dev);
#ifdef CONFIG_SND_ES1968_RADIO #ifdef CONFIG_SND_ES1968_RADIO
/* don't play with GPIOs on laptops */
if (chip->pci->subsystem_vendor != 0x125d)
goto no_radio;
err = v4l2_device_register(&pci->dev, &chip->v4l2_dev); err = v4l2_device_register(&pci->dev, &chip->v4l2_dev);
if (err < 0) { if (err < 0) {
snd_es1968_free(chip); snd_es1968_free(chip);
@ -2781,10 +2800,18 @@ static int snd_es1968_create(struct snd_card *card,
chip->tea.private_data = chip; chip->tea.private_data = chip;
chip->tea.radio_nr = radio_nr; chip->tea.radio_nr = radio_nr;
chip->tea.ops = &snd_es1968_tea_ops; chip->tea.ops = &snd_es1968_tea_ops;
strlcpy(chip->tea.card, "SF64-PCE2", sizeof(chip->tea.card));
sprintf(chip->tea.bus_info, "PCI:%s", pci_name(pci)); sprintf(chip->tea.bus_info, "PCI:%s", pci_name(pci));
if (!snd_tea575x_init(&chip->tea, THIS_MODULE)) for (i = 0; i < ARRAY_SIZE(snd_es1968_tea575x_gpios); i++) {
printk(KERN_INFO "es1968: detected TEA575x radio\n"); chip->tea575x_tuner = i;
if (!snd_tea575x_init(&chip->tea, THIS_MODULE)) {
snd_printk(KERN_INFO "es1968: detected TEA575x radio type %s\n",
get_tea575x_gpio(chip)->name);
strlcpy(chip->tea.card, get_tea575x_gpio(chip)->name,
sizeof(chip->tea.card));
break;
}
}
no_radio:
#endif #endif
*chip_ret = chip; *chip_ret = chip;