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"
29 #include "framebuffer.h"
30 #include "ui/pixel_ops.h"
31 #include "hw/misc/bcm2835_mbox_defs.h"
33 #include "qemu/module.h"
35 #define DEFAULT_VCRAM_SIZE 0x4000000
36 #define BCM2835_FB_OFFSET 0x00100000
38 /* Maximum permitted framebuffer size; experimentally determined on an rpi2 */
41 /* Framebuffer size used if guest requests zero size */
42 #define XRES_SMALL 592
43 #define YRES_SMALL 488
45 static void fb_invalidate_display(void *opaque
)
47 BCM2835FBState
*s
= BCM2835_FB(opaque
);
52 static void draw_line_src16(void *opaque
, uint8_t *dst
, const uint8_t *src
,
53 int width
, int deststep
)
55 BCM2835FBState
*s
= opaque
;
59 DisplaySurface
*surface
= qemu_console_surface(s
->con
);
60 int bpp
= surface_bits_per_pixel(surface
);
63 switch (s
->config
.bpp
) {
65 /* lookup palette starting at video ram base
66 * TODO: cache translation, rather than doing this each time!
68 rgb888
= ldl_le_phys(&s
->dma_as
, s
->vcram_base
+ (*src
<< 2));
69 r
= (rgb888
>> 0) & 0xff;
70 g
= (rgb888
>> 8) & 0xff;
71 b
= (rgb888
>> 16) & 0xff;
75 rgb565
= lduw_le_p(src
);
76 r
= ((rgb565
>> 11) & 0x1f) << 3;
77 g
= ((rgb565
>> 5) & 0x3f) << 2;
78 b
= ((rgb565
>> 0) & 0x1f) << 3;
82 rgb888
= ldl_le_p(src
);
83 r
= (rgb888
>> 0) & 0xff;
84 g
= (rgb888
>> 8) & 0xff;
85 b
= (rgb888
>> 16) & 0xff;
89 rgb888
= ldl_le_p(src
);
90 r
= (rgb888
>> 0) & 0xff;
91 g
= (rgb888
>> 8) & 0xff;
92 b
= (rgb888
>> 16) & 0xff;
102 if (s
->config
.pixo
== 0) {
103 /* swap to BGR pixel format */
111 *dst
++ = rgb_to_pixel8(r
, g
, b
);
114 *(uint16_t *)dst
= rgb_to_pixel15(r
, g
, b
);
118 *(uint16_t *)dst
= rgb_to_pixel16(r
, g
, b
);
122 rgb888
= rgb_to_pixel24(r
, g
, b
);
123 *dst
++ = rgb888
& 0xff;
124 *dst
++ = (rgb888
>> 8) & 0xff;
125 *dst
++ = (rgb888
>> 16) & 0xff;
128 *(uint32_t *)dst
= rgb_to_pixel32(r
, g
, b
);
137 static bool fb_use_offsets(BCM2835FBConfig
*config
)
140 * Return true if we should use the viewport offsets.
141 * Experimentally, the hardware seems to do this only if the
142 * viewport size is larger than the physical screen. (It doesn't
143 * prevent the guest setting this silly viewport setting, though...)
145 return config
->xres_virtual
> config
->xres
&&
146 config
->yres_virtual
> config
->yres
;
149 static void fb_update_display(void *opaque
)
151 BCM2835FBState
*s
= opaque
;
152 DisplaySurface
*surface
= qemu_console_surface(s
->con
);
157 uint32_t xoff
= 0, yoff
= 0;
159 if (s
->lock
|| !s
->config
.xres
) {
163 src_width
= bcm2835_fb_get_pitch(&s
->config
);
164 if (fb_use_offsets(&s
->config
)) {
165 xoff
= s
->config
.xoffset
;
166 yoff
= s
->config
.yoffset
;
169 dest_width
= s
->config
.xres
;
171 switch (surface_bits_per_pixel(surface
)) {
189 hw_error("bcm2835_fb: bad color depth\n");
194 hwaddr base
= s
->config
.base
+ xoff
+ (hwaddr
)yoff
* src_width
;
195 framebuffer_update_memory_section(&s
->fbsection
, s
->dma_mr
,
197 s
->config
.yres
, src_width
);
200 framebuffer_update_display(surface
, &s
->fbsection
,
201 s
->config
.xres
, s
->config
.yres
,
202 src_width
, dest_width
, 0, s
->invalidate
,
203 draw_line_src16
, s
, &first
, &last
);
206 dpy_gfx_update(s
->con
, 0, first
, s
->config
.xres
,
210 s
->invalidate
= false;
213 void bcm2835_fb_validate_config(BCM2835FBConfig
*config
)
216 * Validate the config, and clip any bogus values into range,
217 * as the hardware does. Note that fb_update_display() relies on
218 * this happening to prevent it from performing out-of-range
219 * accesses on redraw.
221 config
->xres
= MIN(config
->xres
, XRES_MAX
);
222 config
->xres_virtual
= MIN(config
->xres_virtual
, XRES_MAX
);
223 config
->yres
= MIN(config
->yres
, YRES_MAX
);
224 config
->yres_virtual
= MIN(config
->yres_virtual
, YRES_MAX
);
227 * These are not minima: a 40x40 framebuffer will be accepted.
228 * They're only used as defaults if the guest asks for zero size.
230 if (config
->xres
== 0) {
231 config
->xres
= XRES_SMALL
;
233 if (config
->yres
== 0) {
234 config
->yres
= YRES_SMALL
;
236 if (config
->xres_virtual
== 0) {
237 config
->xres_virtual
= config
->xres
;
239 if (config
->yres_virtual
== 0) {
240 config
->yres_virtual
= config
->yres
;
243 if (fb_use_offsets(config
)) {
244 /* Clip the offsets so the viewport is within the physical screen */
245 config
->xoffset
= MIN(config
->xoffset
,
246 config
->xres_virtual
- config
->xres
);
247 config
->yoffset
= MIN(config
->yoffset
,
248 config
->yres_virtual
- config
->yres
);
252 void bcm2835_fb_reconfigure(BCM2835FBState
*s
, BCM2835FBConfig
*newconfig
)
256 s
->config
= *newconfig
;
258 s
->invalidate
= true;
259 qemu_console_resize(s
->con
, s
->config
.xres
, s
->config
.yres
);
263 static void bcm2835_fb_mbox_push(BCM2835FBState
*s
, uint32_t value
)
267 BCM2835FBConfig newconf
;
271 newconf
.xres
= ldl_le_phys(&s
->dma_as
, value
);
272 newconf
.yres
= ldl_le_phys(&s
->dma_as
, value
+ 4);
273 newconf
.xres_virtual
= ldl_le_phys(&s
->dma_as
, value
+ 8);
274 newconf
.yres_virtual
= ldl_le_phys(&s
->dma_as
, value
+ 12);
275 newconf
.bpp
= ldl_le_phys(&s
->dma_as
, value
+ 20);
276 newconf
.xoffset
= ldl_le_phys(&s
->dma_as
, value
+ 24);
277 newconf
.yoffset
= ldl_le_phys(&s
->dma_as
, value
+ 28);
279 newconf
.base
= s
->vcram_base
| (value
& 0xc0000000);
280 newconf
.base
+= BCM2835_FB_OFFSET
;
282 bcm2835_fb_validate_config(&newconf
);
284 pitch
= bcm2835_fb_get_pitch(&newconf
);
285 size
= bcm2835_fb_get_size(&newconf
);
287 stl_le_phys(&s
->dma_as
, value
+ 16, pitch
);
288 stl_le_phys(&s
->dma_as
, value
+ 32, newconf
.base
);
289 stl_le_phys(&s
->dma_as
, value
+ 36, size
);
291 bcm2835_fb_reconfigure(s
, &newconf
);
294 static uint64_t bcm2835_fb_read(void *opaque
, hwaddr offset
, unsigned size
)
296 BCM2835FBState
*s
= opaque
;
303 qemu_set_irq(s
->mbox_irq
, 0);
306 case MBOX_AS_PENDING
:
311 qemu_log_mask(LOG_GUEST_ERROR
, "%s: Bad offset %"HWADDR_PRIx
"\n",
319 static void bcm2835_fb_write(void *opaque
, hwaddr offset
, uint64_t value
,
322 BCM2835FBState
*s
= opaque
;
326 /* bcm2835_mbox should check our pending status before pushing */
329 bcm2835_fb_mbox_push(s
, value
);
330 qemu_set_irq(s
->mbox_irq
, 1);
334 qemu_log_mask(LOG_GUEST_ERROR
, "%s: Bad offset %"HWADDR_PRIx
"\n",
340 static const MemoryRegionOps bcm2835_fb_ops
= {
341 .read
= bcm2835_fb_read
,
342 .write
= bcm2835_fb_write
,
343 .endianness
= DEVICE_NATIVE_ENDIAN
,
344 .valid
.min_access_size
= 4,
345 .valid
.max_access_size
= 4,
348 static const VMStateDescription vmstate_bcm2835_fb
= {
349 .name
= TYPE_BCM2835_FB
,
351 .minimum_version_id
= 1,
352 .fields
= (VMStateField
[]) {
353 VMSTATE_BOOL(lock
, BCM2835FBState
),
354 VMSTATE_BOOL(invalidate
, BCM2835FBState
),
355 VMSTATE_BOOL(pending
, BCM2835FBState
),
356 VMSTATE_UINT32(config
.xres
, BCM2835FBState
),
357 VMSTATE_UINT32(config
.yres
, BCM2835FBState
),
358 VMSTATE_UINT32(config
.xres_virtual
, BCM2835FBState
),
359 VMSTATE_UINT32(config
.yres_virtual
, BCM2835FBState
),
360 VMSTATE_UINT32(config
.xoffset
, BCM2835FBState
),
361 VMSTATE_UINT32(config
.yoffset
, BCM2835FBState
),
362 VMSTATE_UINT32(config
.bpp
, BCM2835FBState
),
363 VMSTATE_UINT32(config
.base
, BCM2835FBState
),
364 VMSTATE_UNUSED(8), /* Was pitch and size */
365 VMSTATE_UINT32(config
.pixo
, BCM2835FBState
),
366 VMSTATE_UINT32(config
.alpha
, BCM2835FBState
),
367 VMSTATE_END_OF_LIST()
371 static const GraphicHwOps vgafb_ops
= {
372 .invalidate
= fb_invalidate_display
,
373 .gfx_update
= fb_update_display
,
376 static void bcm2835_fb_init(Object
*obj
)
378 BCM2835FBState
*s
= BCM2835_FB(obj
);
380 memory_region_init_io(&s
->iomem
, obj
, &bcm2835_fb_ops
, s
, TYPE_BCM2835_FB
,
382 sysbus_init_mmio(SYS_BUS_DEVICE(s
), &s
->iomem
);
383 sysbus_init_irq(SYS_BUS_DEVICE(s
), &s
->mbox_irq
);
386 static void bcm2835_fb_reset(DeviceState
*dev
)
388 BCM2835FBState
*s
= BCM2835_FB(dev
);
392 s
->config
= s
->initial_config
;
394 s
->invalidate
= true;
398 static void bcm2835_fb_realize(DeviceState
*dev
, Error
**errp
)
400 BCM2835FBState
*s
= BCM2835_FB(dev
);
404 if (s
->vcram_base
== 0) {
405 error_setg(errp
, "%s: required vcram-base property not set", __func__
);
409 obj
= object_property_get_link(OBJECT(dev
), "dma-mr", &err
);
411 error_setg(errp
, "%s: required dma-mr link not found: %s",
412 __func__
, error_get_pretty(err
));
416 /* Fill in the parts of initial_config that are not set by QOM properties */
417 s
->initial_config
.xres_virtual
= s
->initial_config
.xres
;
418 s
->initial_config
.yres_virtual
= s
->initial_config
.yres
;
419 s
->initial_config
.xoffset
= 0;
420 s
->initial_config
.yoffset
= 0;
421 s
->initial_config
.base
= s
->vcram_base
+ BCM2835_FB_OFFSET
;
423 s
->dma_mr
= MEMORY_REGION(obj
);
424 address_space_init(&s
->dma_as
, s
->dma_mr
, NULL
);
426 bcm2835_fb_reset(dev
);
428 s
->con
= graphic_console_init(dev
, 0, &vgafb_ops
, s
);
429 qemu_console_resize(s
->con
, s
->config
.xres
, s
->config
.yres
);
432 static Property bcm2835_fb_props
[] = {
433 DEFINE_PROP_UINT32("vcram-base", BCM2835FBState
, vcram_base
, 0),/*required*/
434 DEFINE_PROP_UINT32("vcram-size", BCM2835FBState
, vcram_size
,
436 DEFINE_PROP_UINT32("xres", BCM2835FBState
, initial_config
.xres
, 640),
437 DEFINE_PROP_UINT32("yres", BCM2835FBState
, initial_config
.yres
, 480),
438 DEFINE_PROP_UINT32("bpp", BCM2835FBState
, initial_config
.bpp
, 16),
439 DEFINE_PROP_UINT32("pixo", BCM2835FBState
,
440 initial_config
.pixo
, 1), /* 1=RGB, 0=BGR */
441 DEFINE_PROP_UINT32("alpha", BCM2835FBState
,
442 initial_config
.alpha
, 2), /* alpha ignored */
443 DEFINE_PROP_END_OF_LIST()
446 static void bcm2835_fb_class_init(ObjectClass
*klass
, void *data
)
448 DeviceClass
*dc
= DEVICE_CLASS(klass
);
450 dc
->props
= bcm2835_fb_props
;
451 dc
->realize
= bcm2835_fb_realize
;
452 dc
->reset
= bcm2835_fb_reset
;
453 dc
->vmsd
= &vmstate_bcm2835_fb
;
456 static TypeInfo bcm2835_fb_info
= {
457 .name
= TYPE_BCM2835_FB
,
458 .parent
= TYPE_SYS_BUS_DEVICE
,
459 .instance_size
= sizeof(BCM2835FBState
),
460 .class_init
= bcm2835_fb_class_init
,
461 .instance_init
= bcm2835_fb_init
,
464 static void bcm2835_fb_register_types(void)
466 type_register_static(&bcm2835_fb_info
);
469 type_init(bcm2835_fb_register_types
)