1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
|
/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
*
* Copyright (C) 2017 Marcin Bukat
* Copyright (C) 2016 Amaury Pouly
* Copyright (C) 2019 Roman Stolyarov
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/
#include <stdlib.h>
#include <unistd.h>
#include <stdio.h>
#include <string.h>
#include <linux/fb.h>
#include <sys/mman.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include "lcd.h"
#include "lcd-target.h"
#include "backlight-target.h"
#include "sysfs.h"
#include "panic.h"
//#define FB_DOUBLEBUF
static int fd = -1;
static struct fb_var_screeninfo vinfo;
static struct fb_fix_screeninfo finfo;
fb_data *framebuffer = NULL; /* global variable, see lcd-target.h */
#ifdef FB_DOUBLEBUF
static int fb_plane;
static int doublebuf;
#else
#define fb_plane 0
#endif
static void redraw(void)
{
#ifdef FB_DOUBLEBUF
if (doublebuf) {
vinfo.yoffset = fb_plane * LCD_HEIGHT;
fb_plane = !fb_plane;
vinfo.activate = FB_ACTIVATE_VBL;
}
#endif
ioctl(fd, FBIOPAN_DISPLAY, &vinfo);
}
void lcd_init_device(void)
{
const char * const fb_dev = "/dev/fb0";
fd = open(fb_dev, O_RDWR | O_CLOEXEC);
if(fd < 0)
{
panicf("Cannot open framebuffer: %s\n", fb_dev);
}
/* get fixed information */
if(ioctl(fd, FBIOGET_FSCREENINFO, &finfo) < 0)
{
panicf("Cannot read framebuffer fixed information");
}
if (finfo.smem_len < FRAMEBUFFER_SIZE)
panicf("FRAMEBUFFER_SIZE too large for hardware? (%u vs %u)", FRAMEBUFFER_SIZE, finfo.smem_len);
#ifdef FB_DOUBLEBUF
if (finfo.smem_len >= 2*FRAMEBUFFER_SIZE)
doublebuf = 1;
fb_plane = 0;
#endif
/* get variable information */
if(ioctl(fd, FBIOGET_VSCREENINFO, &vinfo) < 0)
{
panicf("Cannot read framebuffer variable information");
}
#ifdef FB_DOUBLEBUF
if (doublebuf) {
vinfo.yres_virtual = vinfo.yres * 2;
if(ioctl(fd, FBIOPUT_VSCREENINFO, &vinfo) < 0) {
panicf("Cannot write framebuffer variable information");
}
}
#if 0
/* check resolution and framebuffer size */
if(vinfo.xres != LCD_WIDTH || vinfo.yres != LCD_HEIGHT || vinfo.bits_per_pixel != LCD_DEPTH)
{
panicf("Unexpected framebuffer resolution: %dx%dx%d\n", vinfo.xres,
vinfo.yres, vinfo.bits_per_pixel);
}
#endif
#else
/* Make sure we match our desired bitdepth */
if (vinfo.bits_per_pixel != LCD_DEPTH || vinfo.xres != LCD_WIDTH || vinfo.yres != LCD_HEIGHT) {
vinfo.bits_per_pixel = LCD_DEPTH;
vinfo.xres = LCD_WIDTH;
vinfo.yres = LCD_HEIGHT;
if (ioctl(fd, FBIOPUT_VSCREENINFO, &vinfo)) {
panicf("Cannot set framebuffer to %dx%dx%d",
vinfo.xres, vinfo.yres, vinfo.bits_per_pixel);
}
}
#endif
/* map framebuffer */
framebuffer = mmap(NULL, finfo.smem_len, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
if((void *)framebuffer == MAP_FAILED)
{
panicf("Cannot map framebuffer");
}
memset(framebuffer, 0, finfo.smem_len);
#ifdef HAVE_LCD_ENABLE
lcd_set_active(true);
#endif
}
#ifdef HAVE_LCD_SHUTDOWN
void lcd_shutdown(void)
{
munmap(framebuffer, FRAMEBUFFER_SIZE);
framebuffer = NULL;
close(fd);
fd = -1;
}
#endif
#ifdef HAVE_LCD_ENABLE
void lcd_enable(bool on)
{
if (fd < 0) return;
if (lcd_active() == on)
return;
lcd_set_active(on);
if (on) {
send_event(LCD_EVENT_ACTIVATION, NULL);
ioctl(fd, FB_BLANK_UNBLANK);
} else {
memset(framebuffer, 0, finfo.smem_len);
redraw();
ioctl(fd, FB_BLANK_POWERDOWN);
}
}
#endif
extern void lcd_copy_buffer_rect(fb_data *dst, const fb_data *src,
int width, int height);
void lcd_update(void)
{
if (fd < 0) return;
#ifdef HAVE_LCD_ENABLE
if (lcd_active())
#endif
{
/* Copy the Rockbox framebuffer to the second framebuffer */
fb_data *dst = LCD_FRAMEBUF_ADDR(0, 0) + (fb_plane * FRAMEBUFFER_SIZE);
lcd_copy_buffer_rect(dst, FBADDR(0,0),
LCD_WIDTH*LCD_HEIGHT, 1);
redraw();
}
}
void lcd_update_rect(int x, int y, int width, int height)
{
if (fd < 0) return;
#ifdef HAVE_LCD_ENABLE
if (lcd_active())
#endif
{
fb_data *dst = LCD_FRAMEBUF_ADDR(x, y) + (fb_plane * FRAMEBUFFER_SIZE);
fb_data *src = FBADDR(x,y);
/* Copy part of the Rockbox framebuffer to the second framebuffer */
if (width < LCD_WIDTH)
{
/* Not full width - do line-by-line */
lcd_copy_buffer_rect(dst, src, width, height);
}
else
{
/* Full width - copy as one line */
lcd_copy_buffer_rect(dst, src, LCD_WIDTH*height, 1);
}
redraw();
}
}
|
