forked from mirrors/linux
		
	 1a59d1b8e0
			
		
	
	
		1a59d1b8e0
		
	
	
	
	
		
			
			Based on 1 normalized pattern(s): 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 extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 1334 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Reviewed-by: Richard Fontana <rfontana@redhat.com> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070033.113240726@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
		
			
				
	
	
		
			355 lines
		
	
	
	
		
			10 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			355 lines
		
	
	
	
		
			10 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| /*
 | |
|  *  Routines for control of the TEA6330T circuit via i2c bus
 | |
|  *  Sound fader control circuit for car radios by Philips Semiconductors
 | |
|  *  Copyright (c) by Jaroslav Kysela <perex@perex.cz>
 | |
|  */
 | |
| 
 | |
| #include <linux/init.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/module.h>
 | |
| #include <sound/core.h>
 | |
| #include <sound/control.h>
 | |
| #include <sound/tea6330t.h>
 | |
| 
 | |
| MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
 | |
| MODULE_DESCRIPTION("Routines for control of the TEA6330T circuit via i2c bus");
 | |
| MODULE_LICENSE("GPL");
 | |
| 
 | |
| #define TEA6330T_ADDR			(0x80>>1) /* fixed address */
 | |
| 
 | |
| #define TEA6330T_SADDR_VOLUME_LEFT	0x00	/* volume left */
 | |
| #define TEA6330T_SADDR_VOLUME_RIGHT	0x01	/* volume right */
 | |
| #define TEA6330T_SADDR_BASS		0x02	/* bass control */
 | |
| #define TEA6330T_SADDR_TREBLE		0x03	/* treble control */
 | |
| #define TEA6330T_SADDR_FADER		0x04	/* fader control */
 | |
| #define   TEA6330T_MFN			0x20	/* mute control for selected channels */
 | |
| #define   TEA6330T_FCH			0x10	/* select fader channels - front or rear */
 | |
| #define TEA6330T_SADDR_AUDIO_SWITCH	0x05	/* audio switch */
 | |
| #define   TEA6330T_GMU			0x80	/* mute control, general mute */
 | |
| #define   TEA6330T_EQN			0x40	/* equalizer switchover (0=equalizer-on) */
 | |
| 
 | |
| 
 | |
| struct tea6330t {
 | |
| 	struct snd_i2c_device *device;
 | |
| 	struct snd_i2c_bus *bus;
 | |
| 	int equalizer;
 | |
| 	int fader;
 | |
| 	unsigned char regs[8];
 | |
| 	unsigned char mleft, mright;
 | |
| 	unsigned char bass, treble;
 | |
| 	unsigned char max_bass, max_treble;
 | |
| };
 | |
| 
 | |
| 
 | |
| int snd_tea6330t_detect(struct snd_i2c_bus *bus, int equalizer)
 | |
| {
 | |
| 	int res;
 | |
| 
 | |
| 	snd_i2c_lock(bus);
 | |
| 	res = snd_i2c_probeaddr(bus, TEA6330T_ADDR);
 | |
| 	snd_i2c_unlock(bus);
 | |
| 	return res;
 | |
| }
 | |
| 
 | |
| #if 0
 | |
| static void snd_tea6330t_set(struct tea6330t *tea,
 | |
| 			     unsigned char addr, unsigned char value)
 | |
| {
 | |
| #if 0
 | |
| 	printk(KERN_DEBUG "set - 0x%x/0x%x\n", addr, value);
 | |
| #endif
 | |
| 	snd_i2c_write(tea->bus, TEA6330T_ADDR, addr, value, 1);
 | |
| }
 | |
| #endif
 | |
| 
 | |
| #define TEA6330T_MASTER_VOLUME(xname, xindex) \
 | |
| { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
 | |
|   .info = snd_tea6330t_info_master_volume, \
 | |
|   .get = snd_tea6330t_get_master_volume, .put = snd_tea6330t_put_master_volume }
 | |
| 
 | |
