Patch by Anders Holst:
[enigma2.git] / lib / driver / avswitch.cpp
index 8110049b072450eedb26821f5a9b511dba51279a..dbfebf5f2e15ee0d45a9ffe506bd4478ff338a6c 100644 (file)
@@ -1,12 +1,13 @@
-#include <lib/driver/avswitch.h>
-
 #include <unistd.h>
 #include <fcntl.h>
 #include <sys/ioctl.h>
+#include <string.h>
 
 #include <lib/base/init.h>
 #include <lib/base/init_num.h>
 #include <lib/base/eerror.h>
+#include <lib/base/ebase.h>
+#include <lib/driver/avswitch.h>
 
 eAVSwitch *eAVSwitch::instance = 0;
 
@@ -15,10 +16,83 @@ eAVSwitch::eAVSwitch()
        ASSERT(!instance);
        instance = this;
        m_video_mode = 0;
+       m_fp_fd = open("/dev/dbox/fp0", O_RDONLY|O_NONBLOCK);
+       if (m_fp_fd == -1)
+       {
+               eDebug("couldnt open /dev/dbox/fp0 to monitor vcr scart slow blanking changed!");
+               m_fp_notifier=0;
+       }
+       else
+       {
+               m_fp_notifier = eSocketNotifier::create(eApp, m_fp_fd, eSocketNotifier::Read|POLLERR);
+               CONNECT(m_fp_notifier->activated, eAVSwitch::fp_event);
+       }
+}
+
+#ifndef FP_IOCTL_GET_EVENT
+#define FP_IOCTL_GET_EVENT 20
+#endif
+
+#ifndef FP_IOCTL_GET_VCR
+#define FP_IOCTL_GET_VCR 7
+#endif
+
+#ifndef FP_EVENT_VCR_SB_CHANGED
+#define FP_EVENT_VCR_SB_CHANGED 1
+#endif
+
+int eAVSwitch::getVCRSlowBlanking()
+{
+       int val=0;
+       if (m_fp_fd >= 0)
+       {
+               FILE *f = fopen("/proc/stb/fp/vcr_fns", "r");
+               if (f)
+               {
+                       if (fscanf(f, "%d", &val) != 1)
+                               eDebug("read /proc/stb/fp/vcr_fns failed!! (%m)");
+                       fclose(f);
+               }
+               else if (ioctl(m_fp_fd, FP_IOCTL_GET_VCR, &val) < 0)
+                       eDebug("FP_GET_VCR failed (%m)");
+       }
+       return val;
+}
+
+void eAVSwitch::fp_event(int what)
+{
+       if (what & POLLERR) // driver not ready for fp polling
+       {
+               eDebug("fp driver not read for polling.. so disable polling");
+               m_fp_notifier->stop();
+       }
+       else
+       {
+               FILE *f = fopen("/proc/stb/fp/events", "r");
+               if (f)
+               {
+                       int events;
+                       if (fscanf(f, "%d", &events) != 1)
+                               eDebug("read /proc/stb/fp/events failed!! (%m)");
+                       else if (events & FP_EVENT_VCR_SB_CHANGED)
+                               /* emit */ vcr_sb_notifier(getVCRSlowBlanking());
+                       fclose(f);
+               }
+               else
+               {
+                       int val = FP_EVENT_VCR_SB_CHANGED;  // ask only for this event
+                       if (ioctl(m_fp_fd, FP_IOCTL_GET_EVENT, &val) < 0)
+                               eDebug("FP_IOCTL_GET_EVENT failed (%m)");
+                       else if (val & FP_EVENT_VCR_SB_CHANGED)
+                               /* emit */ vcr_sb_notifier(getVCRSlowBlanking());
+               }
+       }
 }
 
 eAVSwitch::~eAVSwitch()
 {
+       if ( m_fp_fd >= 0 )
+               close(m_fp_fd);
 }
 
 eAVSwitch *eAVSwitch::getInstance()
@@ -26,6 +100,19 @@ eAVSwitch *eAVSwitch::getInstance()
        return instance;
 }
 
