Tectu/ugfx слито с master

1 files changed, 24 insertions, 0 deletions

diff --git a/boards/base/RaspberryPi/example-FreeRTOS/Drivers/mmio.h b/boards/base/RaspberryPi/example-FreeRTOS/Drivers/mmio.h
new file mode 100644
index 00000000..89bea700
--- /dev/null
+++ b/boards/base/RaspberryPi/example-FreeRTOS/Drivers/mmio.h
@@ -0,0 +1,24 @@
+/* mmio.h - access to MMIO registers */
+ 
+#ifndef MMIO_H
+#define MMIO_H
+ 
+#include <stdint.h>
+ 
+// write to MMIO register
+static inline void mmio_write(uint32_t reg, uint32_t data) {
+    uint32_t *ptr = (uint32_t*)reg;
+    asm volatile("str %[data], [%[reg]]"
+	     : : [reg]"r"(ptr), [data]"r"(data));
+}
+ 
+// read from MMIO register
+static inline uint32_t mmio_read(uint32_t reg) {
+    uint32_t *ptr = (uint32_t*)reg;
+    uint32_t data;
+    asm volatile("ldr %[data], [%[reg]]"
+		 : [data]"=r"(data) : [reg]"r"(ptr));
+    return data;
+}
+ 
+#endif // #ifndef MMIO_H