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

diff --git a/KernelLand/Modules/Interfaces/UDI/udi_lib/physio.c b/KernelLand/Modules/Interfaces/UDI/udi_lib/physio.c
index 5d136a14..ed47c157 100644
--- a/KernelLand/Modules/Interfaces/UDI/udi_lib/physio.c
+++ b/KernelLand/Modules/Interfaces/UDI/udi_lib/physio.c
@@ -5,6 +5,15 @@
 #include <acess.h>
 #include <udi.h>
 #include <udi_physio.h>
+#include "../udi_internal.h"
+//#include <udi_internal/physio.h>
+
+struct udi_dma_constraints_s
+{
+	udi_ubit16_t	size;
+	udi_ubit16_t	n_attrs;
+	udi_dma_constraints_attr_spec_t	attrs[];
+};
 
 // === EXPORTS ===
 EXPORT(udi_dma_constraints_attr_set);
@@ -17,7 +26,79 @@ void udi_dma_constraints_attr_set(udi_dma_constraints_attr_set_call_t *callback,
 	const udi_dma_constraints_attr_spec_t *attr_list, udi_ubit16_t list_length,
 	udi_ubit8_t flags)
 {
-	UNIMPLEMENTED();
+	udi_dma_constraints_t	ret;
+	if( !src_constraints )
+	{
+		// Allocate new
+		ret = NEW_wA(struct udi_dma_constraints_s, attrs, list_length);
+		if(!ret)	goto alloc_error;
+		ret->size = list_length;
+		ret->n_attrs = 0;
+	}
+	else
+	{
+		udi_ubit8_t	bm[256/8] = {0};
+		// Calculate new size
+		for( int i = 0; i < src_constraints->n_attrs; i ++ ) {
+			int idx = src_constraints->attrs[i].attr_type;
+			bm[idx/8] |= 1 << (idx%8);
+		}
+		udi_ubit16_t	count = src_constraints->n_attrs;
+		for( int i = 0; i < list_length; i ++ ) {
+			int idx = attr_list[i].attr_type;
+			if(bm[idx/8] & 1 << (idx%8))
+				;
+			else {
+				count ++;
+				bm[idx/8] |= 1 << (idx%8);
+			}
+		}
+		
+		if( flags & UDI_DMA_CONSTRAINTS_COPY )
+		{
+			// Duplicate
+			ret = NEW_wA(struct udi_dma_constraints_s, attrs, count);
+			if(!ret)	goto alloc_error;
+			ret->size = count;
+			ret->n_attrs = src_constraints->n_attrs;
+			memcpy(ret->attrs, src_constraints->attrs,
+				src_constraints->n_attrs*sizeof(ret->attrs[0]));
+		}
+		else
+		{
+			// Expand
+			ret = realloc(src_constraints, sizeof(*ret)
+				+ count*sizeof(ret->attrs[0]));
+			if(!ret)	goto alloc_error;
+			ret->size = count;
+		}
+	}
+	
+	// Begin populating
+	for( int i = 0; i < list_length; i ++ )
+	{
+		 int	j;
+		for( j = 0; j < ret->n_attrs; j ++ )
+		{
+			if( ret->attrs[j].attr_type == attr_list[i].attr_type ) {
+				ret->attrs[j].attr_value = attr_list[i].attr_value;
+				break;
+			}
+		}
+		if( j == ret->n_attrs )
+		{
+			ASSERTC(ret->n_attrs, !=, ret->size);
+			ret->attrs[j].attr_type = attr_list[i].attr_type;
+			ret->attrs[j].attr_value = attr_list[i].attr_value;
+			ret->n_attrs ++;
+		}
+		
+	}
+	
+	callback(gcb, ret, UDI_OK);
+	return ;
+alloc_error:
+	callback(gcb, NULL, UDI_STAT_RESOURCE_UNAVAIL);
 }
 
 void udi_dma_constraints_attr_reset(
@@ -30,5 +111,5 @@ void udi_dma_constraints_attr_reset(
 
 void udi_dma_constraints_free(udi_dma_constraints_t constraints)
 {
-	UNIMPLEMENTED();
+	free(constraints);
 }