1 files changed, 103 insertions, 2 deletions

diff --git a/src/common.h b/src/common.h
index a6af346..0bd365a 100644
--- a/src/common.h
+++ b/src/common.h
@@ -60,11 +60,9 @@ static inline void
 gpio_pin_set_func(u8 pin, GpioFunc func) {
     u8 start = (pin * 3) % 30;
     u8 reg = pin / 10;
-
     u32 selector = GPIO->func_select[reg];
     selector &= ~(7 << start);
     selector |= (func << start);
-
     GPIO->func_select[reg] = selector;
 }
 
@@ -144,4 +142,107 @@ uart_puts(char *s) {
     }
 }
 
+static inline void
+uart_hex(unsigned int d) {
+    unsigned int n;
+    uart_puts("0x");
+    for(int c = 28; c >= 0; c -= 4) {
+        n = (d>>c) & 0xF;
+        n += n> 9 ? 0x37 : 0x30;
+        uart_putc(n);
+    }
+}
+
+//
+// VideoCore Mailboxes.
+//
+
+typedef struct MboxTagHeader {
+    u32 id;
+    u32 buf_size;
+    u32 code;
+} MboxTagHeader;
+
+typedef struct MboxScreenTag {
+    MboxTagHeader header;
+    u32 width;
+    u32 height;
+} MboxScreenTag;
+
+typedef struct MboxDepthTag {
+    MboxTagHeader header;
+    u32 depth;
+} MboxDepthTag;
+
+typedef struct MboxFramebufferTag {
+    MboxTagHeader header;
+    u32 fb_addr;
+    u32 fb_size;
+} MboxFramebufferTag;
+
+typedef struct MboxFramebufferRequest {
+    u32 buf_size;
+    u32 code;
+    MboxScreenTag screen_tag;
+    MboxScreenTag virtual_screen_tag;
+    MboxDepthTag depth_tag;
+    MboxFramebufferTag framebuffer_tag;
+    u32 end_tag;
+    u8 padding[8];
+} MboxFramebufferRequest;
+
+typedef struct MailboxRegs {
+    vu32 read;
+    vu32 reserved[5];
+    vu32 status;
+    vu32 config;
+    vu32 write;
+} MailboxRegs;
+
+#define MBOX ((MailboxRegs *)(MEM_BASE + 0x0000B880))
+
+typedef enum MboxChannels {
+    MBOX_CH_POWER = 0,
+    MBOX_CH_FB    = 1,
+    MBOX_CH_VUART = 2,
+    MBOX_CH_VCHIQ = 3,
+    MBOX_CH_LEDS  = 4,
+    MBOX_CH_BTNS  = 5,
+    MBOX_CH_TOUCH = 6,
+    MBOX_CH_COUNT = 7,
+    MBOX_CH_PROP  = 8,
+} MboxChannels;
+
+// Property channel response type.
+#define MBOX_REQUEST      0
+#define MBOX_RESPONSE_OK  0x80000000
+#define MBOX_RESPONSE_ERR 0x80000001
+
+// Mailbox status codes.
+#define MBOX_FULL  0x80000000
+#define MBOX_EMPTY 0x40000000
+
+static inline void
+mb_write(u8 channel, void *data) {
+    while(MBOX->status & MBOX_FULL);
+    MBOX->write = ((uintptr_t)data & ~0xF) | (channel & 0xF);
+}
+
+static inline u32
+mb_read(u8 channel) {
+    while(true) {
+        while(MBOX->status & MBOX_EMPTY);
+        u32 data = MBOX->read;
+        if ((u8)(data & 0xF) == channel) {
+            return data & 0xFFFFFFF0;
+        }
+    }
+}
+
+static inline int
+mb_call(unsigned char ch, void *msg) {
+    mb_write(ch, msg);
+    return mb_read(ch);
+}
+
 #endif // COMMON_RPIBM_H