[media] mxb: fix audio handling

Instead of using custom ioctls use the VIDIOC_ENUM/G/S/_AUDIO ioctls.
Also send the same audio to both CDROM-out and line-out.

This is what you would expect and anyway, the CDROM-out connector is unlikely
to be used these days as it is obsolete.

Signed-off-by: Hans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

diff --git a/drivers/media/video/mxb.c b/drivers/media/video/mxb.c
index aa3d75c..a698c24 100644 (file)
--- a/drivers/media/video/mxb.c
+++ b/drivers/media/video/mxb.c
@@ -31,10 +31,11 @@
 #include <media/saa7115.h>
 #include <linux/module.h>
 
-#include "mxb.h"
 #include "tea6415c.h"
 #include "tea6420.h"
 
+#define MXB_AUDIOS     6
+
 #define I2C_SAA7111A  0x24
 #define        I2C_TDA9840   0x42
 #define        I2C_TEA6415C  0x43
@@ -62,10 +63,14 @@ MODULE_PARM_DESC(debug, "Turn on/off device debugging (default:off).");
 enum { TUNER, AUX1, AUX3, AUX3_YC };
 
 static struct v4l2_input mxb_inputs[MXB_INPUTS] = {
-       { TUNER,        "Tuner",                V4L2_INPUT_TYPE_TUNER,  1, 0, V4L2_STD_PAL_BG|V4L2_STD_NTSC_M, 0, V4L2_IN_CAP_STD },
-       { AUX1,         "AUX1",                 V4L2_INPUT_TYPE_CAMERA, 2, 0, V4L2_STD_PAL_BG|V4L2_STD_NTSC_M, 0, V4L2_IN_CAP_STD },
-       { AUX3,         "AUX3 Composite",       V4L2_INPUT_TYPE_CAMERA, 8, 0, V4L2_STD_PAL_BG|V4L2_STD_NTSC_M, 0, V4L2_IN_CAP_STD },
-       { AUX3_YC,      "AUX3 S-Video",         V4L2_INPUT_TYPE_CAMERA, 8, 0, V4L2_STD_PAL_BG|V4L2_STD_NTSC_M, 0, V4L2_IN_CAP_STD },
+       { TUNER,   "Tuner",          V4L2_INPUT_TYPE_TUNER,  0x2f, 0,
+               V4L2_STD_PAL_BG | V4L2_STD_PAL_I, 0, V4L2_IN_CAP_STD },
+       { AUX1,    "AUX1",           V4L2_INPUT_TYPE_CAMERA, 0x2f, 0,
+               V4L2_STD_ALL, 0, V4L2_IN_CAP_STD },
+       { AUX3,    "AUX3 Composite", V4L2_INPUT_TYPE_CAMERA, 0x2f, 0,
+               V4L2_STD_ALL, 0, V4L2_IN_CAP_STD },
+       { AUX3_YC, "AUX3 S-Video",   V4L2_INPUT_TYPE_CAMERA, 0x2f, 0,
+               V4L2_STD_ALL, 0, V4L2_IN_CAP_STD },
 };
 
 /* this array holds the information, which port of the saa7146 each
@@ -160,6 +165,7 @@ struct mxb
 
        int     cur_mode;       /* current audio mode (mono, stereo, ...) */
        int     cur_input;      /* current input */
+       int     cur_audinput;   /* current audio input */
        int     cur_mute;       /* current mute status */
        struct v4l2_frequency   cur_freq;       /* current frequency the tuner is tuned to */
 };
