X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=KernelLand%2FModules%2FInterfaces%2FUDI%2Fudi_lib%2Fphysio%2Fpio.c;fp=KernelLand%2FModules%2FInterfaces%2FUDI%2Fudi_lib%2Fphysio%2Fpio.c;h=2fa39eeab7bd0c513aa69dbe73a23ef6a36d1e42;hb=8d3b2c5f55f648f964afe7540a9fca97ab0b17d6;hp=b70861bd09973fa59bc0e308e8e167697a6b8777;hpb=9567f04210ad92b4d991c137527fa5253c968aad;p=tpg%2Facess2.git

diff --git a/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/pio.c b/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/pio.c
index b70861bd..2fa39eea 100644
--- a/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/pio.c
+++ b/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/pio.c
@@ -1,10 +1,38 @@
 /**
- * \file physio/pio.c
+ * \file udi_lib/physio/pio.c
  * \author John Hodge (thePowersGang)
  */
+#define DEBUG	1
 #include <acess.h>
 #include <udi.h>
 #include <udi_physio.h>
+#include "../../udi_internal.h"
+
+typedef void	_udi_pio_do_io_op_t(uint32_t child_ID, udi_ubit32_t regset_idx, udi_ubit32_t ofs, size_t len,
+	void *data, bool isOutput);
+
+// === STRUCTURES ===
+struct udi_pio_handle_s
+{
+	tUDI_DriverInstance	*Inst;
+	udi_index_t	RegionIdx;
+	
+	_udi_pio_do_io_op_t	*IOFunc;
+	udi_ubit32_t	Offset;
+	udi_ubit32_t	Length;
+	
+	size_t	nTransOps;
+	udi_pio_trans_t	*TransOps;
+	
+	udi_ubit16_t	PIOAttributes;
+	udi_ubit32_t	Pace;
+	udi_index_t	Domain;
+
+	// TODO: Cached labels
+};
+
+// === IMPORTS ===
+extern _udi_pio_do_io_op_t	pci_pio_do_io;
 
 // === EXPORTS ===
 EXPORT(udi_pio_map);
@@ -20,22 +48,43 @@ void udi_pio_map(udi_pio_map_call_t *callback, udi_cb_t *gcb,
 	udi_pio_trans_t *trans_list, udi_ubit16_t list_length,
 	udi_ubit16_t pio_attributes, udi_ubit32_t pace, udi_index_t serialization_domain)
 {
+	LOG("gcb=%p,regset_idx=%i,base_offset=0x%x,length=0x%x,trans_list=%p,list_length=%i,...",
+		gcb, regset_idx, base_offset, length, trans_list, list_length);
 	char bus_type[16];
 	udi_instance_attr_type_t	type;
 	type = udi_instance_attr_get_internal(gcb, "bus_type", 0, bus_type, sizeof(bus_type), NULL);
 	if(type != UDI_ATTR_STRING) {
+		Log_Warning("UDI", "No/invalid bus_type attribute");
 		callback(gcb, UDI_NULL_PIO_HANDLE);
 		return ;
 	}
-	
+
+
+	_udi_pio_do_io_op_t	*io_op;
 	if( strcmp(bus_type, "pci") == 0 ) {
 		// Ask PCI binding
+		io_op = pci_pio_do_io;
 	}
 	else {
 		// Oops, unknown
 		callback(gcb, UDI_NULL_PIO_HANDLE);
 		return ;
 	}
+
+	udi_pio_handle_t ret = malloc( sizeof(struct udi_pio_handle_s) );
+	ret->Inst = UDI_int_ChannelGetInstance(gcb, false, &ret->RegionIdx);
+	ret->IOFunc = io_op;
+	ret->Offset = base_offset;
+	ret->Length = length;
+	ret->TransOps = trans_list;
+	// TODO: Pre-scan to get labels
+	ret->nTransOps = list_length;
+	ret->PIOAttributes = pio_attributes;
+	ret->Pace = pace;
+	// TODO: Validate serialization_domain
+	ret->Domain = serialization_domain;
+	
+	callback(gcb, ret);
 }
 
 void udi_pio_unmap(udi_pio_handle_t pio_handle)