Support duo4k.
[vuplus_openvuplus_3.0] / meta-openvuplus / recipes-vuplus / aio-grab / aio-grab / aio-grab_vuplus_c469655e3498abdb58a36b4f62edbd9699ff6f84.patch
1 diff --git a/.gitignore b/.gitignore
2 index ccfb515..a6f8d11 100644
3 --- a/.gitignore
4 +++ b/.gitignore
5 @@ -16,3 +16,4 @@ install-sh
6  *.o
7  missing
8  stamp-h1
9 +aio-grab_vuplus_*
10 diff --git a/main.c b/main.c
11 index 190ff5f..0a4cc01 100644
12 --- a/main.c
13 +++ b/main.c
14 @@ -1,5 +1,5 @@
15  /*
16 -AiO Dreambox Screengrabber v0.83a
17 +AiO Screengrabber v0.83a
18  
19  written 2006 - 2009 by Seddi
20  Contact: seddi@ihad.tv / http://www.ihad.tv
21 @@ -38,6 +38,7 @@ Feel free to use the code for your own projects. See LICENSE file for details.
22  #include <sys/stat.h>
23  #include <sys/types.h>
24  #include <unistd.h>
25 +#include <ctype.h>
26  
27  #include <linux/fb.h>
28  
29 @@ -80,6 +81,8 @@ static const int yuv2rgbtable_bv[256] = {
30  };
31  
32  static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yres);
33 +static bool getvideo2(unsigned char *video, unsigned int *xres, unsigned int *yres);
34 +
35  static bool getosd(unsigned char *osd, unsigned int *xres, unsigned int *yres);
36  
37  static void smooth_resize(const unsigned char *source, unsigned char *dest,
38 @@ -101,10 +104,24 @@ static void combine(unsigned char *output,
39                     const unsigned char *video, const unsigned char *osd,
40                     unsigned int xres, unsigned int yres);
41  
42 +#define IS_VUPLUS 1
43 +#if IS_VUPLUS
44 +enum {UNKNOWN,PALLAS,VULCAN,XILLEON,BRCM7401,BRCM7400,BRCM7405,BRCM7335,BRCM7325,BRCM7346,BRCM7425,BRCM7362,BRCM_ARM};
45 +char *stb_name[]={"unknown","Pallas","Vulcan","Xilleon","Brcm7401","Brcm7400","Brcm7405","Brcm7335","Brcm7325","Brcm7346","Brcm7425\/7241","Brcm7362", "Brcm_ARM"};
46 +#else
47  enum {UNKNOWN,PALLAS,VULCAN,XILLEON,BRCM7401,BRCM7400,BRCM7405};
48  static const char *stb_name[]={"unknown","Pallas","Vulcan","Xilleon","Brcm7401","Brcm7400","Brcm7405"};
49 +#endif
50  static int stb_type=UNKNOWN;
51  
52 +char* upcase(char* mixedstr)
53 +{
54 +       size_t j;
55 +       for (j=0; j< strlen(mixedstr); ++j)
56 +               mixedstr[j]=toupper(mixedstr[j]);
57 +       return mixedstr;
58 +}
59 +
60  static const char *file_getline(const char *filename)
61  {
62         static char *line = NULL;
63 @@ -184,10 +201,9 @@ static int file_scanf_lines(const char *filename, const char *fmt, ...)
64  }
65  
66  // main program
67 -
68  int main(int argc, char **argv) {
69  
70 -       printf("AiO Dreambox Screengrabber " PACKAGE_VERSION "\n\n");
71 +       printf("AiO Screengrabber " PACKAGE_VERSION "\n\n");
72  
73         unsigned int xres_v = 0,yres_v = 0,xres_o,yres_o,xres,yres,aspect,width;
74         int c,osd_only,video_only,use_osd_res,use_png,use_jpg,jpg_quality,no_aspect,use_letterbox;
75 @@ -205,11 +221,45 @@ int main(int argc, char **argv) {
76         char filename[256] = { "/tmp/screenshot.bmp" };
77  
78         // detect STB
79 -       const char *line = file_getline("/proc/fb");
80 +       char *line = (char*)file_getline("/proc/fb");
81         if (line == NULL)
82                 return 1;
83  
84         if (strstr(line, "bcmfb")) {
85 +#if IS_VUPLUS
86 +               if((line=(char*)file_getline("/proc/stb/info/chipset")) == NULL)
87 +                       return 1;
88 +               if (strstr(upcase(line),"7335"))
89 +                       stb_type=BRCM7335;
90 +               else if (strstr(upcase(line),"7325"))
91 +                       stb_type=BRCM7325;
92 +               else if (strstr(upcase(line),"7405"))
93 +                       stb_type=BRCM7405;
94 +               else if (strstr(upcase(line),"7356"))
95 +                       stb_type=BRCM7346;
96 +               else if (strstr(upcase(line),"7346"))
97 +                       stb_type=BRCM7346;
98 +               else if (strstr(upcase(line),"7424"))
99 +                       stb_type=BRCM7425;
100 +               else if (strstr(upcase(line),"7425"))
101 +                       stb_type=BRCM7425;
102 +               else if (strstr(upcase(line),"7241"))
103 +                       stb_type=BRCM7425;
104 +               else if (strstr(upcase(line),"7362"))
105 +                       stb_type=BRCM7362;
106 +               else if (strstr(upcase(line),"7366"))
107 +                       stb_type=BRCM_ARM;
108 +               else if (strstr(upcase(line),"7376"))
109 +                       stb_type=BRCM_ARM;
110 +               else if (strstr(upcase(line),"7444"))
111 +                       stb_type=BRCM_ARM;
112 +               else if (strstr(upcase(line),"7252"))
113 +                       stb_type=BRCM_ARM;
114 +               else if (strstr(upcase(line),"7260"))
115 +                       stb_type=BRCM_ARM;
116 +               else if (strstr(upcase(line),"7278"))
117 +                       stb_type=BRCM_ARM;
118 +#else
119                 line = file_getline("/proc/stb/info/model");
120                 if (line == NULL)
121                         return 1;
122 @@ -221,6 +271,7 @@ int main(int argc, char **argv) {
123                          !strcmp(line, "dm800se") ||
124                          !strcmp(line, "dm7020hd"))
125                         stb_type = BRCM7405;
126 +#endif
127         } else if (strstr(line, "xilleonfb")) {
128                 stb_type = XILLEON;
129         } else if (strstr(line, "Pallas FB")) {
130 @@ -325,9 +376,18 @@ int main(int argc, char **argv) {
131         if (!video_only && !getosd(osd, &xres_o, &yres_o))
132                 return 1;
133  
134 -       // get video
135 -       if (!osd_only && !getvideo(video, &xres_v, &yres_v))
136 -               return 1;
137 +       if (stb_type == BRCM_ARM)
138 +       {
139 +               if (!osd_only && !getvideo2(video, &xres_v, &yres_v))
140 +                       return 1;
141 +       }
142 +       else
143 +       {
144 +               if (!osd_only && !getvideo(video, &xres_v, &yres_v))
145 +                       return 1;
146 +       }
147 +
148 +       
149  
150         // get aspect ratio
151         if (stb_type == VULCAN || stb_type == PALLAS)
152 @@ -549,6 +609,22 @@ int main(int argc, char **argv) {
153  }
154  
155  // grabing the video picture
156 +static bool getvideo2(unsigned char *video, unsigned int *xres, unsigned int *yres)
157 +{
158 +       int fd_video = open("/dev/dvb/adapter0/video0", O_RDONLY);
159 +       if (fd_video < 0) {
160 +               perror("/dev/dvb/adapter0/video0");
161 +               return false;
162 +       }
163 +       
164 +       ssize_t r = read(fd_video, video, 1920 * 1080 * 3);
165 +       close(fd_video);
166 +
167 +       *xres = 1920;
168 +       *yres = 1080;
169 +
170 +       return true;
171 +}
172  
173  static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yres)
174  {
175 @@ -563,16 +639,34 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
176                 perror("/dev/mem");
177                 return false;
178         }
179 -
180 +#if IS_VUPLUS
181 +       if (stb_type == BRCM7401 || stb_type == BRCM7400 || stb_type == BRCM7405 || stb_type == BRCM7335 || stb_type == BRCM7325 || stb_type == BRCM7346 || stb_type == BRCM7425 || stb_type == BRCM7362)
182 +#else
183         if (stb_type == BRCM7401 || stb_type == BRCM7400 || stb_type == BRCM7405)
184 +#endif
185         {
186                 // grab brcm7401 pic from decoder memory
187 +#if IS_VUPLUS
188 +               off_t offset_addr = 0x10600000;
189 +               switch(stb_type) {
190 +               case BRCM7401:
191 +               case BRCM7400:
192 +               case BRCM7405:
193 +               case BRCM7335:
194 +               case BRCM7325: offset_addr = 0x10100000; break;
195 +               }
196 +               unsigned char *memory = mmap(0, 100, PROT_READ, MAP_SHARED, mem_fd, offset_addr);
197 +               if (memory == MAP_FAILED) {
198 +                       perror("mmap");
199 +                       return false;
200 +               }
201 +#else
202                 unsigned char *memory = mmap(0, 100, PROT_READ, MAP_SHARED, mem_fd, 0x10100000);
203                 if (memory == MAP_FAILED) {
204                         perror("mmap");
205                         return false;
206                 }
207 -
208 +#endif
209                 unsigned char data[100];
210  
211                 unsigned int adr,adr2,ofs,ofs2,offset/*,vert_start,vert_end*/;
212 @@ -582,12 +676,30 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
213                 memcpy(data,memory,100); 
214                 //vert_start=data[0x1B]<<8|data[0x1A];
215                 //vert_end=data[0x19]<<8|data[0x18];
216 +#if IS_VUPLUS
217 +               if(stb_type == BRCM7401 || stb_type == BRCM7400 || stb_type == BRCM7405 || stb_type == BRCM7335 || stb_type == BRCM7325) {
218 +                       stride=data[0x15]<<8|data[0x14];        
219 +                       ofs=(data[0x28]<<8|data[0x27])>>4;
220 +                       ofs2=(data[0x2c]<<8|data[0x2b])>>4;
221 +                       adr=(data[0x1f]<<24|data[0x1e]<<16|data[0x1d]<<8|data[0x1c])&0xFFFFFF00;
222 +                       adr2=(data[0x23]<<24|data[0x22]<<16|data[0x21]<<8|data[0x20])&0xFFFFFF00;
223 +                       offset=adr2-adr;
224 +               } else {
225 +                       stride=data[0x15]<<8|data[0x14];
226 +                       ofs=(data[0x3c]<<8|data[0x3b])>>4;
227 +                       ofs2=(data[0x40]<<8|data[0x3f])>>4;
228 +                       adr=(data[0x1f]<<24|data[0x1e]<<16|data[0x1d]<<8|data[0x1c])&0xFFFFFF00;
229 +                       adr2=(data[0x37]<<24|data[0x36]<<16|data[0x35]<<8|data[0x34])&0xFFFFFF00;
230 +                       offset=adr2-adr;
231 +               }
232 +#else
233                 stride=data[0x15]<<8|data[0x14];        
234                 ofs=(data[0x28]<<8|data[0x27])>>4;
235                 ofs2=(data[0x2c]<<8|data[0x2b])>>4;
236                 adr=(data[0x1f]<<24|data[0x1e]<<16|data[0x1d]<<8|data[0x1c])&0xFFFFFF00;
237                 adr2=(data[0x23]<<24|data[0x22]<<16|data[0x21]<<8|data[0x20])&0xFFFFFF00;
238                 offset=adr2-adr;
239 +#endif
240                 
241                 munmap(memory, 100);
242  
243 @@ -609,7 +721,11 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
244                 assert(chroma);
245  
246                 // grabbing luma & chroma plane from the decoder memory
247 +#if IS_VUPLUS
248 +               if (stb_type == BRCM7401 || stb_type == BRCM7405 || stb_type == BRCM7325 || stb_type == BRCM7346 || stb_type == BRCM7425 || stb_type == BRCM7362 ) {
249 +#else
250                 if (stb_type == BRCM7401 || stb_type == BRCM7405) {
251 +#endif
252                         // on dm800/dm500hd we have direct access to the decoder memory
253                         memory = mmap(0, offset + stride*(ofs2+64), PROT_READ, MAP_SHARED, mem_fd, adr);
254                         if (memory == MAP_FAILED) {
255 @@ -620,7 +736,11 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
256                         usleep(50000);  // we try to get a full picture, its not possible to get a sync from the decoder so we use a delay
257                                         // and hope we get a good timing. dont ask me why, but every DM800 i tested so far produced a good
258                                         // result with a 50ms delay
259 +#if IS_VUPLUS
260 +               } else if (stb_type == BRCM7400 || stb_type == BRCM7335) {
261 +#else
262                 } else if (stb_type == BRCM7400) { 
263 +#endif
264                         // on dm8000 we have to use dma, so dont change anything here until you really know what you are doing !
265                         
266                         unsigned int i = 0;
267 @@ -639,7 +759,11 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
268                         }
269  
270                         volatile unsigned long *mem_dma;
271 +#if IS_VUPLUS
272 +                       mem_dma = mmap(0, 0x1000, PROT_READ|PROT_WRITE, MAP_SHARED, mem_fd, (stb_type==BRCM7400)?0x10c02000:0x10c01000);
273 +#else
274                         mem_dma = mmap(0, 0x1000, PROT_READ|PROT_WRITE, MAP_SHARED, mem_fd, 0x10c02000);
275 +#endif
276                         if (mem_dma == MAP_FAILED) {
277                                 perror("mmap");
278                                 return false;
279 @@ -675,8 +799,11 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
280                 unsigned int t = 0, t2 = 0, dat1 = 0;
281                 unsigned int chr_luma_stride = 0x40;
282                 unsigned int sw;
283 -
284 +#if IS_VUPLUS
285 +               if (stb_type == BRCM7405 || stb_type == BRCM7325 || stb_type == BRCM7346 || stb_type == BRCM7425)
286 +#else
287                 if (stb_type == BRCM7405)
288 +#endif
289                         chr_luma_stride *= 2;
290  
291                 xsub=chr_luma_stride;
292 @@ -692,6 +819,7 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
293                         for (ytmp = 0; ytmp < ofs; ytmp++) 
294                         {
295                                 memcpy(luma + dat1, memory + t, xsub); // luma
296 +                               
297                                 t += chr_luma_stride;
298  
299                                 switch (ofs2-ytmp) // the two switch commands are much faster than one if statement
300 @@ -710,10 +838,17 @@ static bool getvideo(unsigned char *video, unsigned int *xres, unsigned int *yre
301                                 dat1+=stride;
302                         }
303                 }
304 -
305 +#if IS_VUPLUS
306 +               if (stb_type == BRCM7401 || stb_type == BRCM7405 || stb_type == BRCM7325 || stb_type == BRCM7346 || stb_type == BRCM7425 || stb_type == BRCM7362) {
307 +#else
308                 if (stb_type == BRCM7401 || stb_type == BRCM7405)
309 +#endif
310                         munmap(memory, offset + stride * (ofs2 + 64));
311 +#if IS_VUPLUS
312 +               } else if (stb_type == BRCM7400 || stb_type == BRCM7335) {
313 +#else
314                 else if (stb_type == BRCM7400) {
315 +#endif
316                         memory -= 0x1000;
317                         munmap(memory, DMA_BLOCKSIZE + 0x1000);
318                 }