@@ -175,16 +181,12 @@ struct mxb
 #define call_all(dev, o, f, args...) \
        v4l2_device_call_until_err(&dev->v4l2_dev, 0, o, f, ##args)
 
-static inline void tea6420_route_cd(struct mxb *mxb, int idx)
+static inline void tea6420_route(struct mxb *mxb, int idx)
 {
        v4l2_subdev_call(mxb->tea6420_1, audio, s_routing,
                TEA6420_cd[idx][0].input, TEA6420_cd[idx][0].output, 0);
        v4l2_subdev_call(mxb->tea6420_2, audio, s_routing,
                TEA6420_cd[idx][1].input, TEA6420_cd[idx][1].output, 0);
-}
-
-static inline void tea6420_route_line(struct mxb *mxb, int idx)
-{
        v4l2_subdev_call(mxb->tea6420_1, audio, s_routing,
                TEA6420_line[idx][0].input, TEA6420_line[idx][0].output, 0);
        v4l2_subdev_call(mxb->tea6420_2, audio, s_routing,
@@ -203,7 +205,7 @@ static int mxb_s_ctrl(struct v4l2_ctrl *ctrl)
        case V4L2_CID_AUDIO_MUTE:
                mxb->cur_mute = ctrl->val;
                /* switch the audio-source */
-               tea6420_route_line(mxb, ctrl->val ? 6 :
+               tea6420_route(mxb, ctrl->val ? 6 :
                                video_audio_connect[mxb->cur_input]);
                break;
        default:
@@ -365,8 +367,7 @@ static int mxb_init_done(struct saa7146_dev* dev)
        tuner_call(mxb, core, s_std, std);
 
        /* mute audio on tea6420s */
-       tea6420_route_line(mxb, 6);
-       tea6420_route_cd(mxb, 6);
+       tea6420_route(mxb, 6);
 
        /* switch to tuner-channel on tea6415c */
        tea6415c_call(mxb, video, s_routing, 3, 17, 0);
@@ -376,6 +377,7 @@ static int mxb_init_done(struct saa7146_dev* dev)
 
        /* the rest for mxb */
        mxb->cur_input = 0;
+       mxb->cur_audinput = video_audio_connect[mxb->cur_input];
        mxb->cur_mute = 0;
 
        mxb->cur_mode = V4L2_TUNER_MODE_STEREO;
@@ -512,9 +514,10 @@ static int vidioc_s_input(struct file *file, void *fh, unsigned int input)
        if (saa7111a_call(mxb, video, s_routing, i, SAA7111_FMT_CCIR, 0))
                pr_err("VIDIOC_S_INPUT: could not address saa7111a\n");
 
+       mxb->cur_audinput = video_audio_connect[input];
        /* switch the audio-source only if necessary */
        if (0 == mxb->cur_mute)
-               tea6420_route_line(mxb, video_audio_connect[input]);
+               tea6420_route(mxb, mxb->cur_audinput);
 
        return 0;
 }
@@ -619,7 +622,7 @@ static int vidioc_g_audio(struct file *file, void *fh, struct v4l2_audio *a)
        }
 
        DEB_EE("VIDIOC_G_AUDIO %d\n", a->index);
-       memcpy(a, &mxb_audios[video_audio_connect[mxb->cur_input]], sizeof(struct v4l2_audio));
+       memcpy(a, &mxb_audios[video_audio_connect[mxb->cur_audinput]], sizeof(struct v4l2_audio));
        return 0;
 }
 
@@ -629,8 +632,13 @@ static int vidioc_s_audio(struct file *file, void *fh, struct v4l2_audio *a)
        struct mxb *mxb = (struct mxb *)dev->ext_priv;
 
        DEB_D("VIDIOC_S_AUDIO %d\n", a->index);
-       if (mxb_inputs[mxb->cur_input].audioset & (1 << a->index))
+       if (mxb_inputs[mxb->cur_input].audioset & (1 << a->index)) {
+               if (mxb->cur_audinput != a->index) {
+                       mxb->cur_audinput = a->index;
+                       tea6420_route(mxb, a->index);
+               }
                return 0;
+       }
        return -EINVAL;
 }
 
@@ -650,50 +658,6 @@ static int vidioc_s_register(struct file *file, void *fh, struct v4l2_dbg_regist
 }
 #endif
 
