[deliverable/linux.git] / sound / i2c / tea6330t.c

/*
 *  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>
 *
 *
 *   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/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);

/*
 *  INIT part
 */

static int __init alsa_tea6330t_init(void)
{
	return 0;
}

static void __exit alsa_tea6330t_exit(void)
{
}

module_init(alsa_tea6330t_init)
module_exit(alsa_tea6330t_exit)
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Routines for control of the TEA6330T circuit via i2c bus
	3	* Sound fader control circuit for car radios by Philips Semiconductors
c1017a4c	4	* Copyright (c) by Jaroslav Kysela <perex@perex.cz>
1da177e4 LT	5	*
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License, or
	10	* (at your option) any later version.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
	18	* along with this program; if not, write to the Free Software
	19	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	20	*
	21	*/
	22
1da177e4 LT	23	#include <linux/init.h>
1da177e4 LT	24	#include <linux/slab.h>
da155d5b	25	#include <linux/module.h>
1da177e4	26	#include <sound/core.h>
c8714ba1	27	#include <sound/control.h>
1da177e4 LT	28	#include <sound/tea6330t.h>
1da177e4 LT	29
c1017a4c	30	MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
1da177e4 LT	31	MODULE_DESCRIPTION("Routines for control of the TEA6330T circuit via i2c bus");
	32	MODULE_LICENSE("GPL");
	33
	34	#define TEA6330T_ADDR (0x80>>1) /* fixed address */
	35
	36	#define TEA6330T_SADDR_VOLUME_LEFT 0x00 /* volume left */
	37	#define TEA6330T_SADDR_VOLUME_RIGHT 0x01 /* volume right */
	38	#define TEA6330T_SADDR_BASS 0x02 /* bass control */
	39	#define TEA6330T_SADDR_TREBLE 0x03 /* treble control */
	40	#define TEA6330T_SADDR_FADER 0x04 /* fader control */
	41	#define TEA6330T_MFN 0x20 /* mute control for selected channels */
	42	#define TEA6330T_FCH 0x10 /* select fader channels - front or rear */
	43	#define TEA6330T_SADDR_AUDIO_SWITCH 0x05 /* audio switch */
	44	#define TEA6330T_GMU 0x80 /* mute control, general mute */
	45	#define TEA6330T_EQN 0x40 /* equalizer switchover (0=equalizer-on) */
	46
97f02e05 TI	47
	48	struct tea6330t {
	49	struct snd_i2c_device *device;
	50	struct snd_i2c_bus *bus;
c8714ba1 TI	51	int equalizer;
	52	int fader;
	53	unsigned char regs[8];
	54	unsigned char mleft, mright;
	55	unsigned char bass, treble;
	56	unsigned char max_bass, max_treble;
97f02e05 TI	57	};
97f02e05 TI	58
c8714ba1	59
97f02e05	60	int snd_tea6330t_detect(struct snd_i2c_bus *bus, int equalizer)
1da177e4 LT	61	{
	62	int res;
	63
	64	snd_i2c_lock(bus);
	65	res = snd_i2c_probeaddr(bus, TEA6330T_ADDR);
	66	snd_i2c_unlock(bus);
	67	return res;
	68	}
	69
	70	#if 0
97f02e05	71	static void snd_tea6330t_set(struct tea6330t *tea,
1da177e4 LT	72	unsigned char addr, unsigned char value)
	73	{
	74	#if 0
99b359ba	75	printk(KERN_DEBUG "set - 0x%x/0x%x\n", addr, value);
1da177e4 LT	76	#endif
	77	snd_i2c_write(tea->bus, TEA6330T_ADDR, addr, value, 1);
	78	}
	79	#endif
	80
	81	#define TEA6330T_MASTER_VOLUME(xname, xindex) \
	82	{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
	83	.info = snd_tea6330t_info_master_volume, \
	84	.get = snd_tea6330t_get_master_volume, .put = snd_tea6330t_put_master_volume }
	85
97f02e05 TI	86	static int snd_tea6330t_info_master_volume(struct snd_kcontrol *kcontrol,
97f02e05 TI	87	struct snd_ctl_elem_info *uinfo)
1da177e4 LT	88	{
	89	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
	90	uinfo->count = 2;
	91	uinfo->value.integer.min = 0;
	92	uinfo->value.integer.max = 43;
	93	return 0;
	94	}
	95
