[linux-block.git] / sound / i2c / tea6330t.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) {
		err = snd_i2c_sendbytes(tea->device, bytes, count);
		if (err < 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];
	err = snd_i2c_sendbytes(tea->device, bytes, 3);
	if (err < 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;
	err = snd_i2c_sendbytes(tea->device, bytes, 2);
	if (err < 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;
	err = snd_i2c_sendbytes(tea->device, bytes, 2);
	if (err < 0)
		change = err;
	snd_i2c_unlock(tea->bus);
	return change;
}

static const 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;
	const struct snd_kcontrol_new *knew;
	unsigned int idx;
	int err;
	u8 default_treble, default_bass;
	unsigned char bytes[7];

	tea = kzalloc(sizeof(*tea), GFP_KERNEL);
	if (tea == NULL)
		return -ENOMEM;
	err = snd_i2c_device_create(bus, "TEA6330T", TEA6330T_ADDR, &device);
	if (err < 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];
	err = snd_i2c_sendbytes(device, bytes, 7);
	if (err < 0)
		goto __error;

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