patch-2.3.34 linux/drivers/char/tda9855.c

• Lines: 457
• Date: Thu Dec 16 13:59:38 1999
• Orig file: v2.3.33/linux/drivers/char/tda9855.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.3.33/linux/drivers/char/tda9855.c linux/drivers/char/tda9855.c
@@ -0,0 +1,456 @@
+/*
+ * For the TDA9855 chip (afaik, only the Diamond DTV2000 has this)
+ * This driver will not complain if used with a TDA9850 or any 
+ * other i2c device with the same address.
+ *
+ * Copyright (c) 1999 Steve VanDeBogart (vandebo@uclink.berkeley.edu)
+ * This code is placed under the terms of the GNU General Public License
+ * Based on tda8425.c by Greg Alexander (c) 1998
+ *
+ * TODO:
+ *   Fix channel change bug - sound goes out when changeing channels, mute
+ *                            and unmote to fix.
+ *   Fine tune sound
+ *   Get rest of capabilities into video_audio struct...
+ *
+ *  Revision: 0.1 
+ */
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/sched.h>
+#include <linux/string.h>
+#include <linux/timer.h>
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/malloc.h>
+#include <linux/videodev.h>
+#include <linux/i2c.h>
+#include <linux/i2c-algo-bit.h>
+
+#include "bttv.h"
+#include "audiochip.h"
+
+
+MODULE_PARM(debug,"i");
+static int debug = 0; /* insmod parameter */
+
+/* Addresses to scan */
+#define I2C_TDA9855_L        0xb4
+#define I2C_TDA9855_H        0xb6
+static unsigned short normal_i2c[] = {I2C_CLIENT_END};
+static unsigned short normal_i2c_range[] = {
+    I2C_TDA9855_L >> 1,
+    I2C_TDA9855_H >> 1,
+    I2C_CLIENT_END};
+static unsigned short probe[2]        = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short probe_range[2]  = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short ignore[2]       = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short ignore_range[2] = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short force[2]        = { I2C_CLIENT_END, I2C_CLIENT_END };
+static struct i2c_client_address_data addr_data = {
+	normal_i2c, normal_i2c_range, 
+	probe, probe_range, 
+	ignore, ignore_range, 
+	force
+};
+
+struct tda9855 {
+	int addr;
+	int rvol, lvol;
+	int bass, treble, sub;
+	int c1, c2, c3;
+	int a1, a2, a3;
+};
+
+static struct i2c_driver driver;
+static struct i2c_client client_template;
+
+
+#define dprintk  if (debug) printk
+
+                                 /* subaddresses */
+#define TDA9855_VR	0x00 /* Volume, right */
+#define TDA9855_VL	0x01 /* Volume, left */
+#define TDA9855_BA	0x02 /* Bass */
+#define TDA9855_TR	0x03 /* Treble */
+#define TDA9855_SW	0x04 /* Subwoofer - not connected on DTV2000 */
+#define TDA9855_C1	0x05 /* Control 1 */
+#define TDA9855_C2	0x06 /* Control 2 */
+#define TDA9855_C3	0x07 /* Control 3 */
+#define TDA9855_A1	0x08 /* Alignmnet 1*/
+#define TDA9855_A2	0x09 /* Alignmnet 2*/
+#define TDA9855_A3	0x0a /* Alignmnet 3*/
+				 /* Masks for bits in subaddresses */
+/* VR */ /* VL */
+/* lower 7 bits control gain from -71dB (0x28) to 16dB (0x7f)
+ * in 1dB steps - mute is 0x27 */
+
+/* BA */ 
+/* lower 5 bits control bass gain from -12dB (0x06) to 16.5dB (0x19)
+ * in .5dB steps - 0 is 0x0E */
+
+/* TR */
+/* 4 bits << 1 control treble gain from -12dB (0x3) to 12dB (0xb)
+ * in 3dB steps - 0 is 0x7 */
+
+/* SW */
+/* 4 bits << 2 control subwoofer/surraound gain from -14db (0x1) to 14db (0xf)
+ * in 3dB steps - mute is 0x0 */
+
+/* C1 */
+#define TDA9855_MUTE	1<<7 /* GMU, Mute at outputs */
+#define TDA9855_AVL	1<<6 /* AVL, Automatic Volume Level */
+#define TDA9855_LOUD	1<<5 /* Loudness, 1==off */
+#define TDA9855_SUR	1<<3 /* Surround / Subwoofer 1==.5(L-R) 0==.5(L+R) */
+				/* Bits 0 to 3 select various combinations
+                                 * of line in and line out, only the 
+                                 * interesting ones are defined */
+#define TDA9855_EXT	1<<2 /* Selects inputs LIR and LIL.  Pins 41 & 12 */
+#define TDA9855_INT	0    /* Selects inputs LOR and LOL.  (internal) */
+
+/* C2 */
+#define TDA9855_SAP	3<<6 /* Selects SAP output, mute if not received */
+#define TDA9855_STEREO	1<<6 /* Selects Stereo ouput, mono if not received */
+#define TDA9855_MONO	0    /* Forces Mono output */
+#define TDA9855_TZCM	1<<5 /* If set, don't mute till zero crossing */
+#define TDA9855_VZCM	1<<4 /* If set, don't change volume till zero crossing*/
+#define TDA9855_LMU	1<<3 /* Mute at LOR and LOL */
+#define TDA9855_LINEAR	0    /* Linear Stereo */
+#define TDA9855_PSEUDO	1    /* Pseudo Stereo */
+#define TDA9855_SPAT_30	2    /* Spatial Stereo, 30% anti-phase crosstalk */
+#define TDA9855_SPAT_50	3    /* Spatial Stereo, 52% anti-phase crosstalk */
+#define TDA9855_E_MONO	7    /* Forced mono - mono select elseware, so useless*/
+
+/* C3 */
+/* lower 4 bits control input gain from -3.5dB (0x0) to 4dB (0xF)
+ * in .5dB steps -  0 is 0x7 */
+
+/* A1 and A2 (read/write) */
+/* lower 5 bites are wideband and spectral expander alignment
+ * from 0x00 to 0x1f - nominal at 0x0f and 0x10 (read/write) */
+#define TDA9855_STP	1<<5 /* Stereo Pilot/detect (read-only) */
+#define TDA9855_SAPP	1<<6 /* SAP Pilot/detect (read-only) */
+#define TDA9855_STS	1<<7 /* Stereo trigger 1= <35mV 0= <30mV (write-only)*/
+
+/* A3 */
+/* lower 3 bits control timing current for alignment: -30% (0x0), -20% (0x1),
+ * -10% (0x2), nominal (0x3), +10% (0x6), +20% (0x5), +30% (0x4) */
+/* 2 bits << 5 control AVL attack time: 420ohm (0x0), 730ohm (0x2), 
+ * 1200ohm (0x1), 2100ohm (0x3) */
+#define TDA9855_ADJ	1<<7 /* Stereo adjust on/off (wideband and spectral) */
+
+
+/* Begin code */
+
+static int tda9855_write(struct i2c_client *client, int subaddr, int val)
+{
+	unsigned char buffer[2];
+	
+	buffer[0] = subaddr;
+	buffer[1] = val;
+	if (2 != i2c_master_send(client,buffer,2)) {
+		printk(KERN_WARNING "tda9855: I/O error, trying (write %d 0x%x)\n",
+		       subaddr, val);
+		return -1;
+	}
+	return 0;
+}
+
+static int tda9855_read(struct i2c_client *client)
+{
+	unsigned char buffer;
+	
+	if (1 != i2c_master_recv(client,&buffer,1)) {
+		printk(KERN_WARNING "tda9855: I/O error, trying (read)\n");
+		return -1;
+	}
+	return buffer;
+}
+
+static int tda9855_set(struct i2c_client *client)
+{
+	struct tda9855 *t = client->data;
+	unsigned char buf[16];
+	
+	dprintk(KERN_INFO "tda9855_set(0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x)\n",t->rvol,t->lvol,t->bass,t->treble,t->sub,
+		t->c1,t->c2,t->c3,t->a1,t->a2,t->a3);
+	buf[0]  = TDA9855_VR;
+	buf[1]  = t->rvol;
+	buf[2]  = t->lvol;
+	buf[3]  = t->bass;
+	buf[4]  = t->treble;
+	buf[5]  = t->sub;
+	buf[6]  = t->c1;
+	buf[7]  = t->c2;
+	buf[8]  = t->c3;
+	buf[9]  = t->a1;
+	buf[10] = t->a2;
+	buf[11] = t->a3;
+	if (12 != i2c_master_send(client,buf,12)) {
+		printk(KERN_WARNING "tda9855: I/O error, trying tda9855_set\n");
+		return -1;
+	}
+	return 0;
+}
+
+static void tda9855_init(struct i2c_client *client)
+{
+	struct tda9855 *t = client->data;
+
+	t->rvol=0x6f;         /* 0dB */
+	t->lvol=0x6f;		/* 0dB */
+	t->bass=0x0e;         /* 0dB */
+	t->treble=(0x07 << 1);  /* 0dB */
+	t->sub=0x8 << 2;      /* 0dB */
+	t->c1=TDA9855_MUTE | TDA9855_AVL | TDA9855_LOUD | TDA9855_INT;  
+	/* Set Mute, AVL, Loudness off, Internal sound */
+	t->c2=TDA9855_STEREO | TDA9855_LINEAR; /* Set Stereo liner mode */
+	t->c3=0x07;           /* 0dB input gain */
+	t->a1=0x10;	 	/* Select nominal wideband expander */
+	t->a2=0x10;		/* Select nominal spectral expander and 30mV trigger */
+	t->a3=0x3;            /* Set: nominal timinig current, 420ohm AVL attack */
+	tda9855_write(client, TDA9855_C1, TDA9855_MUTE); /* mute */
+	tda9855_set(client);
+}
+
+/* *********************** *
+ * i2c interface functions *
+ * *********************** */
+
+static int tda9855_attach(struct i2c_adapter *adap, int addr,
+			  unsigned short flags, int kind)
+{
+	struct tda9855 *t;
+	struct i2c_client *client;
+
+	client = kmalloc(sizeof *client,GFP_KERNEL);
+	if (!client)
+		return -ENOMEM;		
+        memcpy(client,&client_template,sizeof(struct i2c_client));
+        client->adapter = adap;
+        client->addr = addr;
+	
+	client->data = t = kmalloc(sizeof *t,GFP_KERNEL);
+	if (!t)
+		return -ENOMEM;
+	memset(t,0,sizeof *t);
+	tda9855_init(client);
+	MOD_INC_USE_COUNT;
+	strcpy(client->name,"TDA9855");
+	printk(KERN_INFO "tda9855: init\n");
+
+	i2c_attach_client(client);
+	return 0;
+}
+
+static int tda9855_probe(struct i2c_adapter *adap)
+{
+	if (adap->id == (I2C_ALGO_BIT | I2C_HW_B_BT848))
+		return i2c_probe(adap, &addr_data, tda9855_attach);
+	return 0;
+}
+
+static int tda9855_detach(struct i2c_client *client)
+{
+	struct tda9855 *t  = client->data;
+
+	tda9855_init(client);
+	i2c_detach_client(client);
+	
+	kfree(t);
+	kfree(client);
+	MOD_DEC_USE_COUNT;
+	return 0;
+}
+
+static int tda9855_command(struct i2c_client *client,
+			   unsigned int cmd, void *arg)
+{
+	struct tda9855 *t = client->data;
+#if 0
+	__u16 *sarg = arg;
+#endif
+
+	switch (cmd) {
+	/* --- v4l ioctls --- */
+	/* take care: bttv does userspace copying, we'll get a
+	   kernel pointer here... */
+	case VIDIOCGAUDIO:
+	{
+		struct video_audio *va = arg;
+		int left,right;
+
+		va->flags |= VIDEO_AUDIO_VOLUME |
+			VIDEO_AUDIO_BASS |
+			VIDEO_AUDIO_TREBLE;
+
+		/* min is 0x27 max is 0x7f, vstep is 2e8 */
+		left = (t->lvol-0x27)*0x2e8;
+		right = (t->rvol-0x27)*0x2e8;
+		va->volume=MAX(left,right);
+		va->balance=(32768*MIN(left,right))/
+			(va->volume ? va->volume : 1);
+		va->balance=(left<right)?
+			(65535-va->balance) : va->balance;
+		va->bass = (t->bass-0x6)*0xccc; /* min 0x6 max is 0x19 */
+		va->treble = ((t->treble>>1)-0x3)*0x1c71;
+
+		va->mode = ((TDA9855_STP | TDA9855_SAPP) & 
+			    tda9855_read(client)) >> 4;
+		if (0 == va->mode)
+			va->mode = VIDEO_SOUND_MONO;
+		break;
+	}
+	case VIDIOCSAUDIO:
+	{
+		struct video_audio *va = arg;
+		int left,right;
+
+		left = (MIN(65536 - va->balance,32768) *
+			va->volume) / 32768;
+		right = (MIN(va->balance,32768) *
+			 va->volume) / 32768;
+		t->lvol = left/0x2e8+0x27;
+		t->rvol = right/0x2e8+0x27;
+		t->bass = va->bass/0xccc+0x6;
+		t->treble = (va->treble/0x1c71+0x3)<<1;
+		tda9855_write(client,TDA9855_VL,t->lvol);
+		tda9855_write(client,TDA9855_VR,t->rvol);
+		tda9855_write(client,TDA9855_BA, t->bass);
+		tda9855_write(client,TDA9855_TR,t->treble);
+
+		switch (va->mode) {
+		case VIDEO_SOUND_MONO:
+			t->c2= TDA9855_MONO | (t->c2 & 0x3f);
+			break;
+		case VIDEO_SOUND_STEREO:
+			t->c2= TDA9855_STEREO | (t->c2 & 0x3f); 
+			break;
+		case VIDEO_SOUND_LANG2:
+			t->c2= TDA9855_SAP | (t->c2 & 0x3f); 
+			break;
+		}
+		tda9855_write(client,TDA9855_C2,t->c2);
+		break;
+	}
+
+#if 0
+	/* --- old, obsolete interface --- */
+	case AUDC_GET_VOLUME_LEFT:
+		*sarg = (t->lvol-0x27)*0x2e8; /* min is 0x27 max is 0x7f, vstep is 2e8 */
+		break;
+	case AUDC_GET_VOLUME_RIGHT:
+		*sarg = (t->rvol-0x27)*0x2e8;
+		break;
+	case AUDC_SET_VOLUME_LEFT:
+		t->lvol = *sarg/0x2e8+0x27;
+		break;
+	case AUDC_SET_VOLUME_RIGHT:
+		t->rvol = *sarg/0x2e8+0x27;
+		break;
+	case AUDC_GET_BASS:
+		*sarg = (t->bass-0x6)*0xccc; /* min 0x6 max is 0x19 */
+		break;
+	case AUDC_SET_BASS:
+		t->bass = *sarg/0xccc+0x6;
+		tda9855_write(client,TDA9855_BA, t->bass);
+		break;
+	case AUDC_GET_TREBLE:
+		*sarg = ((t->treble>>1)-0x3)*0x1c71;
+		break;
+	case AUDC_SET_TREBLE:
+		t->treble = (*sarg/0x1c71+0x3)<<1;
+		tda9855_write(client,TDA9855_TR,t->treble);
+		break;
+	case AUDC_GET_STEREO:
+		*sarg = ((TDA9855_STP | TDA9855_SAPP) & 
+			 tda9855_read(client)) >> 4;
+		if(*sarg==0) *sarg=VIDEO_SOUND_MONO;
+		break;
+	case AUDC_SET_STEREO:
+		if(*sarg==VIDEO_SOUND_MONO)
+			t->c2= TDA9855_MONO | (t->c2 & 0x3f); 
+		/* Mask out the sap and stereo bits and set mono */
+		else if(*sarg==VIDEO_SOUND_STEREO)
+			t->c2= TDA9855_STEREO | (t->c2 & 0x3f); 
+		/* Mask out the sap and stereo bits and set stereo */
+		else if(*sarg==VIDEO_SOUND_LANG2)
+			t->c2= TDA9855_SAP | (t->c2 & 0x3f); 
+		/* Mask out the sap and stereo bits and set sap */
+		tda9855_write(client,TDA9855_C2,t->c2);
+		break;
+	case AUDC_SET_INPUT:
+		dprintk(KERN_INFO "tda9855: SET_INPUT with 0x%04x\n",*sarg);
+		if((*sarg & (AUDIO_MUTE | AUDIO_OFF))!=0)
+			t->c1|=TDA9855_MUTE;
+		else
+			t->c1= t->c1 & 0x7f;  /* won't work -->  (~TDA9855_MUTE); */
+		if((*sarg & AUDIO_INTERN) == AUDIO_INTERN)
+			t->c1=(t->c1 & ~0x7) | TDA9855_INT;  /* 0x7 is a mask for the int/ext */
+		if((*sarg & AUDIO_EXTERN) == AUDIO_EXTERN)
+			t->c1=(t->c1 & ~0x7) | TDA9855_EXT;  /* 0x7 is a mask for the int/ext */
+		tda9855_write(client,TDA9855_C1,t->c1);
+		break;
+    case AUDC_SWITCH_MUTE:
+	    if((t->c1 & ~TDA9855_MUTE) == 0)
+		    t->c1|=TDA9855_MUTE;
+	    else
+		    t->c1&=~TDA9855_MUTE;
+	    tda9855_write(client,TDA9855_C1,t->c1);
+	    break;
+	    
+/* TDA9855 unsupported: */
+/*	case AUDC_NEWCHANNEL:
+	case AUDC_SET_RADIO:
+	case AUDC_GET_DC:
+*/
+#endif
+	default:
+		/* nothing */
+	}
+	return 0;
+}
+
+
+static struct i2c_driver driver = {
+        "i2c tda9855 driver",
+        I2C_DRIVERID_TDA9855, /* FIXME */
+        I2C_DF_NOTIFY,
+	tda9855_probe,
+        tda9855_detach,
+        tda9855_command,
+};
+
+static struct i2c_client client_template =
+{
+        "(unset)",		/* name */
+        -1,
+        0,
+        0,
+        NULL,
+        &driver
+};
+
+#ifdef MODULE
+int init_module(void)
+#else
+int tda9855_init(void)
+#endif
+{
+	i2c_add_driver(&driver);
+	return 0;
+}
+
+#ifdef MODULE
+void cleanup_module(void)
+{
+	i2c_add_driver(&driver);
+}
+#endif
+
+/*
+ * Local variables:
+ * c-basic-offset: 8
+ * End:
+ */