Integration of software registers

10 files changed, 198 insertions, 6 deletions

diff --git a/dma/ipe.h b/dma/ipe.h
index 44fbc99..5640606 100644
--- a/dma/ipe.h
+++ b/dma/ipe.h
@@ -39,6 +39,7 @@ static const pcilib_dma_engine_description_t ipe_dma_engines[] = {
 
 static const pcilib_register_bank_description_t ipe_dma_banks[] = {
     { PCILIB_REGISTER_BANK_DMA, PCILIB_REGISTER_PROTOCOL_DEFAULT, PCILIB_BAR0, 0, 0, 32, 0x0200, PCILIB_LITTLE_ENDIAN, PCILIB_LITTLE_ENDIAN, "0x%lx", "dma", "DMA Registers"},
+    { PCILIB_REGISTER_BANK_DMACONF, PCILIB_REGISTER_PROTOCOL_SOFTWARE, PCILIB_BAR_NOBAR, 0, 0, 32, 0x1000, PCILIB_HOST_ENDIAN, PCILIB_HOST_ENDIAN, "0x%lx", "dmaconf", "DMA Software Registers"},
     { 0, 0, 0, 0, 0, 0, 0, 0, 0, NULL, NULL, NULL }
 };
 
@@ -77,6 +78,7 @@ static const pcilib_register_description_t ipe_dma_registers[] = {
     {0x0058, 	0, 	32, 	0, 	0x00000000,	PCILIB_REGISTER_RW  , PCILIB_REGISTER_STANDARD, PCILIB_REGISTER_BANK_DMA, "last_descriptor_read",	"Last descriptor read by the host"},
     {0x005C, 	0, 	32, 	0, 	0x00000000,	PCILIB_REGISTER_RW  , PCILIB_REGISTER_STANDARD, PCILIB_REGISTER_BANK_DMA, "desc_mem_addr", 		"Number of descriptors configured"},
     {0x0060, 	0, 	32, 	0, 	0x00000000,	PCILIB_REGISTER_RW  , PCILIB_REGISTER_STANDARD, PCILIB_REGISTER_BANK_DMA, "update_thresh",  		"Update threshold of progress register"},
+    {0x0000, 	0, 	32, 	PCILIB_VERSION, 	0x00000000,	PCILIB_REGISTER_R   , PCILIB_REGISTER_STANDARD, PCILIB_REGISTER_BANK_DMACONF, "dma_version",  		"Version of DMA engine"},
     {0,		0,	0,	0,	0x00000000,	0,                                           0,                        0, NULL, 			NULL}
 };
 #endif /* _PCILIB_EXPORT_C */
diff --git a/pcilib/bank.c b/pcilib/bank.c
index dbbb427..3d53db2 100644
--- a/pcilib/bank.c
+++ b/pcilib/bank.c
@@ -65,7 +65,7 @@ void pcilib_free_register_banks(pcilib_t *ctx) {
 	
 	if (ctx->bank_ctx[i]) {
 	    if (bapi->free)
-		bapi->free(ctx->bank_ctx[i]);
+		bapi->free(ctx, ctx->bank_ctx[i]);
 	    else
 		free(ctx->bank_ctx[i]);
 		
diff --git a/pcilib/bank.h b/pcilib/bank.h
index 943c389..8b461af 100644
--- a/pcilib/bank.h
+++ b/pcilib/bank.h
@@ -9,10 +9,12 @@
 #define PCILIB_REGISTER_BANK2 			2
 #define PCILIB_REGISTER_BANK3 			3
 #define PCILIB_REGISTER_BANK_DMA		64					/**< First BANK address to be used by DMA engines */
+#define PCILIB_REGISTER_BANK_DMACONF		65					/**< DMA configuration in the software registers */
 #define PCILIB_REGISTER_BANK_DYNAMIC		128					/**< First BANK address to map dynamic XML configuration */
 #define PCILIB_REGISTER_PROTOCOL_INVALID	((pcilib_register_protocol_t)-1)
 #define PCILIB_REGISTER_PROTOCOL0		0					/**< First PROTOCOL address to be used in the event engine */
 #define PCILIB_REGISTER_PROTOCOL_DEFAULT	64					/**< Default memmap based protocol */
+#define PCILIB_REGISTER_PROTOCOL_SOFTWARE	65					/**< Software registers */
 #define PCILIB_REGISTER_PROTOCOL_DMA		96					/**< First PROTOCOL address to be used by DMA engines */
 #define PCILIB_REGISTER_PROTOCOL_DYNAMIC	128					/**< First PROTOCOL address to be used by plugins */
 
@@ -28,7 +30,7 @@ typedef struct {
     pcilib_version_t version;
 
     pcilib_register_bank_context_t *(*init)(pcilib_t *ctx, pcilib_register_bank_t bank, const char *model, const void *args);			/**< Optional API call to initialize bank context */
-    void (*free)(pcilib_register_bank_context_t *ctx);												/**< Optional API call to cleanup bank context */
+    void (*free)(pcilib_t *pcilib, pcilib_register_bank_context_t *ctx);									/**< Optional API call to cleanup bank context */
     int (*read)(pcilib_t *pcilib, pcilib_register_bank_context_t *ctx, pcilib_register_addr_t addr, pcilib_register_value_t *value);		/**< Read from register, mandatory for RO/RW registers */
     int (*write)(pcilib_t *pcilib, pcilib_register_bank_context_t *ctx, pcilib_register_addr_t addr, pcilib_register_value_t value);		/**< Write to register, mandatory for WO/RW registers */
 } pcilib_register_protocol_api_description_t;
@@ -84,7 +86,6 @@ struct pcilib_register_bank_context_s {
     const pcilib_register_protocol_api_description_t *api;			/**< API functions */
 };
 
-
     // we don't copy strings, they should be statically allocated
 int pcilib_init_register_banks(pcilib_t *ctx);
 void pcilib_free_register_banks(pcilib_t *ctx);
diff --git a/pcilib/bar.c b/pcilib/bar.c
index a2670c0..ce04f6d 100644
--- a/pcilib/bar.c
+++ b/pcilib/bar.c
@@ -131,6 +131,9 @@ int pcilib_map_register_space(pcilib_t *ctx) {
 //	    uint32_t buf[2];
 	    void *reg_space;
             pcilib_bar_t bar = banks[i].bar;
+            
+            if (bar == PCILIB_BAR_NOBAR)
+        	continue;
 
 	    if (bar == PCILIB_BAR_DETECT) {
 		uintptr_t addr = banks[0].read_addr;
diff --git a/pcilib/export.c b/pcilib/export.c
index e442fc7..7b78e32 100644
--- a/pcilib/export.c
+++ b/pcilib/export.c
@@ -5,10 +5,11 @@
 #include "export.h"
 
 #include "protocols/default.h"
-
+#include "protocols/software.h"
 
 const pcilib_register_protocol_description_t pcilib_protocols[] = {
     { PCILIB_REGISTER_PROTOCOL_DEFAULT, &pcilib_default_protocol_api, NULL, NULL, "default", "" },
+    { PCILIB_REGISTER_PROTOCOL_SOFTWARE, &pcilib_register_software_protocol_api, NULL, NULL, "software_registers", "" },
     { 0 }
 };
 
diff --git a/pcilib/kmem.h b/pcilib/kmem.h
index 8302b6a..ae690fe 100644
--- a/pcilib/kmem.h
+++ b/pcilib/kmem.h
@@ -4,6 +4,8 @@
 typedef struct pcilib_s pcilib_t;
 typedef struct pcilib_kmem_list_s pcilib_kmem_list_t;
 
+#define PCILIB_KMEM_PAGE_SIZE	0x1000
+
 typedef enum {
     PCILIB_TRISTATE_NO = 0,
     PCILIB_TRISTATE_PARTIAL = 1,
@@ -27,6 +29,7 @@ typedef enum {
     PCILIB_KMEM_USE_STANDARD = 0,
     PCILIB_KMEM_USE_DMA_RING = 1,
     PCILIB_KMEM_USE_DMA_PAGES = 2,
+    PCILIB_KMEM_USE_SOFTWARE_REGISTERS = 3,
     PCILIB_KMEM_USE_USER = 0x10
 } pcilib_kmem_use_t;
 
diff --git a/pcilib/pcilib.h b/pcilib/pcilib.h
index 6d241c6..9710642 100644
--- a/pcilib/pcilib.h
+++ b/pcilib/pcilib.h
@@ -85,6 +85,7 @@ typedef struct {
 
 #define PCILIB_BAR_DETECT 		((pcilib_bar_t)-1)
 #define PCILIB_BAR_INVALID		((pcilib_bar_t)-1)
+#define PCILIB_BAR_NOBAR		((pcilib_bar_t)-2)
 #define PCILIB_BAR0			0
 #define PCILIB_BAR1			1
 #define PCILIB_DMA_ENGINE_INVALID	((pcilib_dma_engine_t)-1)
diff --git a/protocols/CMakeLists.txt b/protocols/CMakeLists.txt
index 3c1d75b..2c482f6 100644
--- a/protocols/CMakeLists.txt
+++ b/protocols/CMakeLists.txt
@@ -3,6 +3,6 @@ include_directories(
     ${CMAKE_SOURCE_DIR}/pcilib
 )
 
-set(HEADERS ${HEADERS} default.h)
+set(HEADERS ${HEADERS} default.h software.h)
 
-add_library(protocols STATIC default.c)
+add_library(protocols STATIC default.c software.c)
diff --git a/protocols/software.c b/protocols/software.c
new file mode 100644
index 0000000..5534dc7
--- /dev/null
+++ b/protocols/software.c
@@ -0,0 +1,122 @@
+#include <stdio.h>
+#include <unistd.h>
+#include <stdlib.h>
+#include <string.h>
+#include <sys/file.h>
+
+#include "model.h"
+#include "error.h"
+#include "kmem.h"
+#include "pcilib.h"
+#include "pci.h"
+
+typedef struct pcilib_software_register_bank_context_s pcilib_software_register_bank_context_t;
+
+struct pcilib_software_register_bank_context_s {
+    pcilib_register_bank_context_t bank_ctx;
+
+    pcilib_kmem_handle_t *kmem;
+    void *addr;
+};
+
+/**
+ * pcilib_software_registers_close
+ * this function clear the kernel memory space that could have been allocated for software registers
+ * @param[in] bank_ctx the bank context running that we get from the initialisation function
+ */	
+void pcilib_software_registers_close(pcilib_t *ctx, pcilib_register_bank_context_t *bank_ctx) {
+	if (((pcilib_software_register_bank_context_t*)bank_ctx)->kmem)
+	    pcilib_free_kernel_memory(ctx, ((pcilib_software_register_bank_context_t*)bank_ctx)->kmem, PCILIB_KMEM_FLAG_REUSE);
+	free(bank_ctx);
+}
+
+/**
+ * pcilib_software_registers_open
+ * this function initializes the kernel space memory and stores in it the default values of the registers of the given bank index, if it was not initialized by a concurrent process, and return a bank context containing the adress of this kernel space. It the kernel space memory was already initialized by a concurrent process, then this function just return the bank context with the adress of this kernel space already used
+ * @param[in] ctx the pcilib_t structure running
+ * @param[in] bank the bank index that will permits to get the bank we want registers from
+ * @param[in] model not used
+ * @param[in] args not used
+ * @return a bank context with the adress of the kernel space memory related to it
+ */
+pcilib_register_bank_context_t* pcilib_software_registers_open(pcilib_t *ctx, pcilib_register_bank_t bank, const char* model, const void *args) {
+	pcilib_software_register_bank_context_t *bank_ctx;
+	pcilib_kmem_handle_t *handle;
+	pcilib_kmem_reuse_state_t reused;
+
+	const pcilib_register_bank_description_t *bank_desc = ctx->banks + bank;
+	
+	if (bank_desc->size > PCILIB_KMEM_PAGE_SIZE) {
+	    pcilib_error("Currently software register banks are limited to %lu bytes, but %lu requested", PCILIB_KMEM_PAGE_SIZE, bank_desc->size);
+	    return NULL;
+	}
+
+	bank_ctx = calloc(1, sizeof(pcilib_software_register_bank_context_t));
+
+	handle = pcilib_alloc_kernel_memory(ctx, PCILIB_KMEM_TYPE_PAGE, 1, PCILIB_KMEM_PAGE_SIZE, 0, PCILIB_KMEM_USE(PCILIB_KMEM_USE_SOFTWARE_REGISTERS, bank), PCILIB_KMEM_FLAG_REUSE|PCILIB_KMEM_FLAG_PERSISTENT);
+	if (!handle) {
+	    pcilib_error("Allocation of kernel memory for software registers has failed");
+	    pcilib_software_registers_close(ctx, (pcilib_register_bank_context_t*)bank_ctx);
+	    return NULL;
+	}
+	
+	bank_ctx->kmem = handle;
+	bank_ctx->addr = pcilib_kmem_get_block_ua(ctx, handle, 0);
+	reused = pcilib_kmem_is_reused(ctx, handle);
+
+	if ((reused & PCILIB_KMEM_REUSE_REUSED) == 0) {
+	    pcilib_register_t i;
+
+	    if (reused & PCILIB_KMEM_REUSE_PARTIAL) {
+		pcilib_error("Inconsistent software registers are found (only part of required buffers is available)");
+		pcilib_software_registers_close(ctx, (pcilib_register_bank_context_t*)bank_ctx);
+		return NULL;
+	    }
+		
+	    for (i = 0; ctx->model_info.registers[i].name != NULL; i++) {
+		if ((ctx->model_info.registers[i].bank == ctx->banks[bank].addr)&&(ctx->model_info.registers[i].type == PCILIB_REGISTER_STANDARD)) {
+		    *(pcilib_register_value_t*)(bank_ctx->addr + ctx->model_info.registers[i].addr) = ctx->model_info.registers[i].defvalue;
+		}
+	    }
+	}
+
+	return (pcilib_register_bank_context_t*)bank_ctx;
+}
+
+/**
+ * pcilib_software_registers_read
+ * this function read the value of a said register in the kernel space
+ * @param[in] ctx the pcilib_t structure runnning
+ * @param[in] bank_ctx the bank context that was returned by the initialisation function
+ * @param[in] addr the adress of the register we want to read
+ * @param[out] value the value of the register
+ * @return 0 in case of success
+ */
+int pcilib_software_registers_read(pcilib_t *ctx, pcilib_register_bank_context_t *bank_ctx, pcilib_register_addr_t addr, pcilib_register_value_t *value){
+	if ((addr + sizeof(pcilib_register_value_t)) > bank_ctx->bank->size) {
+	    pcilib_error("Trying to access space outside of the define register bank (bank: %s, addr: 0x%lx)", bank_ctx->bank->name, addr);
+	    return PCILIB_ERROR_INVALID_ADDRESS;
+	}
+	
+	*value = *(pcilib_register_value_t*)(((pcilib_software_register_bank_context_t*)bank_ctx)->addr + addr);
+	return 0;
+}
+
+/**
+ * pcilib_software_registers_write
+ * this function write the said value to a said register in the kernel space
+ * @param[in] ctx the pcilib_t structure runnning
+ * @param[in] bank_ctx the bank context that was returned by the initialisation function
+ * @param[in] addr the adress of the register we want to write in
+ * @param[out] value the value we want to write in the register
+ * @return 0 in case of success
+ */
+int pcilib_software_registers_write(pcilib_t *ctx, pcilib_register_bank_context_t *bank_ctx, pcilib_register_addr_t addr, pcilib_register_value_t value){
+	if ((addr + sizeof(pcilib_register_value_t)) > bank_ctx->bank->size) {
+	    pcilib_error("Trying to access space outside of the define register bank (bank: %s, addr: 0x%lx)", bank_ctx->bank->name, addr);
+	    return PCILIB_ERROR_INVALID_ADDRESS;
+	}
+	
+	*(pcilib_register_value_t*)(((pcilib_software_register_bank_context_t*)bank_ctx)->addr + addr) = value;
+	return 0;
+}
diff --git a/protocols/software.h b/protocols/software.h
new file mode 100644
index 0000000..d066cd6
--- /dev/null
+++ b/protocols/software.h
@@ -0,0 +1,59 @@
+/**
+ * @file software.h
+ * @skip author nicolas zilio, nicolas.zilio@hotmail.fr
+ * @brief header file for implementation of the protocol with software registers allocated in the main memory.
+ */
+
+#ifndef _PCILIB_SOFTWARE_H
+#define _PCILIB_SOFTWARE_H
+
+#include "pcilib.h"
+#include "version.h"
+#include "model.h"
+
+/**
+ * this function initialize the kernel space memory for the use of software register. it initializes the kernel space memory and stores in it the default values of the registers of the given bank index, if it was not initialized by a concurrent process, and return a bank context containing the adress of this kernel space. If the kernel space memory was already initialized by a concurrent process, then this function just return the bank context with the adress of this kernel space already used
+ * @param[in] ctx the pcilib_t structure running
+ * @param[in] bank the bank index that will permits to get the bank we want registers from
+ * @param[in] model not used
+ * @param[in] args not used
+ * @return a bank context with the adress of the kernel space memory related to it
+ */
+pcilib_register_bank_context_t* pcilib_software_registers_open(pcilib_t *ctx, pcilib_register_bank_t bank, const char* model, const void *args);
+
+/**
+ * this function clear the kernel memory space that could have been allocated for software registers.
+ * @param[in] ctx the pcilib_t structure runnning
+ * @param[in] bank_ctx the bank context running that we get from the initialisation function
+ */
+void pcilib_software_registers_close(pcilib_t *ctx, pcilib_register_bank_context_t *bank_ctx);
+
+/**
+ * this function read the value of a said register in the kernel space.
+ * @param[in] ctx the pcilib_t structure runnning
+ * @param[in] bank_ctx the bank context that was returned by the initialisation function
+ * @param[in] addr the adress of the register we want to read
+ * @param[out] value the value of the register
+ * @return 0 in case of success
+ */
+int  pcilib_software_registers_read(pcilib_t *ctx, pcilib_register_bank_context_t* bank_ctx, pcilib_register_addr_t addr, pcilib_register_value_t *value);
+
+/**
+ * this function write the said value to a said register in the kernel space
+ * @param[in] ctx the pcilib_t structure runnning
+ * @param[in] bank_ctx the bank context that was returned by the initialisation function
+ * @param[in] addr the adress of the register we want to write in
+ * @param[out] value the value we want to write in the register
+ * @return 0 in case of success
+ */
+int pcilib_software_registers_write(pcilib_t *ctx,pcilib_register_bank_context_t* bank_ctx, pcilib_register_addr_t addr, pcilib_register_value_t value);
+
+#ifdef _PCILIB_EXPORT_C
+/**
+ * new protocol addition to the protocol api.
+ */
+const pcilib_register_protocol_api_description_t pcilib_register_software_protocol_api =
+  { PCILIB_VERSION, pcilib_software_registers_open, pcilib_software_registers_close,pcilib_software_registers_read, pcilib_software_registers_write }; /**< we add there the protocol to the list of possible protocols*/
+#endif /* _PCILIB_EXPORT_C */
+
+#endif /* _PCILIB_SOFTWARE_H */