2 * Raspberry Pi emulation (c) 2012 Gregory Estrade
3 * Refactoring for Pi2 Copyright (c) 2015, Microsoft. Written by Andrew Baumann.
4 * This code is licensed under the GNU GPLv2 and later.
6 * Heavily based on milkymist-vgafb.c, copyright terms below:
7 * QEMU model of the Milkymist VGA framebuffer.
9 * Copyright (c) 2010-2012 Michael Walle <michael@walle.cc>
11 * This library is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU Lesser General Public
13 * License as published by the Free Software Foundation; either
14 * version 2 of the License, or (at your option) any later version.
16 * This library is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
19 * Lesser General Public License for more details.
21 * You should have received a copy of the GNU Lesser General Public
22 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
26 #include "qemu/osdep.h"
27 #include "qapi/error.h"
28 #include "hw/display/bcm2835_fb.h"
30 #include "framebuffer.h"
31 #include "ui/pixel_ops.h"
32 #include "hw/misc/bcm2835_mbox_defs.h"
33 #include "migration/vmstate.h"
35 #include "qemu/module.h"
37 #define DEFAULT_VCRAM_SIZE 0x4000000
38 #define BCM2835_FB_OFFSET 0x00100000
40 /* Maximum permitted framebuffer size; experimentally determined on an rpi2 */
43 /* Framebuffer size used if guest requests zero size */
44 #define XRES_SMALL 592
45 #define YRES_SMALL 488
47 static void fb_invalidate_display(void *opaque
)
49 BCM2835FBState
*s
= BCM2835_FB(opaque
);
54 static void draw_line_src16(void *opaque
, uint8_t *dst
, const uint8_t *src
,
55 int width
, int deststep
)
57 BCM2835FBState
*s
= opaque
;
61 DisplaySurface
*surface
= qemu_console_surface(s
->con
);
62 int bpp
= surface_bits_per_pixel(surface
);
65 switch (s
->config
.bpp
) {
67 /* lookup palette starting at video ram base
68 * TODO: cache translation, rather than doing this each time!
70 rgb888
= ldl_le_phys(&s
->dma_as
, s
->vcram_base
+ (*src
<< 2));
71 r
= (rgb888
>> 0) & 0xff;
72 g
= (rgb888
>> 8) & 0xff;
73 b
= (rgb888
>> 16) & 0xff;
77 rgb565
= lduw_le_p(src
);
78 r
= ((rgb565
>> 11) & 0x1f) << 3;
79 g
= ((rgb565
>> 5) & 0x3f) << 2;
80 b
= ((rgb565
>> 0) & 0x1f) << 3;
84 rgb888
= ldl_le_p(src
);
85 r
= (rgb888
>> 0) & 0xff;
86 g
= (rgb888
>> 8) & 0xff;
87 b
= (rgb888
>> 16) & 0xff;
91 rgb888
= ldl_le_p(src
);
92 r
= (rgb888
>> 0) & 0xff;
93 g
= (rgb888
>> 8) & 0xff;
94 b
= (rgb888
>> 16) & 0xff;
104 if (s
->config
.pixo
== 0) {
105 /* swap to BGR pixel format */
113 *dst
++ = rgb_to_pixel8(r
, g
, b
);
116 *(uint16_t *)dst
= rgb_to_pixel15(r
, g
, b
);
120 *(uint16_t *)dst
= rgb_to_pixel16(r
, g
, b
);
124 rgb888
= rgb_to_pixel24(r
, g
, b
);
125 *dst
++ = rgb888
& 0xff;
126 *dst
++ = (rgb888
>> 8) & 0xff;
127 *dst
++ = (rgb888
>> 16) & 0xff;
130 *(uint32_t *)dst
= rgb_to_pixel32(r
, g
, b
);
139 static bool fb_use_offsets(BCM2835FBConfig
*config
)
142 * Return true if we should use the viewport offsets.
143 * Experimentally, the hardware seems to do this only if the
144 * viewport size is larger than the physical screen. (It doesn't
145 * prevent the guest setting this silly viewport setting, though...)
147 return config
->xres_virtual
> config
->xres
&&
148 config
->yres_virtual
> config
->yres
;
151 static void fb_update_display(void *opaque
)
153 BCM2835FBState
*s
= opaque
;
154 DisplaySurface
*surface
= qemu_console_surface(s
->con
);
159 uint32_t xoff
= 0, yoff
= 0;
161 if (s
->lock
|| !s
->config
.xres
) {
165 src_width
= bcm2835_fb_get_pitch(&s
->config
);
166 if (fb_use_offsets(&s
->config
)) {
167 xoff
= s
->config
.xoffset
;
168 yoff
= s
->config
.yoffset
;
171 dest_width
= s
->config
.xres
;
173 switch (surface_bits_per_pixel(surface
)) {
191 hw_error("bcm2835_fb: bad color depth\n");
196 hwaddr base
= s
->config
.base
+ xoff
+ (hwaddr
)yoff
* src_width
;
197 framebuffer_update_memory_section(&s
->fbsection
, s
->dma_mr
,
199 s
->config
.yres
, src_width
);
202 framebuffer_update_display(surface
, &s
->fbsection
,
203 s
->config
.xres
, s
->config
.yres
,
204 src_width
, dest_width
, 0, s
->invalidate
,
205 draw_line_src16
, s
, &first
, &last
);
208 dpy_gfx_update(s
->con
, 0, first
, s
->config
.xres
,
212 s
->invalidate
= false;
215 void bcm2835_fb_validate_config(BCM2835FBConfig
*config
)
218 * Validate the config, and clip any bogus values into range,
219 * as the hardware does. Note that fb_update_display() relies on
220 * this happening to prevent it from performing out-of-range
221 * accesses on redraw.
223 config
->xres
= MIN(config
->xres
, XRES_MAX
);
224 config
->xres_virtual
= MIN(config
->xres_virtual
, XRES_MAX
);
225 config
->yres
= MIN(config
->yres
, YRES_MAX
);
226 config
->yres_virtual
= MIN(config
->yres_virtual
, YRES_MAX
);
229 * These are not minima: a 40x40 framebuffer will be accepted.
230 * They're only used as defaults if the guest asks for zero size.
232 if (config
->xres
== 0) {
233 config
->xres
= XRES_SMALL
;
235 if (config
->yres
== 0) {
236 config
->yres
= YRES_SMALL
;
238 if (config
->xres_virtual
== 0) {
239 config
->xres_virtual
= config
->xres
;
241 if (config
->yres_virtual
== 0) {
242 config
->yres_virtual
= config
->yres
;
245 if (fb_use_offsets(config
)) {
246 /* Clip the offsets so the viewport is within the physical screen */
247 config
->xoffset
= MIN(config
->xoffset
,
248 config
->xres_virtual
- config
->xres
);
249 config
->yoffset
= MIN(config
->yoffset
,
250 config
->yres_virtual
- config
->yres
);
254 void bcm2835_fb_reconfigure(BCM2835FBState
*s
, BCM2835FBConfig
*newconfig
)
258 s
->config
= *newconfig
;
260 s
->invalidate
= true;
261 qemu_console_resize(s
->con
, s
->config
.xres
, s
->config
.yres
);
265 static void bcm2835_fb_mbox_push(BCM2835FBState
*s
, uint32_t value
)
269 BCM2835FBConfig newconf
;
273 newconf
.xres
= ldl_le_phys(&s
->dma_as
, value
);
274 newconf
.yres
= ldl_le_phys(&s
->dma_as
, value
+ 4);
275 newconf
.xres_virtual
= ldl_le_phys(&s
->dma_as
, value
+ 8);
276 newconf
.yres_virtual
= ldl_le_phys(&s
->dma_as
, value
+ 12);
277 newconf
.bpp
= ldl_le_phys(&s
->dma_as
, value
+ 20);
278 newconf
.xoffset
= ldl_le_phys(&s
->dma_as
, value
+ 24);
279 newconf
.yoffset
= ldl_le_phys(&s
->dma_as
, value
+ 28);
281 newconf
.base
= s
->vcram_base
| (value
& 0xc0000000);
282 newconf
.base
+= BCM2835_FB_OFFSET
;
284 bcm2835_fb_validate_config(&newconf
);
286 pitch
= bcm2835_fb_get_pitch(&newconf
);
287 size
= bcm2835_fb_get_size(&newconf
);
289 stl_le_phys(&s
->dma_as
, value
+ 16, pitch
);
290 stl_le_phys(&s
->dma_as
, value
+ 32, newconf
.base
);
291 stl_le_phys(&s
->dma_as
, value
+ 36, size
);
293 bcm2835_fb_reconfigure(s
, &newconf
);
296 static uint64_t bcm2835_fb_read(void *opaque
, hwaddr offset
, unsigned size
)
298 BCM2835FBState
*s
= opaque
;
305 qemu_set_irq(s
->mbox_irq
, 0);
308 case MBOX_AS_PENDING
:
313 qemu_log_mask(LOG_GUEST_ERROR
, "%s: Bad offset %"HWADDR_PRIx
"\n",
321 static void bcm2835_fb_write(void *opaque
, hwaddr offset
, uint64_t value
,
324 BCM2835FBState
*s
= opaque
;
328 /* bcm2835_mbox should check our pending status before pushing */
331 bcm2835_fb_mbox_push(s
, value
);
332 qemu_set_irq(s
->mbox_irq
, 1);
336 qemu_log_mask(LOG_GUEST_ERROR
, "%s: Bad offset %"HWADDR_PRIx
"\n",
342 static const MemoryRegionOps bcm2835_fb_ops
= {
343 .read
= bcm2835_fb_read
,
344 .write
= bcm2835_fb_write
,
345 .endianness
= DEVICE_NATIVE_ENDIAN
,
346 .valid
.min_access_size
= 4,
347 .valid
.max_access_size
= 4,
350 static const VMStateDescription vmstate_bcm2835_fb
= {
351 .name
= TYPE_BCM2835_FB
,
353 .minimum_version_id
= 1,
354 .fields
= (VMStateField
[]) {
355 VMSTATE_BOOL(lock
, BCM2835FBState
),
356 VMSTATE_BOOL(invalidate
, BCM2835FBState
),
357 VMSTATE_BOOL(pending
, BCM2835FBState
),
358 VMSTATE_UINT32(config
.xres
, BCM2835FBState
),
359 VMSTATE_UINT32(config
.yres
, BCM2835FBState
),
360 VMSTATE_UINT32(config
.xres_virtual
, BCM2835FBState
),
361 VMSTATE_UINT32(config
.yres_virtual
, BCM2835FBState
),
362 VMSTATE_UINT32(config
.xoffset
, BCM2835FBState
),
363 VMSTATE_UINT32(config
.yoffset
, BCM2835FBState
),
364 VMSTATE_UINT32(config
.bpp
, BCM2835FBState
),
365 VMSTATE_UINT32(config
.base
, BCM2835FBState
),
366 VMSTATE_UNUSED(8), /* Was pitch and size */
367 VMSTATE_UINT32(config
.pixo
, BCM2835FBState
),
368 VMSTATE_UINT32(config
.alpha
, BCM2835FBState
),
369 VMSTATE_END_OF_LIST()
373 static const GraphicHwOps vgafb_ops
= {
374 .invalidate
= fb_invalidate_display
,
375 .gfx_update
= fb_update_display
,
378 static void bcm2835_fb_init(Object
*obj
)
380 BCM2835FBState
*s
= BCM2835_FB(obj
);
382 memory_region_init_io(&s
->iomem
, obj
, &bcm2835_fb_ops
, s
, TYPE_BCM2835_FB
,
384 sysbus_init_mmio(SYS_BUS_DEVICE(s
), &s
->iomem
);
385 sysbus_init_irq(SYS_BUS_DEVICE(s
), &s
->mbox_irq
);
388 static void bcm2835_fb_reset(DeviceState
*dev
)
390 BCM2835FBState
*s
= BCM2835_FB(dev
);
394 s
->config
= s
->initial_config
;
396 s
->invalidate
= true;
400 static void bcm2835_fb_realize(DeviceState
*dev
, Error
**errp
)
402 BCM2835FBState
*s
= BCM2835_FB(dev
);
406 if (s
->vcram_base
== 0) {
407 error_setg(errp
, "%s: required vcram-base property not set", __func__
);
411 obj
= object_property_get_link(OBJECT(dev
), "dma-mr", &err
);
413 error_setg(errp
, "%s: required dma-mr link not found: %s",
414 __func__
, error_get_pretty(err
));
418 /* Fill in the parts of initial_config that are not set by QOM properties */
419 s
->initial_config
.xres_virtual
= s
->initial_config
.xres
;
420 s
->initial_config
.yres_virtual
= s
->initial_config
.yres
;
421 s
->initial_config
.xoffset
= 0;
422 s
->initial_config
.yoffset
= 0;
423 s
->initial_config
.base
= s
->vcram_base
+ BCM2835_FB_OFFSET
;
425 s
->dma_mr
= MEMORY_REGION(obj
);
426 address_space_init(&s
->dma_as
, s
->dma_mr
, NULL
);
428 bcm2835_fb_reset(dev
);
430 s
->con
= graphic_console_init(dev
, 0, &vgafb_ops
, s
);
431 qemu_console_resize(s
->con
, s
->config
.xres
, s
->config
.yres
);
434 static Property bcm2835_fb_props
[] = {
435 DEFINE_PROP_UINT32("vcram-base", BCM2835FBState
, vcram_base
, 0),/*required*/
436 DEFINE_PROP_UINT32("vcram-size", BCM2835FBState
, vcram_size
,
438 DEFINE_PROP_UINT32("xres", BCM2835FBState
, initial_config
.xres
, 640),
439 DEFINE_PROP_UINT32("yres", BCM2835FBState
, initial_config
.yres
, 480),
440 DEFINE_PROP_UINT32("bpp", BCM2835FBState
, initial_config
.bpp
, 16),
441 DEFINE_PROP_UINT32("pixo", BCM2835FBState
,
442 initial_config
.pixo
, 1), /* 1=RGB, 0=BGR */
443 DEFINE_PROP_UINT32("alpha", BCM2835FBState
,
444 initial_config
.alpha
, 2), /* alpha ignored */
445 DEFINE_PROP_END_OF_LIST()
448 static void bcm2835_fb_class_init(ObjectClass
*klass
, void *data
)
450 DeviceClass
*dc
= DEVICE_CLASS(klass
);
452 dc
->props
= bcm2835_fb_props
;
453 dc
->realize
= bcm2835_fb_realize
;
454 dc
->reset
= bcm2835_fb_reset
;
455 dc
->vmsd
= &vmstate_bcm2835_fb
;
458 static TypeInfo bcm2835_fb_info
= {
459 .name
= TYPE_BCM2835_FB
,
460 .parent
= TYPE_SYS_BUS_DEVICE
,
461 .instance_size
= sizeof(BCM2835FBState
),
462 .class_init
= bcm2835_fb_class_init
,
463 .instance_init
= bcm2835_fb_init
,
466 static void bcm2835_fb_register_types(void)
468 type_register_static(&bcm2835_fb_info
);
471 type_init(bcm2835_fb_register_types
)