1 /*
2 * Copyright (C) 2008 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17 #include <stdio.h>
18 #include <stdlib.h>
19 #include <unistd.h>
20 #include <fcntl.h>
21 #include <sys/mman.h>
22 #include <sys/stat.h>
23 #include <sys/types.h>
24
25 #include <linux/fb.h>
26 #include <linux/kd.h>
27
28 #include "log.h"
29
30 #ifdef ANDROID
31 #include <cutils/memory.h>
32 #else
android_memset16(void * _ptr,unsigned short val,unsigned count)33 void android_memset16(void *_ptr, unsigned short val, unsigned count)
34 {
35 unsigned short *ptr = _ptr;
36 count >>= 1;
37 while(count--)
38 *ptr++ = val;
39 }
40 #endif
41
42 struct FB {
43 unsigned short *bits;
44 unsigned size;
45 int fd;
46 struct fb_fix_screeninfo fi;
47 struct fb_var_screeninfo vi;
48 };
49
50 #define fb_width(fb) ((fb)->vi.xres)
51 #define fb_height(fb) ((fb)->vi.yres)
52 #define fb_size(fb) ((fb)->vi.xres * (fb)->vi.yres * 2)
53
fb_open(struct FB * fb)54 static int fb_open(struct FB *fb)
55 {
56 fb->fd = open("/dev/graphics/fb0", O_RDWR);
57 if (fb->fd < 0)
58 return -1;
59
60 if (ioctl(fb->fd, FBIOGET_FSCREENINFO, &fb->fi) < 0)
61 goto fail;
62 if (ioctl(fb->fd, FBIOGET_VSCREENINFO, &fb->vi) < 0)
63 goto fail;
64
65 fb->bits = mmap(0, fb_size(fb), PROT_READ | PROT_WRITE,
66 MAP_SHARED, fb->fd, 0);
67 if (fb->bits == MAP_FAILED)
68 goto fail;
69
70 return 0;
71
72 fail:
73 close(fb->fd);
74 return -1;
75 }
76
fb_close(struct FB * fb)77 static void fb_close(struct FB *fb)
78 {
79 munmap(fb->bits, fb_size(fb));
80 close(fb->fd);
81 }
82
83 /* there's got to be a more portable way to do this ... */
fb_update(struct FB * fb)84 static void fb_update(struct FB *fb)
85 {
86 fb->vi.yoffset = 1;
87 ioctl(fb->fd, FBIOPUT_VSCREENINFO, &fb->vi);
88 fb->vi.yoffset = 0;
89 ioctl(fb->fd, FBIOPUT_VSCREENINFO, &fb->vi);
90 }
91
vt_set_mode(int graphics)92 static int vt_set_mode(int graphics)
93 {
94 int fd, r;
95 fd = open("/dev/tty0", O_RDWR | O_SYNC);
96 if (fd < 0)
97 return -1;
98 r = ioctl(fd, KDSETMODE, (void*) (graphics ? KD_GRAPHICS : KD_TEXT));
99 close(fd);
100 return r;
101 }
102
103 /* 565RLE image format: [count(2 bytes), rle(2 bytes)] */
104
load_565rle_image(char * fn)105 int load_565rle_image(char *fn)
106 {
107 struct FB fb;
108 struct stat s;
109 unsigned short *data, *bits, *ptr;
110 unsigned count, max;
111 int fd;
112
113 if (vt_set_mode(1))
114 return -1;
115
116 fd = open(fn, O_RDONLY);
117 if (fd < 0) {
118 ERROR("cannot open '%s'\n", fn);
119 goto fail_restore_text;
120 }
121
122 if (fstat(fd, &s) < 0) {
123 goto fail_close_file;
124 }
125
126 data = mmap(0, s.st_size, PROT_READ, MAP_SHARED, fd, 0);
127 if (data == MAP_FAILED)
128 goto fail_close_file;
129
130 if (fb_open(&fb))
131 goto fail_unmap_data;
132
133 max = fb_width(&fb) * fb_height(&fb);
134 ptr = data;
135 count = s.st_size;
136 bits = fb.bits;
137 while (count > 3) {
138 unsigned n = ptr[0];
139 if (n > max)
140 break;
141 android_memset16(bits, ptr[1], n << 1);
142 bits += n;
143 max -= n;
144 ptr += 2;
145 count -= 4;
146 }
147
148 munmap(data, s.st_size);
149 fb_update(&fb);
150 fb_close(&fb);
151 close(fd);
152 unlink(fn);
153 return 0;
154
155 fail_unmap_data:
156 munmap(data, s.st_size);
157 fail_close_file:
158 close(fd);
159 fail_restore_text:
160 vt_set_mode(0);
161 return -1;
162 }
163
164