source: titan/titan/fb.h @ 20751

Last change on this file since 20751 was 20751, checked in by nit, 10 years ago

[titan] fix autores

File size: 10.1 KB
Line 
1#ifndef FB_H
2#define FB_H
3
4struct fb* getfb(char *name)
5{
6        debug(1000, "in");
7        struct fb *node = fb;
8
9        while(node != NULL)
10        {
11                if(ostrstr(node->name, name) != NULL)
12                {
13                        debug(1000, "out");
14                        return node;
15                }
16
17                node = node->next;
18        }
19        debug(100, "framebuffer not found (%s)", name);
20        return NULL;
21}
22
23long getfbsize(int dev)
24{
25        debug(1000, "in");
26        struct fb* node = fb;
27        unsigned long fbmemcount = 0;
28        struct fb_fix_screeninfo fix_screeninfo;
29
30        if(fb == NULL)
31        {
32                debug(1000, "out -> NULL dedect");
33                return 0;
34        }
35
36#ifndef NOFB
37        if(ioctl(fb->fd, FBIOGET_FSCREENINFO, &fix_screeninfo) == -1)
38        {
39                perr("ioctl FBIOGET_FSCREENINFO failed");
40                return 0;
41        }
42#else
43        fix_screeninfo.smem_len = 16*1024*1024;
44#endif
45
46        while(node != NULL)
47        {
48                if(node->dev == dev)
49                        fbmemcount = fbmemcount + node->varfbsize;
50                node = node->next;
51        }
52
53        debug(1000, "out");
54        return fix_screeninfo.smem_len - fbmemcount;
55}
56
57struct fb* addfb(char *fbname, int dev, int width, int height, int colbytes, int fd, unsigned char* mmapfb, unsigned long fixfbsize)
58{
59        debug(1000, "in");
60        struct fb *newnode = NULL, *node = fb;
61        char *name = NULL;
62        long ret = 0;
63
64        name = ostrcat(fbname, NULL, 0, 0);
65        if(name == NULL)
66        {
67                err("no memory");
68                return NULL;
69        }
70
71        newnode = (struct fb*)malloc(sizeof(struct fb));       
72        if(newnode == NULL)
73        {
74                err("no memory");
75                free(name);
76                return NULL;
77        }
78
79        memset(newnode, 0, sizeof(struct fb));
80        newnode->name = name;
81        newnode->dev = dev;
82        newnode->width = width;
83        newnode->height = height;
84        newnode->colbytes = colbytes;
85        newnode->pitch = newnode->width * newnode->colbytes;
86        newnode->fb = mmapfb;
87        newnode->fblong = (unsigned long*)newnode->fb;
88        newnode->fd = fd;
89        newnode->fixfbsize = fixfbsize;
90       
91        if(ostrcmp(name, FB) == 0)
92                setfbvarsize(newnode);
93        else if(ostrcmp(name, FB1) == 0)
94                newnode->varfbsize = 720 * 576 * newnode->colbytes;
95        else
96                newnode->varfbsize = width * height * newnode->colbytes;
97       
98        if(node != NULL)
99        {
100                while(node->next != NULL)
101                        node = node->next;
102                node->next = newnode;
103        }
104        else
105                fb = newnode;
106               
107        /*eigener Buffer zB fuer LCD*/
108        if(dev == 999)
109                return newnode;
110
111        ret = getfbsize(dev);
112        if(ret < 0)
113        {
114                err("framebuffermem (%s) to small, needed = %ld", name, ret * -1);
115                free(name);
116                free(newnode);
117                if(newnode == fb) fb = NULL;
118                return NULL;
119        }
120
121        debug(100, "fbname=%s, fbwidth=%d, fbheight=%d, fbcol=%d, fbsize=%ld", newnode->name, newnode->width, newnode->height, newnode->colbytes, newnode->varfbsize);
122        debug(1000, "out");
123        return newnode;
124}
125
126void fb2png_thread()
127{
128        while (writeFBfile.buf1 != NULL || writeFBfile.buf2 != NULL) {
129                if(writeFBfile.buf1 != NULL) {
130                        writeFBfile.ActBuf = writeFBfile.buf1;
131                        fb2png(writeFBfile.buf1, 320, 240, "/tmp/titanlcd.png");
132                        free(writeFBfile.buf1); writeFBfile.buf1 = NULL;
133                        if(writeFBfile.buf2 != NULL)
134                                usleep(500000);
135                }
136                if(writeFBfile.buf2 != NULL) {
137                        writeFBfile.ActBuf = writeFBfile.buf2;
138                        fb2png(writeFBfile.buf2, 320, 240, "/tmp/titanlcd.png");
139                        free(writeFBfile.buf2); writeFBfile.buf2 = NULL;
140                        if(writeFBfile.buf1 != NULL)
141                                usleep(500000);
142                }
143        }
144        writeFBfile.ActBuf = NULL;
145}
146
147void delfb(char *name)
148{
149        debug(1000, "in");
150        struct fb *node = fb, *prev = fb;
151
152        while(node != NULL)
153        {
154                if(ostrcmp(node->name, name) == 0)
155                {
156                        if(node == fb)
157                                fb = node->next;
158                        else
159                                prev->next = node->next;
160
161                        free(node->name);
162                        node->name = NULL;
163
164                        free(node);
165                        node = NULL;
166                        break;
167                }
168
169                prev = node;
170                node = node->next;
171        }
172        debug(1000, "out");
173}
174
175void freefb()
176{
177        debug(1000, "in");
178        struct fb *node = fb, *prev = fb;
179
180        while(node != NULL)
181        {
182                prev = node;
183                node = node->next;
184                if(prev != NULL)
185                        delfb(prev->name);
186        }
187        debug(1000, "out");
188}
189
190struct fb* openfb(char *fbdev, int devnr)
191{
192        debug(1000, "in");
193        int fd = -1;
194        unsigned char *mmapfb = NULL;
195        struct fb_var_screeninfo var_screeninfo;
196        struct fb_fix_screeninfo fix_screeninfo;
197        struct fb* node = NULL;
198
199        if(fbdev == NULL)
200        {
201                err("failed to find fbdev in config file");
202                return NULL;
203        }
204
205#ifndef NOFB
206        fd = open(fbdev, O_RDWR);
207        if(fd == -1)
208        {
209                perr("failed to open %s", fbdev);
210                return NULL;
211        }
212        closeonexec(fd);
213
214        if(ioctl(fd, FBIOGET_VSCREENINFO, &var_screeninfo) == -1)
215        {
216                perr("ioctl FBIOGET_VSCREENINFO failed");
217                close(fd);
218                return NULL;
219        }
220
221        if(ioctl(fd, FBIOGET_FSCREENINFO, &fix_screeninfo) == -1)
222        {
223                perr("ioctl FBIOGET_FSCREENINFO failed");
224                close(fd);
225                return NULL;
226        }
227
228        if(!(mmapfb = (unsigned char*)mmap(0, fix_screeninfo.smem_len, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0)))
229        {
230                perr("mmap framebuffer");
231                close(fd);
232                return NULL;
233        }
234
235        if(devnr == 0)
236                node = addfb(FB, devnr, var_screeninfo.xres, var_screeninfo.yres, var_screeninfo.bits_per_pixel / 8, fd, mmapfb, fix_screeninfo.smem_len);
237        if(devnr == 1)
238                node = addfb(FB1, devnr, var_screeninfo.xres, var_screeninfo.yres, var_screeninfo.bits_per_pixel / 8, fd, mmapfb, fix_screeninfo.smem_len);
239
240#else
241
242        mmapfb = malloc(16 * 1024 * 1024);
243        if(devnr == 0)
244                node = addfb(FB, devnr, getconfigint("skinfbwidth", NULL), getconfigint("skinfbheight", NULL), 4, -1, mmapfb, 16*1024*1024);
245        if(devnr == 1)
246                node = addfb(FB1, devnr, getconfigint("skinfbwidth", NULL), getconfigint("skinfbheight", NULL), 4, -1, mmapfb, 16*1024*1024);
247
248#endif
249
250        debug(1000, "out");
251        return node;
252}
253
254void closefb()
255{
256        if(fb != NULL)
257        {
258                if(fb->fb != NULL)
259                        munmap(fb->fb, fb->fixfbsize);
260                if(fb->fd != -1)
261                        close(fb->fd);
262#ifdef NOFB
263                free(fb->fb);
264#endif
265        }
266}
267
268void clearfball()
269{
270        if(fb != NULL && fb->fb != NULL)
271                memset(fb->fb, 0, fb->fixfbsize);
272}
273
274void clearfb(struct fb *node)
275{
276        if(node != NULL)
277                memset(node->fb, 0, node->varfbsize);
278}
279
280void blitfb(int flag)
281{
282        blitfb2(skinfb, flag);
283}
284
285//flag 0: del skinfb
286//flag 1: don't del skinfb
287void changefbresolution(char *value, int flag)
288{
289        if(ostrcmp("pal", value) == 0)
290        {
291                fb->width = 720;
292                fb->height = 576;
293                fb->pitch = fb->width * fb->colbytes;
294        }
295        else if(ostrncmp("576", value, 3) == 0)
296        {
297                fb->width = 720;
298                fb->height = 576;
299                fb->pitch = fb->width * fb->colbytes;
300        }
301        else if(ostrncmp("720", value, 3) == 0)
302        {
303                fb->width = 1280;
304                fb->height = 720;
305                fb->pitch = fb->width * fb->colbytes;
306        }
307        else if(ostrncmp("1080", value, 4) == 0)
308        {
309                fb->width = 1920;
310                fb->height = 1080;
311                fb->pitch = fb->width * fb->colbytes;
312        }
313        if(skinfb == fb)
314        {
315                skin->width = skinfb->width;
316                skin->height = skinfb->height;
317                skin->iwidth = skinfb->width;
318                skin->iheight = skinfb->height;
319                skin->rwidth = skinfb->width;
320                skin->rheight = skinfb->height;
321        }
322        clearfb(fb);
323        if(flag == 0) clearfb(skinfb);
324}
325
326static void write_PNG(unsigned char *outbuffer, char *filename,
327                                int width, int height, int interlace)
328{
329        int i;
330        int bit_depth=0, color_type;
331        png_bytep row_pointers[height];
332        png_structp png_ptr;
333        png_infop info_ptr;
334        FILE *outfile = fopen(filename, "wb");
335
336        for (i=0; i<height; i++)
337                row_pointers[i] = outbuffer + i * 4 * width;
338               
339        if (!outfile)
340        {
341                fprintf (stderr, "Error: Couldn't fopen %s.\n", filename);
342                exit(EXIT_FAILURE);
343        }
344   
345        png_ptr = png_create_write_struct(PNG_LIBPNG_VER_STRING,
346        (png_voidp) NULL, (png_error_ptr) NULL, (png_error_ptr) NULL);
347   
348        if (!png_ptr)
349                err("Error: Couldn't create PNG write struct.");
350   
351        info_ptr = png_create_info_struct(png_ptr);
352        if (!info_ptr)
353        {
354                png_destroy_write_struct(&png_ptr, (png_infopp) NULL);
355                err("Error: Couldn't create PNG info struct.");
356        }
357   
358        png_init_io(png_ptr, outfile);
359   
360        png_set_compression_level(png_ptr, Z_BEST_COMPRESSION);
361   
362        bit_depth = 8;
363        color_type = PNG_COLOR_TYPE_RGB_ALPHA;
364        //color_type = PNG_COLOR_TYPE_RGB;
365        png_set_invert_alpha(png_ptr);
366        png_set_bgr(png_ptr);
367
368        png_set_IHDR(png_ptr, info_ptr, width, height,
369        bit_depth, color_type, interlace,
370        PNG_COMPRESSION_TYPE_DEFAULT, PNG_FILTER_TYPE_DEFAULT);
371   
372        png_write_info(png_ptr, info_ptr);
373   
374        printf ("Now writing PNG file\n");
375   
376        png_write_image(png_ptr, row_pointers);
377   
378        png_write_end(png_ptr, info_ptr);
379        /* puh, done, now freeing memory... */
380        png_destroy_write_struct(&png_ptr, &info_ptr);
381   
382        if (outfile != NULL)
383                (void) fclose(outfile);
384}
385
386static void convert_and_write(unsigned char *inbuffer, char *filename,
387                                int width, int height, int bits, int interlace)
388{
389        size_t bufsize = (size_t) width * height * 4;
390
391        unsigned char *outbuffer = malloc(bufsize);
392
393        if (outbuffer == NULL)
394                err("Not enough memory");
395       
396        memset(outbuffer, 0, bufsize);
397        write_PNG(inbuffer, filename, width, height, interlace);
398        (void) free(outbuffer);
399}
400
401int fb2png(unsigned char *buf_p, int width, int height, char *outfile)
402{
403        int interlace = PNG_INTERLACE_ADAM7;
404        int bitdepth = 32;
405               
406        size_t help = 0;
407        while(help <= (width * height * 4))
408        {
409                buf_p[help+3] = 0x00;
410                help = help + 4;
411        }
412               
413        convert_and_write(buf_p, outfile, width, height, bitdepth, interlace);
414
415        return 0;
416}
417
418void pngforlcd(unsigned char *fbuffer, int width, int height)
419{
420        fb2png(fbuffer, width, height, "/tmp/titanlcd.png");
421}
422
423void write_FB_to_JPEG_file(unsigned char *inbuffer, int image_width, int image_height, char * filename, int quality)
424{
425       
426               
427        size_t helpb = 0;
428        size_t help = 0;
429        unsigned char *helpbuffer = malloc(image_width*image_height*3);
430       
431        //delete alpha byte
432        while(help <= (image_width*image_height*4))
433        {
434                helpbuffer[helpb+0] = inbuffer[help+2];
435                helpbuffer[helpb+1] = inbuffer[help+1];
436                helpbuffer[helpb+2] = inbuffer[help+0];
437                help = help + 4;
438                helpb = helpb + 3;
439        }
440       
441        JSAMPLE *image_buffer = helpbuffer;
442        struct jpeg_compress_struct cinfo;
443        struct jpeg_error_mgr jerr;
444        FILE * outfile;
445       
446        JSAMPROW row_pointer[1];
447        int row_stride;
448       
449        cinfo.err = jpeg_std_error(&jerr);
450        jpeg_create_compress(&cinfo);
451        if ((outfile = fopen(filename, "wb")) == NULL) {
452                fprintf(stderr, "can't open %s\n", filename);
453                exit(1);
454        }
455        jpeg_stdio_dest(&cinfo, outfile);
456        cinfo.image_width = image_width;        /* image width and height, in pixels */
457        cinfo.image_height = image_height;
458        cinfo.input_components = 3;             /* # of color components per pixel */
459        cinfo.in_color_space = JCS_RGB;
460
461        jpeg_set_defaults(&cinfo);
462        jpeg_set_quality(&cinfo, quality, TRUE);
463
464        jpeg_start_compress(&cinfo, TRUE);
465        row_stride = image_width * 3;
466
467        while (cinfo.next_scanline < cinfo.image_height) {
468                row_pointer[0] = & image_buffer[cinfo.next_scanline * row_stride];
469                (void) jpeg_write_scanlines(&cinfo, row_pointer, 1);
470        }
471
472        jpeg_finish_compress(&cinfo);
473        fclose(outfile);
474        jpeg_destroy_compress(&cinfo);
475   
476        free(helpbuffer);
477}
478
479#endif
Note: See TracBrowser for help on using the repository browser.