userspace/libswitchhw: uploaded missing fpga_io.c (with O_SYNC mmap bugfix)

5715d9cc · Tomasz Wlostowski · 0fbbbcdd · 5715d9cc
Commit 5715d9cc authored Mar 07, 2012 by Tomasz Wlostowski
Hide whitespace changes
Inline Side-by-side

Showing with 44 additions and 0 deletions

fpga_io.c userspace/libswitchhw/fpga_io.c +44 -0

No files found.
--- a/userspace/libswitchhw/fpga_io.c
+++ b/userspace/libswitchhw/fpga_io.c
+/* Userspace /dev/mem I/O functions for accessing the Main FPGA */
+
+#include <stdio.h>
+#include <unistd.h>
+
+#include <unistd.h>
+#include <sys/mman.h>
+#include <inttypes.h>
+#include <fcntl.h>
+#include <poll.h>
+
+#include <hw/switch_hw.h>
+
+#define SMC_CS0_BASE 0x10000000
+#define SMC_CS0_SIZE 0x200000
+
+#define SPI_CLKDIV_VAL 20 // clock divider for CMI SPI bus clock
+
+/* Virtual base address of the Main FPGA address space. */
+volatile uint8_t *_fpga_base_virt;
+
+/* Initializes the mapping of the Main FPGA to the CPU address space. */
+int shw_fpga_mmap_init()
+{
+  int fd;
+
+    TRACE(TRACE_INFO, "Initializing FPGA memory mapping.");
+
+    fd = open("/dev/mem", O_RDWR | O_SYNC);
+  if(!fd) return -1;
+  _fpga_base_virt = mmap(NULL, SMC_CS0_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, SMC_CS0_BASE);
+
+  if(_fpga_base_virt == NULL)
+  {
+    perror("mmap()");
+    close(fd);
+    return -1;
+  }
+
+    TRACE(TRACE_INFO, "FPGA virtual base = 0x%08x", _fpga_base_virt);
+
+    return 0;
+
+}