revert re-mmap (it's not necessary with new driver, and is a bad idea anyway if a...
[enigma2.git] / lib / driver / avswitch.cpp
index f7b1bbd4e7afe37e4248c43e3184937ad65f427f..d582db81ae3ca90bf33b25158e2e75f616b4af60 100644 (file)
@@ -1,13 +1,12 @@
-#include <lib/driver/avswitch.h>
-
 #include <unistd.h>
 #include <fcntl.h>
 #include <sys/ioctl.h>
 
 #include <lib/base/init.h>
 #include <lib/base/init_num.h>
-#include <lib/base/econfig.h>
 #include <lib/base/eerror.h>
+#include <lib/base/ebase.h>
+#include <lib/driver/avswitch.h>
 
 eAVSwitch *eAVSwitch::instance = 0;
 
@@ -15,18 +14,66 @@ eAVSwitch::eAVSwitch()
 {
        ASSERT(!instance);
        instance = this;
-       
-       avsfd = open("/dev/dbox/avs0", O_RDWR);
-       
-       //enable colors on thedoc's tv 
-       ioctl(avsfd, 0x1000 | 35, 2);
-       ioctl(avsfd, 0x1000 | 9, 1);
+       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 = new eSocketNotifier(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)
+       {
+               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
+       {
+               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(avsfd > 0)
-               close(avsfd);
+       if ( m_fp_fd >= 0 )
+               close(m_fp_fd);
+       if (m_fp_notifier)
+               delete m_fp_notifier;
 }
 
 eAVSwitch *eAVSwitch::getInstance()
@@ -34,11 +81,188 @@ eAVSwitch *eAVSwitch::getInstance()
        return instance;
 }
 
+void eAVSwitch::setInput(int val)
+{
+       /*
+       0-encoder
+       1-scart
+       2-aux
+       */
+
+       char *input[] = {"encoder", "scart", "aux"};
+
+       int fd;
+       
+       if((fd = open("/proc/stb/avs/0/input", O_WRONLY)) < 0) {
+               eDebug("cannot open /proc/stb/avs/0/input");
+               return;
+       }
+
+       write(fd, input[val], strlen(input[val]));
+       close(fd);
+       
+       if (val == 1)
+               setFastBlank(2);
+}
+
+void eAVSwitch::setFastBlank(int val)
+{
+       int fd;
+       char *fb[] = {"low", "high", "vcr"};
+
+       if((fd = open("/proc/stb/avs/0/fb", O_WRONLY)) < 0) {
+               eDebug("cannot open /proc/stb/avs/0/fb");
+               return;
+       }
+
+       write(fd, fb[val], strlen(fb[0]));
+       close(fd);
+}
+
 void eAVSwitch::setColorFormat(int format)
 {
-       printf("eAVSwitch::setColorFormat(%d)\n",format);
-       /*there are no ioctl for controling this in avs - scart api needed 
-               no, not the gillem one */
+       /*
+       0-CVBS
+       1-RGB
+       2-S-Video
+       */
+       char *cvbs="cvbs";
+       char *rgb="rgb";
+       char *svideo="svideo";
+       char *yuv="yuv";
+       int fd;
+       
+       if((fd = open("/proc/stb/avs/0/colorformat", O_WRONLY)) < 0) {
+               printf("cannot open /proc/stb/avs/0/colorformat\n");
+               return;
+       }
+       switch(format) {
+               case 0:
+                       write(fd, cvbs, strlen(cvbs));
+                       break;
+               case 1:
+                       write(fd, rgb, strlen(rgb));
+                       break;
+               case 2:
+                       write(fd, svideo, strlen(svideo));
+                       break;
+               case 3:
+                       write(fd, yuv, strlen(yuv));
+                       break;
+       }       
+       close(fd);
+}
+
+void eAVSwitch::setAspectRatio(int ratio)
+{
+       /*
+       0-4:3 Letterbox
+       1-4:3 PanScan
+       2-16:9
+       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", "16:10", "16:10", "16:9", "16:9"};
+       char *policy[] = {"letterbox", "panscan", "bestfit", "panscan", "letterbox", "panscan", "letterbox"};
+
+       int fd;
+       if((fd = open("/proc/stb/video/aspect", O_WRONLY)) < 0) {
+               eDebug("cannot open /proc/stb/video/aspect");
+               return;
+       }
+//     eDebug("set aspect to %s", aspect[ratio]);
+       write(fd, aspect[ratio], strlen(aspect[ratio]));
+       close(fd);
+
+       if((fd = open("/proc/stb/video/policy", O_WRONLY)) < 0) {
+               eDebug("cannot open /proc/stb/video/policy");
+               return;
+       }
+//     eDebug("set ratio to %s", policy[ratio]);
+       write(fd, policy[ratio], strlen(policy[ratio]));
+       close(fd);
+
+}
+
+void eAVSwitch::setVideomode(int mode)
+{
+       char *pal="pal";
+       char *ntsc="ntsc";
+       
+       if (mode == m_video_mode)
+               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);
+       }
+       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);
+       }
+
+       m_video_mode = mode;
+}
+
+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) {
+               eDebug("cannot open /proc/stb/denc/0/wss");
+               return;
+       }
+       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"
+       };
+       write(fd, wss[val], strlen(wss[val]));
+//     eDebug("set wss to %s", wss[val]);
+       close(fd);
+}
+
+void eAVSwitch::setSlowblank(int val)
+{
+       int fd;
+       if((fd = open("/proc/stb/avs/0/sb", O_WRONLY)) < 0) {
+               eDebug("cannot open /proc/stb/avs/0/sb");
+               return;
+       }
+       char *sb[] = {"0", "6", "12", "vcr", "auto"};
+       write(fd, sb[val], strlen(sb[val]));
+//     eDebug("set slow blanking to %s", sb[val]);
+       close(fd);
 }
 
 //FIXME: correct "run/startlevel"