V4L/DVB: tm6000: Add control to the power led

Turn power led off, if device is disconnected

Signed-off-by: Stefan Ringel <stefan.ringel@arcor.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

2 files changed, 32 insertions, 0 deletions

diff --git a/drivers/staging/tm6000/tm6000-cards.c b/drivers/staging/tm6000/tm6000-cards.c
index 22fbd75a551d..cedd9044022f 100644
--- a/drivers/staging/tm6000/tm6000-cards.c
+++ b/drivers/staging/tm6000/tm6000-cards.c
@@ -912,6 +912,25 @@ static void tm6000_usb_disconnect(struct usb_interface *interface)
         }
 #endif
 
+        if (dev->gpio.power_led) {
+                switch (dev->model) {
+                case TM6010_BOARD_HAUPPAUGE_900H:
+                case TM6010_BOARD_TERRATEC_CINERGY_HYBRID_XE:
+                case TM6010_BOARD_TWINHAN_TU501:
+                        /* Power led off */
+                        tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
+                                dev->gpio.power_led, 0x01);
+                        msleep(15);
+                        break;
+                case TM6010_BOARD_BEHOLD_WANDER:
+                case TM6010_BOARD_BEHOLD_VOYAGER:
+                        /* Power led off */
+                        tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
+                                dev->gpio.power_led, 0x00);
+                        msleep(15);
+                        break;
+                }
+        }
         tm6000_v4l2_unregister(dev);
 
         tm6000_i2c_unregister(dev);
diff --git a/drivers/staging/tm6000/tm6000-core.c b/drivers/staging/tm6000/tm6000-core.c
index 65feb8cb421c..27f3f551b545 100644
--- a/drivers/staging/tm6000/tm6000-core.c
+++ b/drivers/staging/tm6000/tm6000-core.c
@@ -339,6 +339,12 @@ int tm6000_init_analog_mode (struct tm6000_core *dev)
         tm6000_set_standard (dev, &dev->norm);
         tm6000_set_audio_bitrate (dev,48000);
 
+        /* switch dvb led off */
+        if (dev->gpio.dvb_led) {
+                tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
+                        dev->gpio.dvb_led, 0x01);
+        }
+
         return 0;
 }
 
@@ -391,6 +397,13 @@ int tm6000_init_digital_mode (struct tm6000_core *dev)
                 tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
                 msleep(100);
         }
+
+        /* switch dvb led on */
+        if (dev->gpio.dvb_led) {
+                tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
+                        dev->gpio.dvb_led, 0x00);
+        }
+
         return 0;
 }