97f02e05 TI	96	static int snd_tea6330t_get_master_volume(struct snd_kcontrol *kcontrol,
97f02e05 TI	97	struct snd_ctl_elem_value *ucontrol)
1da177e4	98	{
97f02e05	99	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	100
	101	snd_i2c_lock(tea->bus);
	102	ucontrol->value.integer.value[0] = tea->mleft - 0x14;
	103	ucontrol->value.integer.value[1] = tea->mright - 0x14;
	104	snd_i2c_unlock(tea->bus);
	105	return 0;
	106	}
	107
97f02e05 TI	108	static int snd_tea6330t_put_master_volume(struct snd_kcontrol *kcontrol,
97f02e05 TI	109	struct snd_ctl_elem_value *ucontrol)
1da177e4	110	{
97f02e05	111	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	112	int change, count, err;
	113	unsigned char bytes[3];
	114	unsigned char val1, val2;
	115
	116	val1 = (ucontrol->value.integer.value[0] % 44) + 0x14;
	117	val2 = (ucontrol->value.integer.value[1] % 44) + 0x14;
	118	snd_i2c_lock(tea->bus);
	119	change = val1 != tea->mleft \|\| val2 != tea->mright;
	120	tea->mleft = val1;
	121	tea->mright = val2;
	122	count = 0;
	123	if (tea->regs[TEA6330T_SADDR_VOLUME_LEFT] != 0) {
	124	bytes[count++] = TEA6330T_SADDR_VOLUME_LEFT;
	125	bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = tea->mleft;
	126	}
	127	if (tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] != 0) {
	128	if (count == 0)
	129	bytes[count++] = TEA6330T_SADDR_VOLUME_RIGHT;
	130	bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = tea->mright;
	131	}
	132	if (count > 0) {
	133	if ((err = snd_i2c_sendbytes(tea->device, bytes, count)) < 0)
	134	change = err;
	135	}
	136	snd_i2c_unlock(tea->bus);
	137	return change;
	138	}
	139
	140	#define TEA6330T_MASTER_SWITCH(xname, xindex) \
	141	{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
	142	.info = snd_tea6330t_info_master_switch, \
	143	.get = snd_tea6330t_get_master_switch, .put = snd_tea6330t_put_master_switch }
	144
a5ce8890	145	#define snd_tea6330t_info_master_switch snd_ctl_boolean_stereo_info
1da177e4	146
97f02e05 TI	147	static int snd_tea6330t_get_master_switch(struct snd_kcontrol *kcontrol,
97f02e05 TI	148	struct snd_ctl_elem_value *ucontrol)
1da177e4	149	{
97f02e05	150	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	151
	152	snd_i2c_lock(tea->bus);
	153	ucontrol->value.integer.value[0] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
	154	ucontrol->value.integer.value[1] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
	155	snd_i2c_unlock(tea->bus);
	156	return 0;
	157	}
	158
97f02e05 TI	159	static int snd_tea6330t_put_master_switch(struct snd_kcontrol *kcontrol,
97f02e05 TI	160	struct snd_ctl_elem_value *ucontrol)
1da177e4	161	{
97f02e05	162	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	163	int change, err;
	164	unsigned char bytes[3];
	165	unsigned char oval1, oval2, val1, val2;
	166
	167	val1 = ucontrol->value.integer.value[0] & 1;
	168	val2 = ucontrol->value.integer.value[1] & 1;
	169	snd_i2c_lock(tea->bus);
	170	oval1 = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
	171	oval2 = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
	172	change = val1 != oval1 \|\| val2 != oval2;
	173	tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = val1 ? tea->mleft : 0;
	174	tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = val2 ? tea->mright : 0;
	175	bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
	176	bytes[1] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT];
	177	bytes[2] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT];
	178	if ((err = snd_i2c_sendbytes(tea->device, bytes, 3)) < 0)
	179	change = err;
	180	snd_i2c_unlock(tea->bus);
	181	return change;
	182	}
	183
	184	#define TEA6330T_BASS(xname, xindex) \
	185	{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
	186	.info = snd_tea6330t_info_bass, \
	187	.get = snd_tea6330t_get_bass, .put = snd_tea6330t_put_bass }
	188
