Changeset 37d0dd4 in mainline for kernel/genarch/src/drivers/bcm2835/mbox.c

Timestamp:

2021-06-24T08:32:54Z (3 years ago)

Author:

GitHub <noreply@…>

Branches:

master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

65ec18d

Parents:

a977e37 (diff), 1b7b7af (diff)
Note: this is a merge changeset, the changes displayed below correspond to the merge itself.
Use the (diff) links above to see all the changes relative to each parent.

git-author:

Maurizio Lombardi <mlombard@…> (2021-06-24 08:32:54)

git-committer:

GitHub <noreply@…> (2021-06-24 08:32:54)

Message:

Merge pull request #214 from maurizio-lombardi/gfx_rpi3

Graphics improvements for the Raspberry PI

File:

• kernel/genarch/src/drivers/bcm2835/mbox.c (modified) (3 diffs)

kernel/genarch/src/drivers/bcm2835/mbox.c

@@ -86 +86 @@
 }
 
-bool bcm2835_fb_init(fb_properties_t *prop)
+bool bcm2835_fb_init(fb_properties_t *prop, uint32_t width, uint32_t height)
 {
         bcm2835_mbox_t *fb_mbox;
@@ -95 +95 @@
             KM_NATURAL_ALIGNMENT, PAGE_NOT_CACHEABLE);
 
-        fb_desc->width = 640;
-        fb_desc->height = 480;
+        fb_desc->width = width;
+        fb_desc->height = height;
         fb_desc->virt_width = fb_desc->width;
         fb_desc->virt_height = fb_desc->height;
@@ -128 +128 @@
 }
 
+bool bcm2835_mbox_get_fb_size(uint32_t *w, uint32_t *h)
+{
+        bool r;
+        MBOX_BUFF_ALLOC(msg, mbox_getfbsize_buf_t);
+        bcm2835_mbox_t *mbox;
+
+        mbox = (void *) km_map(BCM2835_MBOX0_ADDR, sizeof(bcm2835_mbox_t),
+            KM_NATURAL_ALIGNMENT, PAGE_NOT_CACHEABLE);
+        assert(mbox);
+
+        msg->buf_hdr.size = sizeof(mbox_getfbsize_buf_t);
+        msg->buf_hdr.code = MBOX_PROP_CODE_REQ;
+        msg->tag_hdr.tag_id = MBOX_TAG_GET_PHYS_W_H;
+        msg->tag_hdr.buf_size = sizeof(msg->body);
+        msg->tag_hdr.val_len  = 0;
+        msg->zero = 0;
+
+        mbox_write(mbox,
+            MBOX_CHAN_PROP_A2V, KA2VCA((uint32_t)msg));
+        mbox_read(mbox, MBOX_CHAN_PROP_A2V);
+
+        r = msg->buf_hdr.code == MBOX_PROP_CODE_RESP_OK;
+        if (r) {
+                *h = msg->body.height;
+                *w = msg->body.width;
+        }
+
+        km_unmap((uintptr_t) mbox, sizeof(bcm2835_mbox_t));
+        return r;
+}
+
 /**
  * @}