This commit was manufactured by cvs2svn to create tag

[linux-2.6.git] / drivers / media / video / msp3400.c

diff --git a/drivers/media/video/msp3400.c b/drivers/media/video/msp3400.c
index 41adfef..e2ecf21 100644 (file)
--- a/drivers/media/video/msp3400.c
+++ b/drivers/media/video/msp3400.c
@@ -51,7 +51,6 @@
 #include <asm/pgtable.h>
 
 #include <media/audiochip.h>
-#include <media/id.h>
 #include "msp3400.h"
 
 /* insmod parameters */
@@ -81,7 +80,7 @@ struct msp3400c {
        int input;
 
        int muted;
-       int volume, balance;
+       int left, right;        /* volume */
        int bass, treble;
 
        /* shadow register set */
@@ -379,24 +378,26 @@ static void msp3400c_setcarrier(struct i2c_client *client, int cdo1, int cdo2)
 }
 
 static void msp3400c_setvolume(struct i2c_client *client,
-                              int muted, int volume, int balance)
+                              int muted, int left, int right)
 {
-       int val = 0, bal = 0;
+       int vol = 0,val = 0,balance = 0;
 
        if (!muted) {
-               val = (volume * 0x73 / 65535) << 8;
+               vol     = (left > right) ? left : right;
+               val     = (vol * 0x73 / 65535) << 8;
        }
-       if (val) {
-               bal = (balance / 256) - 128;
+       if (vol > 0) {
+               balance = ((right-left) * 127) / vol;
        }
+
        dprintk(KERN_DEBUG
                "msp34xx: setvolume: mute=%s %d:%d  v=0x%02x b=0x%02x\n",
-               muted ? "on" : "off", volume, balance, val>>8, bal);
+               muted ? "on" : "off", left, right, val>>8, balance);
        msp3400c_write(client,I2C_MSP3400C_DFP, 0x0000, val); /* loudspeaker */
        msp3400c_write(client,I2C_MSP3400C_DFP, 0x0006, val); /* headphones  */
        /* scart - on/off only */
        msp3400c_write(client,I2C_MSP3400C_DFP, 0x0007, val ? 0x4000 : 0);
-       msp3400c_write(client,I2C_MSP3400C_DFP, 0x0001, bal << 8);
+       msp3400c_write(client,I2C_MSP3400C_DFP, 0x0001, balance << 8);
 }
 
 static void msp3400c_setbass(struct i2c_client *client, int bass)
@@ -814,7 +815,7 @@ static int msp3400c_thread(void *data)
                        /* no carrier scan, just unmute */
                        printk("msp3400: thread: no carrier scan\n");
                        msp3400c_setvolume(client, msp->muted,
-                                          msp->volume, msp->balance);
+                                          msp->left, msp->right);
                        continue;
                }
                msp->restart = 0;
@@ -959,8 +960,7 @@ static int msp3400c_thread(void *data)
                }
 
                /* unmute + restore dfp registers */
-               msp3400c_setvolume(client, msp->muted,
-                                  msp->volume, msp->balance);
+               msp3400c_setvolume(client, msp->muted, msp->left, msp->right);
                msp3400c_restore_dfp(client);
 
                if (msp->watch_stereo)
@@ -1042,7 +1042,7 @@ static int msp3410d_thread(void *data)
                        /* no carrier scan needed, just unmute */
                        dprintk(KERN_DEBUG "msp3410: thread: no carrier scan\n");
                        msp3400c_setvolume(client, msp->muted,
-                                          msp->volume, msp->balance);
+                                          msp->left, msp->right);
                        continue;
                }
                msp->restart = 0;
@@ -1194,8 +1194,7 @@ static int msp3410d_thread(void *data)
                /* unmute + restore dfp registers */
                msp3400c_setbass(client, msp->bass);
                msp3400c_settreble(client, msp->treble);
-               msp3400c_setvolume(client, msp->muted,
-                                   msp->volume, msp->balance);
+               msp3400c_setvolume(client, msp->muted, msp->left, msp->right);
                msp3400c_restore_dfp(client);
 
                if (msp->watch_stereo)
@@ -1258,8 +1257,8 @@ static int msp_attach(struct i2c_adapter *adap, int addr, int kind)
        }
        
        memset(msp,0,sizeof(struct msp3400c));
-       msp->volume = 65535;
-       msp->balance = 32768;
+       msp->left   = 65535;
+       msp->right  = 65535;
        msp->bass   = 32768;
        msp->treble = 32768;
        msp->input  = -1;
@@ -1291,7 +1290,7 @@ static int msp_attach(struct i2c_adapter *adap, int addr, int kind)
        /* this will turn on a 1kHz beep - might be useful for debugging... */
        msp3400c_write(c,I2C_MSP3400C_DFP, 0x0014, 0x1040);
 #endif
-       msp3400c_setvolume(c, msp->muted, msp->volume, msp->balance);
+       msp3400c_setvolume(c,msp->muted,msp->left,msp->right);
 
        snprintf(c->name, sizeof(c->name), "MSP34%02d%c-%c%d",
                 (msp->rev2>>8)&0xff, (msp->rev1&0xff)+'@',
@@ -1441,10 +1440,8 @@ static int msp_command(struct i2c_client *client, unsigned int cmd, void *arg)
                } else {
                        /* set msp3400 to FM radio mode */
                        msp3400c_setmode(client,MSP_MODE_FM_RADIO);
-                       msp3400c_setcarrier(client, MSP_CARRIER(10.7),
-                                           MSP_CARRIER(10.7));
-                       msp3400c_setvolume(client, msp->muted,
-                                          msp->volume, msp->balance);
+                       msp3400c_setcarrier(client, MSP_CARRIER(10.7),MSP_CARRIER(10.7));
+                       msp3400c_setvolume(client,msp->muted,msp->left,msp->right);                     
                }
                if (msp->active)
                        msp->restart = 1;
@@ -1491,9 +1488,16 @@ static int msp_command(struct i2c_client *client, unsigned int cmd, void *arg)
                        VIDEO_AUDIO_MUTABLE;
                if (msp->muted)
                        va->flags |= VIDEO_AUDIO_MUTE;
+               va->volume=max(msp->left,msp->right);
 
-               va->volume = msp->volume;
-               va->balance = (va->volume) ? msp->balance : 32768;
+               if (0 == va->volume) {
+                       va->balance = 32768;
+               } else {
+                       va->balance = (32768 * min(msp->left,msp->right))
+                               / va->volume;
+                       va->balance = (msp->left<msp->right) ?
+                               (65535 - va->balance) : va->balance;
+               }
                va->bass = msp->bass;
                va->treble = msp->treble;
 
@@ -1509,13 +1513,13 @@ static int msp_command(struct i2c_client *client, unsigned int cmd, void *arg)
 
                dprintk(KERN_DEBUG "msp34xx: VIDIOCSAUDIO\n");
                msp->muted = (va->flags & VIDEO_AUDIO_MUTE);
-               msp->volume = va->volume;
-               msp->balance = va->balance;
+               msp->left = (min(65536 - va->balance,32768) *
+                            va->volume) / 32768;
+               msp->right = (min(va->balance,(__u16)32768) *
+                             va->volume) / 32768;
                msp->bass = va->bass;
                msp->treble = va->treble;
-
-               msp3400c_setvolume(client, msp->muted,
-                                  msp->volume, msp->balance);
+               msp3400c_setvolume(client,msp->muted,msp->left,msp->right);
                msp3400c_setbass(client,msp->bass);
                msp3400c_settreble(client,msp->treble);