97f02e05 TI	189	static int snd_tea6330t_info_bass(struct snd_kcontrol *kcontrol,
97f02e05 TI	190	struct snd_ctl_elem_info *uinfo)
1da177e4	191	{
97f02e05	192	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	193
	194	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
	195	uinfo->count = 1;
	196	uinfo->value.integer.min = 0;
	197	uinfo->value.integer.max = tea->max_bass;
	198	return 0;
	199	}
	200
97f02e05 TI	201	static int snd_tea6330t_get_bass(struct snd_kcontrol *kcontrol,
97f02e05 TI	202	struct snd_ctl_elem_value *ucontrol)
1da177e4	203	{
97f02e05	204	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	205
	206	ucontrol->value.integer.value[0] = tea->bass;
	207	return 0;
	208	}
	209
97f02e05 TI	210	static int snd_tea6330t_put_bass(struct snd_kcontrol *kcontrol,
97f02e05 TI	211	struct snd_ctl_elem_value *ucontrol)
1da177e4	212	{
97f02e05	213	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	214	int change, err;
	215	unsigned char bytes[2];
	216	unsigned char val1;
	217
	218	val1 = ucontrol->value.integer.value[0] % (tea->max_bass + 1);
	219	snd_i2c_lock(tea->bus);
	220	tea->bass = val1;
	221	val1 += tea->equalizer ? 7 : 3;
	222	change = tea->regs[TEA6330T_SADDR_BASS] != val1;
	223	bytes[0] = TEA6330T_SADDR_BASS;
	224	bytes[1] = tea->regs[TEA6330T_SADDR_BASS] = val1;
	225	if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
	226	change = err;
	227	snd_i2c_unlock(tea->bus);
	228	return change;
	229	}
	230
	231	#define TEA6330T_TREBLE(xname, xindex) \
	232	{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
	233	.info = snd_tea6330t_info_treble, \
	234	.get = snd_tea6330t_get_treble, .put = snd_tea6330t_put_treble }
	235
97f02e05 TI	236	static int snd_tea6330t_info_treble(struct snd_kcontrol *kcontrol,
97f02e05 TI	237	struct snd_ctl_elem_info *uinfo)
1da177e4	238	{
97f02e05	239	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	240
	241	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
	242	uinfo->count = 1;
	243	uinfo->value.integer.min = 0;
	244	uinfo->value.integer.max = tea->max_treble;
	245	return 0;
	246	}
	247
97f02e05 TI	248	static int snd_tea6330t_get_treble(struct snd_kcontrol *kcontrol,
97f02e05 TI	249	struct snd_ctl_elem_value *ucontrol)
1da177e4	250	{
97f02e05	251	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	252
	253	ucontrol->value.integer.value[0] = tea->treble;
	254	return 0;
	255	}
	256
97f02e05 TI	257	static int snd_tea6330t_put_treble(struct snd_kcontrol *kcontrol,
97f02e05 TI	258	struct snd_ctl_elem_value *ucontrol)
1da177e4	259	{
97f02e05	260	struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
1da177e4 LT	261	int change, err;
	262	unsigned char bytes[2];
	263	unsigned char val1;
	264
	265	val1 = ucontrol->value.integer.value[0] % (tea->max_treble + 1);
	266	snd_i2c_lock(tea->bus);
	267	tea->treble = val1;
	268	val1 += 3;
	269	change = tea->regs[TEA6330T_SADDR_TREBLE] != val1;
	270	bytes[0] = TEA6330T_SADDR_TREBLE;
	271	bytes[1] = tea->regs[TEA6330T_SADDR_TREBLE] = val1;
	272	if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
	273	change = err;
	274	snd_i2c_unlock(tea->bus);
	275	return change;
	276	}
	277
97f02e05	278	static struct snd_kcontrol_new snd_tea6330t_controls[] = {
1da177e4 LT	279	TEA6330T_MASTER_SWITCH("Master Playback Switch", 0),
	280	TEA6330T_MASTER_VOLUME("Master Playback Volume", 0),
	281	TEA6330T_BASS("Tone Control - Bass", 0),
	282	TEA6330T_TREBLE("Tone Control - Treble", 0)
	283	};
	284
