From ab9ce99647965d0d3e9ea65ea92ad694c8b8ee1b Mon Sep 17 00:00:00 2001
From: inmarket <andrewh@inmarket.com.au>
Date: Wed, 9 Jul 2014 15:40:03 +1000
Subject: Support added for the Raspberry Pi - talking directly to the graphics
 co-processor.

---
 boards/base/RaspberryPi/rpi_mailbox.c | 47 +++++++++++++++++++++++++++++++++++
 1 file changed, 47 insertions(+)
 create mode 100644 boards/base/RaspberryPi/rpi_mailbox.c

(limited to 'boards/base/RaspberryPi/rpi_mailbox.c')

diff --git a/boards/base/RaspberryPi/rpi_mailbox.c b/boards/base/RaspberryPi/rpi_mailbox.c
new file mode 100644
index 00000000..798cbb1f
--- /dev/null
+++ b/boards/base/RaspberryPi/rpi_mailbox.c
@@ -0,0 +1,47 @@
+/*
+ * Access system mailboxes
+ */
+#include "rpi_mailbox.h"
+
+/* Mailbox memory addresses */
+static volatile unsigned int *MAILBOX0READ = (unsigned int *) (0x2000b880);
+static volatile unsigned int *MAILBOX0STATUS = (unsigned int *) (0x2000b898);
+static volatile unsigned int *MAILBOX0WRITE = (unsigned int *) (0x2000b8a0);
+
+/* Bit 31 set in status register if the write mailbox is full */
+#define MAILBOX_FULL 0x80000000
+
+/* Bit 30 set in status register if the read mailbox is empty */
+#define MAILBOX_EMPTY 0x40000000
+
+unsigned int rpi_readmailbox(unsigned int channel)
+{
+	unsigned int val;
+
+	if (channel > 15)
+		return 0xFFFFFFFF;
+
+	/* Wait for mailbox to be full */
+	while (*MAILBOX0STATUS & MAILBOX_EMPTY);
+
+	val = *MAILBOX0READ;
+
+	if ((val & 15) == channel)
+		return (val & 0xFFFFFFF0);
+	else
+		return 0xFFFFFFFF;
+}
+
+void rpi_writemailbox(unsigned int channel, unsigned int data)
+{
+	if (channel > 15)
+		return;
+
+	if (data & 0x000F)
+		return;
+
+	/* Wait for mailbox to be not full */
+	while (*MAILBOX0STATUS & MAILBOX_FULL);
+
+	*MAILBOX0WRITE = (data | channel);
+}
-- 
cgit v1.2.3