| static int snd_tea6330t_info_master_volume(struct snd_kcontrol *kcontrol,
 | |
| 					   struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
| 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 | |
| 	uinfo->count = 2;
 | |
| 	uinfo->value.integer.min = 0;
 | |
| 	uinfo->value.integer.max = 43;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_tea6330t_get_master_volume(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	
 | |
| 	snd_i2c_lock(tea->bus);
 | |
| 	ucontrol->value.integer.value[0] = tea->mleft - 0x14;
 | |
| 	ucontrol->value.integer.value[1] = tea->mright - 0x14;
 | |
| 	snd_i2c_unlock(tea->bus);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_tea6330t_put_master_volume(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	int change, count, err;
 | |
| 	unsigned char bytes[3];
 | |
| 	unsigned char val1, val2;
 | |
| 	
 | |
| 	val1 = (ucontrol->value.integer.value[0] % 44) + 0x14;
 | |
| 	val2 = (ucontrol->value.integer.value[1] % 44) + 0x14;
 | |
| 	snd_i2c_lock(tea->bus);
 | |
| 	change = val1 != tea->mleft || val2 != tea->mright;
 | |
| 	tea->mleft = val1;
 | |
| 	tea->mright = val2;
 | |
| 	count = 0;
 | |
| 	if (tea->regs[TEA6330T_SADDR_VOLUME_LEFT] != 0) {
 | |
| 		bytes[count++] = TEA6330T_SADDR_VOLUME_LEFT;
 | |
| 		bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = tea->mleft;
 | |
| 	}
 | |
| 	if (tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] != 0) {
 | |
| 		if (count == 0)
 | |
| 			bytes[count++] = TEA6330T_SADDR_VOLUME_RIGHT;
 | |
| 		bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = tea->mright;
 | |
| 	}
 | |
| 	if (count > 0) {
 | |
| 		if ((err = snd_i2c_sendbytes(tea->device, bytes, count)) < 0)
 | |
| 			change = err;
 | |
| 	}
 | |
| 	snd_i2c_unlock(tea->bus);
 | |
| 	return change;
 | |
| }
 | |
| 
 | |
| #define TEA6330T_MASTER_SWITCH(xname, xindex) \
 | |
| { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
 | |
|   .info = snd_tea6330t_info_master_switch, \
 | |
|   .get = snd_tea6330t_get_master_switch, .put = snd_tea6330t_put_master_switch }
 | |
| 
 | |
| #define snd_tea6330t_info_master_switch		snd_ctl_boolean_stereo_info
 | |
| 
 | |
| static int snd_tea6330t_get_master_switch(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	
 | |
| 	snd_i2c_lock(tea->bus);
 | |
| 	ucontrol->value.integer.value[0] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
 | |
| 	ucontrol->value.integer.value[1] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
 | |
| 	snd_i2c_unlock(tea->bus);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_tea6330t_put_master_switch(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	int change, err;
 | |
| 	unsigned char bytes[3];
 | |
| 	unsigned char oval1, oval2, val1, val2;
 | |
| 	
 | |
| 	val1 = ucontrol->value.integer.value[0] & 1;
 | |
| 	val2 = ucontrol->value.integer.value[1] & 1;
 | |
| 	snd_i2c_lock(tea->bus);
 | |
| 	oval1 = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
 | |
| 	oval2 = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
 | |
| 	change = val1 != oval1 || val2 != oval2;
 | |
| 	tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = val1 ? tea->mleft : 0;
 | |
| 	tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = val2 ? tea->mright : 0;
 | |
| 	bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
 | |
| 	bytes[1] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT];
 | |
| 	bytes[2] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT];
 | |
| 	if ((err = snd_i2c_sendbytes(tea->device, bytes, 3)) < 0)
 | |
| 		change = err;
 | |
| 	snd_i2c_unlock(tea->bus);
 | |
| 	return change;
 | |
| }
 | |
| 
 | |
| #define TEA6330T_BASS(xname, xindex) \
 | |
| { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
 | |
|   .info = snd_tea6330t_info_bass, \
 | |
|   .get = snd_tea6330t_get_bass, .put = snd_tea6330t_put_bass }
 | |