97f02e05	285	static void snd_tea6330_free(struct snd_i2c_device *device)
1da177e4	286	{
4d572776	287	kfree(device->private_data);
1da177e4 LT	288	}
1da177e4 LT	289
97f02e05 TI	290	int snd_tea6330t_update_mixer(struct snd_card *card,
97f02e05 TI	291	struct snd_i2c_bus *bus,
1da177e4 LT	292	int equalizer, int fader)
1da177e4 LT	293	{
97f02e05 TI	294	struct snd_i2c_device *device;
	295	struct tea6330t *tea;
	296	struct snd_kcontrol_new *knew;
1da177e4 LT	297	unsigned int idx;
	298	int err = -ENOMEM;
	299	u8 default_treble, default_bass;
	300	unsigned char bytes[7];
	301
561b220a	302	tea = kzalloc(sizeof(*tea), GFP_KERNEL);
1da177e4 LT	303	if (tea == NULL)
	304	return -ENOMEM;
	305	if ((err = snd_i2c_device_create(bus, "TEA6330T", TEA6330T_ADDR, &device)) < 0) {
	306	kfree(tea);
	307	return err;
	308	}
	309	tea->device = device;
	310	tea->bus = bus;
	311	tea->equalizer = equalizer;
	312	tea->fader = fader;
	313	device->private_data = tea;
	314	device->private_free = snd_tea6330_free;
	315
	316	snd_i2c_lock(bus);
	317
	318	/* turn fader off and handle equalizer */
	319	tea->regs[TEA6330T_SADDR_FADER] = 0x3f;
	320	tea->regs[TEA6330T_SADDR_AUDIO_SWITCH] = equalizer ? 0 : TEA6330T_EQN;
	321	/* initialize mixer */
	322	if (!tea->equalizer) {
	323	tea->max_bass = 9;
	324	tea->max_treble = 8;
	325	default_bass = 3 + 4;
	326	tea->bass = 4;
	327	default_treble = 3 + 4;
	328	tea->treble = 4;
	329	} else {
	330	tea->max_bass = 5;
	331	tea->max_treble = 0;
	332	default_bass = 7 + 4;
	333	tea->bass = 4;
	334	default_treble = 3;
	335	tea->treble = 0;
	336	}
	337	tea->mleft = tea->mright = 0x14;
	338	tea->regs[TEA6330T_SADDR_BASS] = default_bass;
	339	tea->regs[TEA6330T_SADDR_TREBLE] = default_treble;
	340
	341	/* compose I2C message and put the hardware to initial state */
	342	bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
	343	for (idx = 0; idx < 6; idx++)
	344	bytes[idx+1] = tea->regs[idx];
	345	if ((err = snd_i2c_sendbytes(device, bytes, 7)) < 0)
	346	goto __error;
	347
	348	strcat(card->mixername, ",TEA6330T");
	349	if ((err = snd_component_add(card, "TEA6330T")) < 0)
	350	goto __error;
	351
	352	for (idx = 0; idx < ARRAY_SIZE(snd_tea6330t_controls); idx++) {
	353	knew = &snd_tea6330t_controls[idx];
	354	if (tea->treble == 0 && !strcmp(knew->name, "Tone Control - Treble"))
	355	continue;
	356	if ((err = snd_ctl_add(card, snd_ctl_new1(knew, tea))) < 0)
	357	goto __error;
	358	}
	359
	360	snd_i2c_unlock(bus);
	361	return 0;
	362
	363	__error:
	364	snd_i2c_unlock(bus);
	365	snd_i2c_device_free(device);
	366	return err;
367	}
368
369	EXPORT_SYMBOL(snd_tea6330t_detect);
370	EXPORT_SYMBOL(snd_tea6330t_update_mixer);
371
372	/*
373	* INIT part
374	*/
375
376	static int __init alsa_tea6330t_init(void)
377	{
378	return 0;
379	}
380
381	static void __exit alsa_tea6330t_exit(void)
382	{
383	}
384
385	module_init(alsa_tea6330t_init)
386	module_exit(alsa_tea6330t_exit)