From a008b10d8488ef905a43de00ee5c8efd03b03ed6 Mon Sep 17 00:00:00 2001
From: "Suren A. Chilingaryan" <csa@dside.dyndns.org>
Date: Wed, 9 Mar 2011 16:55:27 +0100
Subject: Support for FPGA registers

---
 default.c | 39 +++++++++++++++++++++++++++++++++++++++
 1 file changed, 39 insertions(+)
 create mode 100644 default.c

(limited to 'default.c')

diff --git a/default.c b/default.c
new file mode 100644
index 0000000..d03858f
--- /dev/null
+++ b/default.c
@@ -0,0 +1,39 @@
+#include <sys/time.h>
+#include <arpa/inet.h>
+#include <assert.h>
+
+#include "tools.h"
+#include "default.h"
+#include "error.h"
+
+#define BIT_MASK(bits) ((1l << (bits)) - 1)
+
+#define default_datacpy(dst, src, access, bank)   pcilib_datacpy(dst, src, access, 1, bank->raw_endianess)
+
+int pcilib_default_read(pcilib_t *ctx, pcilib_register_bank_description_t *bank, pcilib_register_addr_t addr, uint8_t bits, pcilib_register_value_t *value) {
+    int err;
+    
+    char *ptr;
+    pcilib_register_value_t val = 0;
+    int access = bank->access / 8;
+
+    ptr =  pcilib_resolve_register_address(ctx, bank->read_addr + addr * access);
+    default_datacpy(&val, ptr, access, bank);
+    
+    *value = val&BIT_MASK(bits);
+
+    return 0;
+}
+
+
+int pcilib_default_write(pcilib_t *ctx, pcilib_register_bank_description_t *bank, pcilib_register_addr_t addr, uint8_t bits, pcilib_register_value_t value) {
+    int err;
+    
+    char *ptr;
+    int access = bank->access / 8;
+
+    ptr =  pcilib_resolve_register_address(ctx, bank->write_addr + addr * access);
+    default_datacpy(ptr, &value, access, bank);
+
+    return 0;
+}
-- 
cgit v1.2.3