better solution to add possibility to delete eSocketNotifiers,
[enigma2.git] / lib / driver / avswitch.cpp
1 #include <unistd.h>
2 #include <fcntl.h>
3 #include <sys/ioctl.h>
4 #include <string.h>
5
6 #include <lib/base/init.h>
7 #include <lib/base/init_num.h>
8 #include <lib/base/eerror.h>
9 #include <lib/base/ebase.h>
10 #include <lib/driver/avswitch.h>
11
12 eAVSwitch *eAVSwitch::instance = 0;
13
14 eAVSwitch::eAVSwitch()
15 {
16         ASSERT(!instance);
17         instance = this;
18         m_video_mode = 0;
19         m_fp_fd = open("/dev/dbox/fp0", O_RDONLY|O_NONBLOCK);
20         if (m_fp_fd == -1)
21         {
22                 eDebug("couldnt open /dev/dbox/fp0 to monitor vcr scart slow blanking changed!");
23                 m_fp_notifier=0;
24         }
25         else
26         {
27                 m_fp_notifier = eSocketNotifier::create(eApp, m_fp_fd, eSocketNotifier::Read|POLLERR);
28                 CONNECT(m_fp_notifier->activated, eAVSwitch::fp_event);
29         }
30 }
31
32 #ifndef FP_IOCTL_GET_EVENT
33 #define FP_IOCTL_GET_EVENT 20
34 #endif
35
36 #ifndef FP_IOCTL_GET_VCR
37 #define FP_IOCTL_GET_VCR 7
38 #endif
39
40 #ifndef FP_EVENT_VCR_SB_CHANGED
41 #define FP_EVENT_VCR_SB_CHANGED 1
42 #endif
43
44 int eAVSwitch::getVCRSlowBlanking()
45 {
46         int val=0;
47         if (m_fp_fd >= 0)
48         {
49                 FILE *f = fopen("/proc/stb/fp/vcr_fns", "r");
50                 if (f)
51                 {
52                         if (fscanf(f, "%d", &val) != 1)
53                                 eDebug("read /proc/stb/fp/vcr_fns failed!! (%m)");
54                         fclose(f);
55                 }
56                 else if (ioctl(m_fp_fd, FP_IOCTL_GET_VCR, &val) < 0)
57                         eDebug("FP_GET_VCR failed (%m)");
58         }
59         return val;
60 }
61
62 void eAVSwitch::fp_event(int what)
63 {
64         if (what & POLLERR) // driver not ready for fp polling
65         {
66                 eDebug("fp driver not read for polling.. so disable polling");
67                 m_fp_notifier->stop();
68         }
69         else
70         {
71                 FILE *f = fopen("/proc/stb/fp/events", "r");
72                 if (f)
73                 {
74                         int events;
75                         if (fscanf(f, "%d", &events) != 1)
76                                 eDebug("read /proc/stb/fp/events failed!! (%m)");
77                         else if (events & FP_EVENT_VCR_SB_CHANGED)
78                                 /* emit */ vcr_sb_notifier(getVCRSlowBlanking());
79                         fclose(f);
80                 }
81                 else
82                 {
83                         int val = FP_EVENT_VCR_SB_CHANGED;  // ask only for this event
84                         if (ioctl(m_fp_fd, FP_IOCTL_GET_EVENT, &val) < 0)
85                                 eDebug("FP_IOCTL_GET_EVENT failed (%m)");
86                         else if (val & FP_EVENT_VCR_SB_CHANGED)
87                                 /* emit */ vcr_sb_notifier(getVCRSlowBlanking());
88                 }
89         }
90 }
91
92 eAVSwitch::~eAVSwitch()
93 {
94         if ( m_fp_fd >= 0 )
95                 close(m_fp_fd);
96 }
97
98 eAVSwitch *eAVSwitch::getInstance()
99 {
100         return instance;
101 }
102
103 bool eAVSwitch::haveScartSwitch()
104 {
105         char tmp[255];
106         int fd = open("/proc/stb/avs/0/input_choices", O_RDONLY);
107         if(fd < 0) {
108                 eDebug("cannot open /proc/stb/avs/0/input_choices");
109                 return false;
110         }
111         read(fd, tmp, 255);
112         close(fd);
113         return !!strstr(tmp, "scart");
114 }
115
116 void eAVSwitch::setInput(int val)
117 {
118         /*
119         0-encoder
120         1-scart
121         2-aux
122         */
123
124         const char *input[] = {"encoder", "scart", "aux"};
125
126         int fd;
127         
128         if((fd = open("/proc/stb/avs/0/input", O_WRONLY)) < 0) {
129                 eDebug("cannot open /proc/stb/avs/0/input");
130                 return;
131         }
132
133         write(fd, input[val], strlen(input[val]));
134         close(fd);
135         
136         if (val == 1)
137                 setFastBlank(2);
138 }
139
140 void eAVSwitch::setFastBlank(int val)
141 {
142         int fd;
143         const char *fb[] = {"low", "high", "vcr"};
144
145         if((fd = open("/proc/stb/avs/0/fb", O_WRONLY)) < 0) {
146                 eDebug("cannot open /proc/stb/avs/0/fb");
147                 return;
148         }
149
150         write(fd, fb[val], strlen(fb[0]));
151         close(fd);
152 }
153
154 void eAVSwitch::setColorFormat(int format)
155 {
156         /*
157         0-CVBS
158         1-RGB
159         2-S-Video
160         */
161         const char *cvbs="cvbs";
162         const char *rgb="rgb";
163         const char *svideo="svideo";
164         const char *yuv="yuv";
165         int fd;
166         
167         if((fd = open("/proc/stb/avs/0/colorformat", O_WRONLY)) < 0) {
168                 printf("cannot open /proc/stb/avs/0/colorformat\n");
169                 return;
170         }
171         switch(format) {
172                 case 0:
173                         write(fd, cvbs, strlen(cvbs));
174                         break;
175                 case 1:
176                         write(fd, rgb, strlen(rgb));
177                         break;
178                 case 2:
179                         write(fd, svideo, strlen(svideo));
180                         break;
181                 case 3:
182                         write(fd, yuv, strlen(yuv));
183                         break;
184         }       
185         close(fd);
186 }
187
188 void eAVSwitch::setAspectRatio(int ratio)
189 {
190         /*
191         0-4:3 Letterbox
192         1-4:3 PanScan
193         2-16:9
194         3-16:9 forced ("panscan")
195         4-16:10 Letterbox
196         5-16:10 PanScan
197         6-16:9 forced ("letterbox")
198         */
199         const char *aspect[] = {"4:3", "4:3", "any", "16:9", "16:10", "16:10", "16:9", "16:9"};
200         const char *policy[] = {"letterbox", "panscan", "bestfit", "panscan", "letterbox", "panscan", "letterbox"};
201
202         int fd;
203         if((fd = open("/proc/stb/video/aspect", O_WRONLY)) < 0) {
204                 eDebug("cannot open /proc/stb/video/aspect");
205                 return;
206         }
207 //      eDebug("set aspect to %s", aspect[ratio]);
208         write(fd, aspect[ratio], strlen(aspect[ratio]));
209         close(fd);
210
211         if((fd = open("/proc/stb/video/policy", O_WRONLY)) < 0) {
212                 eDebug("cannot open /proc/stb/video/policy");
213                 return;
214         }
215 //      eDebug("set ratio to %s", policy[ratio]);
216         write(fd, policy[ratio], strlen(policy[ratio]));
217         close(fd);
218
219 }
220
221 void eAVSwitch::setVideomode(int mode)
222 {
223         const char *pal="pal";
224         const char *ntsc="ntsc";
225         
226         if (mode == m_video_mode)
227                 return;
228
229         if (mode == 2)
230         {
231                 int fd1 = open("/proc/stb/video/videomode_50hz", O_WRONLY);
232                 if(fd1 < 0) {
233                         eDebug("cannot open /proc/stb/video/videomode_50hz");
234                         return;
235                 }
236                 int fd2 = open("/proc/stb/video/videomode_60hz", O_WRONLY);
237                 if(fd2 < 0) {
238                         eDebug("cannot open /proc/stb/video/videomode_60hz");
239                         close(fd1);
240                         return;
241                 }
242                 write(fd1, pal, strlen(pal));
243                 write(fd2, ntsc, strlen(ntsc));
244                 close(fd1);
245                 close(fd2);
246         }
247         else
248         {
249                 int fd = open("/proc/stb/video/videomode", O_WRONLY);
250                 if(fd < 0) {
251                         eDebug("cannot open /proc/stb/video/videomode");
252                         return;
253                 }
254                 switch(mode) {
255                         case 0:
256                                 write(fd, pal, strlen(pal));
257                                 break;
258                         case 1:
259                                 write(fd, ntsc, strlen(ntsc));
260                                 break;
261                         default:
262                                 eDebug("unknown videomode %d", mode);
263                 }
264                 close(fd);
265         }
266
267         m_video_mode = mode;
268 }
269
270 void eAVSwitch::setWSS(int val) // 0 = auto, 1 = auto(4:3_off)
271 {
272         int fd;
273         if((fd = open("/proc/stb/denc/0/wss", O_WRONLY)) < 0) {
274                 eDebug("cannot open /proc/stb/denc/0/wss");
275                 return;
276         }
277         const char *wss[] = {
278                 "off", "auto", "auto(4:3_off)", "4:3_full_format", "16:9_full_format",
279                 "14:9_letterbox_center", "14:9_letterbox_top", "16:9_letterbox_center",
280                 "16:9_letterbox_top", ">16:9_letterbox_center", "14:9_full_format"
281         };
282         write(fd, wss[val], strlen(wss[val]));
283 //      eDebug("set wss to %s", wss[val]);
284         close(fd);
285 }
286
287 void eAVSwitch::setSlowblank(int val)
288 {
289         int fd;
290         if((fd = open("/proc/stb/avs/0/sb", O_WRONLY)) < 0) {
291                 eDebug("cannot open /proc/stb/avs/0/sb");
292                 return;
293         }
294         const char *sb[] = {"0", "6", "12", "vcr", "auto"};
295         write(fd, sb[val], strlen(sb[val]));
296 //      eDebug("set slow blanking to %s", sb[val]);
297         close(fd);
298 }
299
300 //FIXME: correct "run/startlevel"
301 eAutoInitP0<eAVSwitch> init_avswitch(eAutoInitNumbers::rc, "AVSwitch Driver");