+bool eAVSwitch::haveScartSwitch()
+{
+       char tmp[255];
+       int fd = open("/proc/stb/avs/0/input_choices", O_RDONLY);
+       if(fd < 0) {
+               eDebug("cannot open /proc/stb/avs/0/input_choices");
+               return false;
+       }
+       read(fd, tmp, 255);
+       close(fd);
+       return !!strstr(tmp, "scart");
+}
+
 void eAVSwitch::setInput(int val)
 {
        /*
@@ -34,12 +121,12 @@ void eAVSwitch::setInput(int val)
        2-aux
        */
 
-       char *input[] = {"encoder", "scart", "aux"};
+       const char *input[] = {"encoder", "scart", "aux"};
 
        int fd;
        
        if((fd = open("/proc/stb/avs/0/input", O_WRONLY)) < 0) {
-               printf("cannot open /proc/stb/avs/0/input\n");
+               eDebug("cannot open /proc/stb/avs/0/input");
                return;
        }
 
@@ -53,10 +140,10 @@ void eAVSwitch::setInput(int val)
 void eAVSwitch::setFastBlank(int val)
 {
        int fd;
-       char *fb[] = {"low", "high", "vcr"};
+       const char *fb[] = {"low", "high", "vcr"};
 
        if((fd = open("/proc/stb/avs/0/fb", O_WRONLY)) < 0) {
-               printf("cannot open /proc/stb/avs/0/fb\n");
+               eDebug("cannot open /proc/stb/avs/0/fb");
                return;
        }
 
@@ -71,10 +158,10 @@ void eAVSwitch::setColorFormat(int format)
        1-RGB
        2-S-Video
        */
-       char *cvbs="cvbs";
-       char *rgb="rgb";
-       char *svideo="svideo";
-       char *yuv="yuv";
+       const char *cvbs="cvbs";
+       const char *rgb="rgb";
+       const char *svideo="svideo";
+       const char *yuv="yuv";
        int fd;
        
        if((fd = open("/proc/stb/avs/0/colorformat", O_WRONLY)) < 0) {
@@ -104,15 +191,17 @@ void eAVSwitch::setAspectRatio(int ratio)
        0-4:3 Letterbox
        1-4:3 PanScan
        2-16:9
-       3-16:9 forced
+       3-16:9 forced ("panscan")
+       4-16:10 Letterbox
+       5-16:10 PanScan
+       6-16:9 forced ("letterbox")
        */
-       
-       char *aspect[] = {"4:3", "4:3", "any", "16:9"};
-       char *policy[] = {"letterbox", "panscan", "bestfit", "panscan"};
+       const char *aspect[] = {"4:3", "4:3", "any", "16:9", "16:10", "16:10", "16:9", "16:9"};
+       const char *policy[] = {"letterbox", "panscan", "bestfit", "panscan", "letterbox", "panscan", "letterbox"};
 
        int fd;
        if((fd = open("/proc/stb/video/aspect", O_WRONLY)) < 0) {
-               printf("cannot open /proc/stb/video/aspect\n");
+               eDebug("cannot open /proc/stb/video/aspect");
                return;
        }
 //     eDebug("set aspect to %s", aspect[ratio]);
@@ -120,7 +209,7 @@ void eAVSwitch::setAspectRatio(int ratio)
        close(fd);
 
        if((fd = open("/proc/stb/video/policy", O_WRONLY)) < 0) {
-               printf("cannot open /proc/stb/video/policy\n");
+               eDebug("cannot open /proc/stb/video/policy");
                return;
        }
 //     eDebug("set ratio to %s", policy[ratio]);
@@ -131,27 +220,49 @@ void eAVSwitch::setAspectRatio(int ratio)
 
 void eAVSwitch::setVideomode(int mode)
 {
-       char *pal="pal";
-       char *ntsc="ntsc";
+       const char *pal="pal";
+       const char *ntsc="ntsc";
        
        if (mode == m_video_mode)
                return;
-       
-       int fd;
 
-       if((fd = open("/proc/stb/video/videomode", O_WRONLY)) < 0) {
-               printf("cannot open /proc/stb/video/videomode\n");
-               return;
+       if (mode == 2)
+       {
+               int fd1 = open("/proc/stb/video/videomode_50hz", O_WRONLY);
+               if(fd1 < 0) {
+                       eDebug("cannot open /proc/stb/video/videomode_50hz");
+                       return;
+               }
+               int fd2 = open("/proc/stb/video/videomode_60hz", O_WRONLY);
+               if(fd2 < 0) {
+                       eDebug("cannot open /proc/stb/video/videomode_60hz");
+                       close(fd1);
+                       return;
+               }
+               write(fd1, pal, strlen(pal));
+               write(fd2, ntsc, strlen(ntsc));
+               close(fd1);
+               close(fd2);
        }
-       switch(mode) {
-               case 0:
-                       write(fd, pal, strlen(pal));
-                       break;
-               case 1:
-                       write(fd, ntsc, strlen(ntsc));
-                       break;
+       else
+       {
+               int fd = open("/proc/stb/video/videomode", O_WRONLY);
+               if(fd < 0) {
+                       eDebug("cannot open /proc/stb/video/videomode");
+                       return;
+               }
+               switch(mode) {
+                       case 0:
+                               write(fd, pal, strlen(pal));
+                               break;
+                       case 1:
+                               write(fd, ntsc, strlen(ntsc));
+                               break;
+                       default:
+                               eDebug("unknown videomode %d", mode);
+               }
+               close(fd);
        }
-       close(fd);
 
        m_video_mode = mode;
 }
@@ -160,10 +271,10 @@ void eAVSwitch::setWSS(int val) // 0 = auto, 1 = auto(4:3_off)
 {
        int fd;
        if((fd = open("/proc/stb/denc/0/wss", O_WRONLY)) < 0) {
-               printf("cannot open /proc/stb/denc/0/wss\n");
+               eDebug("cannot open /proc/stb/denc/0/wss");
                return;
        }
-       char *wss[] = {
+       const char *wss[] = {
                "off", "auto", "auto(4:3_off)", "4:3_full_format", "16:9_full_format",
                "14:9_letterbox_center", "14:9_letterbox_top", "16:9_letterbox_center",
                "16:9_letterbox_top", ">16:9_letterbox_center", "14:9_full_format"
@@ -177,10 +288,10 @@ void eAVSwitch::setSlowblank(int val)
 {
        int fd;
        if((fd = open("/proc/stb/avs/0/sb", O_WRONLY)) < 0) {
-               printf("cannot open /proc/stb/avs/0/sb\n");
+               eDebug("cannot open /proc/stb/avs/0/sb");
                return;
        }
-       char *sb[] = {"0", "6", "12", "vcr", "auto"};
+       const char *sb[] = {"0", "6", "12", "vcr", "auto"};
        write(fd, sb[val], strlen(sb[val]));
 //     eDebug("set slow blanking to %s", sb[val]);
        close(fd);