| 
 | |
| static int snd_tea6330t_info_bass(struct snd_kcontrol *kcontrol,
 | |
| 				  struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 
 | |
| 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 | |
| 	uinfo->count = 1;
 | |
| 	uinfo->value.integer.min = 0;
 | |
| 	uinfo->value.integer.max = tea->max_bass;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_tea6330t_get_bass(struct snd_kcontrol *kcontrol,
 | |
| 				 struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	
 | |
| 	ucontrol->value.integer.value[0] = tea->bass;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_tea6330t_put_bass(struct snd_kcontrol *kcontrol,
 | |
| 				 struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	int change, err;
 | |
| 	unsigned char bytes[2];
 | |
| 	unsigned char val1;
 | |
| 	
 | |
| 	val1 = ucontrol->value.integer.value[0] % (tea->max_bass + 1);
 | |
| 	snd_i2c_lock(tea->bus);
 | |
| 	tea->bass = val1;
 | |
| 	val1 += tea->equalizer ? 7 : 3;
 | |
| 	change = tea->regs[TEA6330T_SADDR_BASS] != val1;
 | |
| 	bytes[0] = TEA6330T_SADDR_BASS;
 | |
| 	bytes[1] = tea->regs[TEA6330T_SADDR_BASS] = val1;
 | |
| 	if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
 | |
| 		change = err;
 | |
| 	snd_i2c_unlock(tea->bus);
 | |
| 	return change;
 | |
| }
 | |
| 
 | |
| #define TEA6330T_TREBLE(xname, xindex) \
 | |
| { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
 | |
|   .info = snd_tea6330t_info_treble, \
 | |
|   .get = snd_tea6330t_get_treble, .put = snd_tea6330t_put_treble }
 | |
| 
 | |
| static int snd_tea6330t_info_treble(struct snd_kcontrol *kcontrol,
 | |
| 				    struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 
 | |
| 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 | |
| 	uinfo->count = 1;
 | |
| 	uinfo->value.integer.min = 0;
 | |
| 	uinfo->value.integer.max = tea->max_treble;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_tea6330t_get_treble(struct snd_kcontrol *kcontrol,
 | |
| 				   struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	
 | |
| 	ucontrol->value.integer.value[0] = tea->treble;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_tea6330t_put_treble(struct snd_kcontrol *kcontrol,
 | |
| 				   struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 | |
| 	int change, err;
 | |
| 	unsigned char bytes[2];
 | |
| 	unsigned char val1;
 | |
| 	
 | |
| 	val1 = ucontrol->value.integer.value[0] % (tea->max_treble + 1);
 | |
| 	snd_i2c_lock(tea->bus);
 | |
| 	tea->treble = val1;
 | |
| 	val1 += 3;
 | |
| 	change = tea->regs[TEA6330T_SADDR_TREBLE] != val1;
 | |
| 	bytes[0] = TEA6330T_SADDR_TREBLE;
 | |
| 	bytes[1] = tea->regs[TEA6330T_SADDR_TREBLE] = val1;
 | |
| 	if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
 | |
| 		change = err;
 | |
| 	snd_i2c_unlock(tea->bus);
 | |
| 	return change;
 | |
| }
 | |
| 
 | |
| static struct snd_kcontrol_new snd_tea6330t_controls[] = {
 | |
| TEA6330T_MASTER_SWITCH("Master Playback Switch", 0),
 | |
| TEA6330T_MASTER_VOLUME("Master Playback Volume", 0),
 | |
| TEA6330T_BASS("Tone Control - Bass", 0),
 | |
| TEA6330T_TREBLE("Tone Control - Treble", 0)
 | |
| };
 | |
| 
 | |
| static void snd_tea6330_free(struct snd_i2c_device *device)
 | |
| {
 | |
| 	kfree(device->private_data);
 | |
| }
 | |
|                                         
 | |
| int snd_tea6330t_update_mixer(struct snd_card *card,
 | |
| 			      struct snd_i2c_bus *bus,
 | |
| 			      int equalizer, int fader)
 | |
| {
 | |
| 	struct snd_i2c_device *device;
 | |
| 	struct tea6330t *tea;
 | |
| 	struct snd_kcontrol_new *knew;
 | |
| 	unsigned int idx;
 | |
| 	int err = -ENOMEM;
 | |
| 	u8 default_treble, default_bass;
 | |
| 	unsigned char bytes[7];
 | |
| 
 | |
| 	tea = kzalloc(sizeof(*tea), GFP_KERNEL);
 | |
| 	if (tea == NULL)
 | |
| 		return -ENOMEM;
 | |
| 	if ((err = snd_i2c_device_create(bus, "TEA6330T", TEA6330T_ADDR, &device)) < 0) {
 | |
| 		kfree(tea);
 | |
| 		return err;
 | |
| 	}
 | |
| 	tea->device = device;
 | |
| 	tea->bus = bus;
 | |
| 	tea->equalizer = equalizer;
 | |
| 	tea->fader = fader;
 | |
| 	device->private_data = tea;
 | |
| 	device->private_free = snd_tea6330_free;
 | |
| 
 | |
| 	snd_i2c_lock(bus);
 | |
| 
 | |
| 	/* turn fader off and handle equalizer */
 | |
| 	tea->regs[TEA6330T_SADDR_FADER] = 0x3f;
 | |
| 	tea->regs[TEA6330T_SADDR_AUDIO_SWITCH] = equalizer ? 0 : TEA6330T_EQN;
 | |
| 	/* initialize mixer */
 | |
| 	if (!tea->equalizer) {
 | |
| 		tea->max_bass = 9;
 | |
| 		tea->max_treble = 8;
 | |
| 		default_bass = 3 + 4;
 | |
| 		tea->bass = 4;
 | |
| 		default_treble = 3 + 4;
 | |
| 		tea->treble = 4;
 | |
| 	} else {
 | |
| 		tea->max_bass = 5;
 | |
| 		tea->max_treble = 0;
 | |
| 		default_bass = 7 + 4;
 | |
| 		tea->bass = 4;
 | |
| 		default_treble = 3;
 | |
| 		tea->treble = 0;
 | |
| 	}
 | |
| 	tea->mleft = tea->mright = 0x14;
 | |
| 	tea->regs[TEA6330T_SADDR_BASS] = default_bass;
 | |
| 	tea->regs[TEA6330T_SADDR_TREBLE] = default_treble;
 | |
| 
 | |
| 	/* compose I2C message and put the hardware to initial state */
 | |
| 	bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
 | |
| 	for (idx = 0; idx < 6; idx++)
 | |
| 		bytes[idx+1] = tea->regs[idx];
 | |
| 	if ((err = snd_i2c_sendbytes(device, bytes, 7)) < 0)
 | |
| 		goto __error;
 | |
| 
 | |
| 	strcat(card->mixername, ",TEA6330T");
 | |
| 	if ((err = snd_component_add(card, "TEA6330T")) < 0)
 | |
| 		goto __error;
 | |
| 
 | |
| 	for (idx = 0; idx < ARRAY_SIZE(snd_tea6330t_controls); idx++) {
 | |
| 		knew = &snd_tea6330t_controls[idx];
 | |
| 		if (tea->treble == 0 && !strcmp(knew->name, "Tone Control - Treble"))
 | |
| 			continue;
 | |
| 		if ((err = snd_ctl_add(card, snd_ctl_new1(knew, tea))) < 0)
 | |
| 			goto __error;
 | |
| 	}
 | |
| 
 | |
| 	snd_i2c_unlock(bus);
 | |
| 	return 0;
 | |
| 	
 | |
|       __error:
 | |
|       	snd_i2c_unlock(bus);
 | |
|       	snd_i2c_device_free(device);
 | |
|       	return err;
 | |
| }
 | |
| 
 | |
| EXPORT_SYMBOL(snd_tea6330t_detect);
 | |
| EXPORT_SYMBOL(snd_tea6330t_update_mixer);
 |