V4L/DVB (7722): pvrusb2: Implement FM radio support for Gotview USB2.0 DVD 2

Signed-off-by: Mike Isely <isely@pobox.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>

1 files changed, 27 insertions, 0 deletions

diff --git a/drivers/media/video/pvrusb2/pvrusb2-hdw.c b/drivers/media/video/pvrusb2/pvrusb2-hdw.c
index 19de395a5fcb..0a868888f389 100644
--- a/drivers/media/video/pvrusb2/pvrusb2-hdw.c
+++ b/drivers/media/video/pvrusb2/pvrusb2-hdw.c
@@ -1321,6 +1321,12 @@ int pvr2_upload_firmware2(struct pvr2_hdw *hdw)
         }
 
  done:
+        if (hdw->hdw_desc->signal_routing_scheme ==
+            PVR2_ROUTING_SCHEME_GOTVIEW) {
+                /* Ensure that GPIO 11 is set to output for GOTVIEW
+                   hardware. */
+                pvr2_hdw_gpio_chg_dir(hdw,(1 << 11),~0);
+        }
         return ret;
 }
 
@@ -1735,6 +1741,13 @@ static void pvr2_hdw_setup_low(struct pvr2_hdw *hdw)
 
         if (!pvr2_hdw_dev_ok(hdw)) return;
 
+        if (hdw->hdw_desc->signal_routing_scheme ==
+            PVR2_ROUTING_SCHEME_GOTVIEW) {
+                /* Ensure that GPIO 11 is set to output for GOTVIEW
+                   hardware. */
+                pvr2_hdw_gpio_chg_dir(hdw,(1 << 11),~0);
+        }
+
         pvr2_hdw_commit_setup(hdw);
 
         hdw->vid_stream = pvr2_stream_create();
@@ -2498,6 +2511,20 @@ static int pvr2_hdw_commit_execute(struct pvr2_hdw *hdw)
                 hdw->active_stream_type = hdw->desired_stream_type;
         }
 
+        if (hdw->hdw_desc->signal_routing_scheme ==
+            PVR2_ROUTING_SCHEME_GOTVIEW) {
+                u32 b;
+                /* Handle GOTVIEW audio switching */
+                pvr2_hdw_gpio_get_out(hdw,&b);
+                if (hdw->input_val == PVR2_CVAL_INPUT_RADIO) {
+                        /* Set GPIO 11 */
+                        pvr2_hdw_gpio_chg_out(hdw,(1 << 11),~0);
+                } else {
+                        /* Clear GPIO 11 */
+                        pvr2_hdw_gpio_chg_out(hdw,(1 << 11),0);
+                }
+        }
+
         /* Now execute i2c core update */
         pvr2_i2c_core_sync(hdw);