-static long vidioc_default(struct file *file, void *fh, bool valid_prio,
-                                                       int cmd, void *arg)
-{
-       struct saa7146_dev *dev = ((struct saa7146_fh *)fh)->dev;
-       struct mxb *mxb = (struct mxb *)dev->ext_priv;
-
-       switch (cmd) {
-       case MXB_S_AUDIO_CD:
-       {
-               int i = *(int *)arg;
-
-               if (i < 0 || i >= MXB_AUDIOS) {
-                       DEB_D("invalid argument to MXB_S_AUDIO_CD: i:%d\n", i);
-                       return -EINVAL;
-               }
-
-               DEB_EE("MXB_S_AUDIO_CD: i:%d\n", i);
-
-               tea6420_route_cd(mxb, i);
-               return 0;
-       }
-       case MXB_S_AUDIO_LINE:
-       {
-               int i = *(int *)arg;
-
-               if (i < 0 || i >= MXB_AUDIOS) {
-                       DEB_D("invalid argument to MXB_S_AUDIO_LINE: i:%d\n",
-                             i);
-                       return -EINVAL;
-               }
-
-               DEB_EE("MXB_S_AUDIO_LINE: i:%d\n", i);
-               tea6420_route_line(mxb, i);
-               return 0;
-       }
-       default:
-/*
-               DEB2(pr_err("does not handle this ioctl\n"));
-*/
-               return -ENOTTY;
-       }
-       return 0;
-}
-
 static struct saa7146_ext_vv vv_data;
 
 /* this function only gets called when the probing was successful */
@@ -724,7 +688,6 @@ static int mxb_attach(struct saa7146_dev *dev, struct saa7146_pci_extension_data
        vv_data.ops.vidioc_g_register = vidioc_g_register;
        vv_data.ops.vidioc_s_register = vidioc_s_register;
 #endif
-       vv_data.ops.vidioc_default = vidioc_default;
        if (saa7146_register_device(&mxb->video_dev, dev, "mxb", VFL_TYPE_GRABBER)) {
                ERR("cannot register capture v4l2 device. skipping.\n");
                saa7146_vv_release(dev);
@@ -752,8 +715,7 @@ static int mxb_detach(struct saa7146_dev *dev)
        DEB_EE("dev:%p\n", dev);
 
        /* mute audio on tea6420s */
-       tea6420_route_line(mxb, 6);
-       tea6420_route_cd(mxb, 6);
+       tea6420_route(mxb, 6);
 
        saa7146_unregister_device(&mxb->video_dev,dev);
        if (MXB_BOARD_CAN_DO_VBI(dev))
@@ -852,7 +814,7 @@ static struct saa7146_ext_vv vv_data = {
 };
 
 static struct saa7146_extension extension = {
-       .name           = MXB_IDENTIFIER,
+       .name           = "Multimedia eXtension Board",
        .flags          = SAA7146_USE_I2C_IRQ,
 
        .pci_tbl        = &pci_tbl[0],

diff --git a/drivers/media/video/mxb.h b/drivers/media/video/mxb.h
deleted file mode 100644 (file)
index dfa4b1c..0000000
--- a/drivers/media/video/mxb.h
+++ /dev/null
@@ -1,13 +0,0 @@
-#ifndef __MXB__
-#define __MXB__
-
-#define BASE_VIDIOC_MXB 10
-
-#define MXB_S_AUDIO_CD         _IOW  ('V', BASE_VIDIOC_PRIVATE+BASE_VIDIOC_MXB+0, int)
-#define MXB_S_AUDIO_LINE       _IOW  ('V', BASE_VIDIOC_PRIVATE+BASE_VIDIOC_MXB+1, int)
-
-#define MXB_IDENTIFIER "Multimedia eXtension Board"
-
-#define MXB_AUDIOS     6
-
-#endif