X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=KernelLand%2FModules%2FInterfaces%2FUDI%2Fudi_lib%2Fphysio%2Fmeta_bus.c;h=c0631f21b81de027d2ff69a5d2829e1c240e14e6;hb=8d3b2c5f55f648f964afe7540a9fca97ab0b17d6;hp=e1e6a47d4de80fbbc74a36a0dc617f35acb647c4;hpb=301dc9a238658b902d9d394b6e930d1ec4832190;p=tpg%2Facess2.git

diff --git a/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/meta_bus.c b/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/meta_bus.c
index e1e6a47d..c0631f21 100644
--- a/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/meta_bus.c
+++ b/KernelLand/Modules/Interfaces/UDI/udi_lib/physio/meta_bus.c
@@ -1,10 +1,35 @@
 /**
- * \file physio/meta_bus.c
- * \author John Hodge (thePowersGang)
+ * Acess2 UDI Layer
+ * - By John Hodge (thePowersGang)
+ *
+ * udi_lib/physio/meta_bus.c
+ * - Bus Bridge Metalanguage
  */
+#define DEBUG	1
 #include <acess.h>
 #include <udi.h>
 #include <udi_physio.h>
+#include "../../udi_internal.h"
+
+// === GLOBALS ==
+udi_layout_t	cMetaLang_BusBridge_IntrAttachCbLayout[] = {
+	UDI_DL_STATUS_T,
+	UDI_DL_UBIT8_T,
+	UDI_DL_ORIGIN_T,	// TODO: handle
+	0
+};
+tUDI_MetaLang	cMetaLang_BusBridge = {
+	"udi_bridge",
+	// CB Types
+	5,
+	{
+		{0},	// 0: Empty
+		{sizeof(udi_bus_bind_cb_t), NULL},	// Defined, but is just a gcb
+		{sizeof(udi_intr_attach_cb_t), NULL},
+		{sizeof(udi_intr_detach_cb_t), NULL},
+		{sizeof(udi_intr_event_cb_t), NULL}
+	}
+};
 
 // === EXPORTS ===
 EXPORT(udi_bus_unbind_req);
@@ -12,6 +37,12 @@ EXPORT(udi_bus_unbind_ack);
 EXPORT(udi_bus_bind_req);
 EXPORT(udi_bus_bind_ack);
 
+#define PREP_OPS(type,ml,num)	const type *ops = UDI_int_ChannelPrepForCall(UDI_GCB(cb), ml, num); \
+	if(!ops) { Log_Warning("UDI", "%s on wrong channel type", __func__); return ; }
+
+#define PREP_OPS_DEVICE	const udi_bus_device_ops_t *ops = UDI_int_ChannelPrepForCall( UDI_GCB(cb), &cMetaLang_BusBridge, UDI_BUS_DEVICE_OPS_NUM ); \
+	if(!ops) { Log_Warning("UDI", "%s on wrong channel type", __func__); return ; }
+
 // === CODE ===
 void udi_bus_unbind_req(udi_bus_bind_cb_t *cb)
 {
@@ -24,7 +55,30 @@ void udi_bus_unbind_ack(udi_bus_bind_cb_t *cb)
 
 void udi_bus_bind_req(udi_bus_bind_cb_t *cb)
 {
-	UNIMPLEMENTED();
+	LOG("cb=%p{...}", cb);
+	PREP_OPS(udi_bus_bridge_ops_t, &cMetaLang_BusBridge, UDI_BUS_BRIDGE_OPS_NUM)
+	
+	UDI_int_MakeDeferredCb( UDI_GCB(cb), (udi_op_t*)ops->bus_bind_req_op );
+}
+
+struct marshalled_bus_bind_ack
+{
+	tUDI_DeferredCall	Call;
+	udi_dma_constraints_t	dma_constraints;
+	udi_ubit8_t	preferred_endianness;
+	udi_status_t	status;
+};
+
+static void _unmarshal_bus_bind_ack(tUDI_DeferredCall *Call)
+{
+	LOG("Call=%p", Call);
+	struct marshalled_bus_bind_ack *info = (void*)Call;
+	((udi_bus_bind_ack_op_t*)Call->Handler)(
+		UDI_MCB(Call->cb, udi_bus_bind_cb_t),
+		info->dma_constraints,
+		info->preferred_endianness,
+		info->status);
+	free(info);
 }
 
 void udi_bus_bind_ack(
@@ -34,5 +88,16 @@ void udi_bus_bind_ack(
 	udi_status_t	status
 	)
 {
-	UNIMPLEMENTED();
+	LOG("cb=%p{...}, dma_constraints=%p, preferred_endianness=%i,status=%i",
+		cb, dma_constraints, preferred_endianness, status);
+	PREP_OPS(udi_bus_device_ops_t, &cMetaLang_BusBridge, UDI_BUS_DEVICE_OPS_NUM)
+	
+	struct marshalled_bus_bind_ack *call = NEW(struct marshalled_bus_bind_ack,);
+	call->Call.Unmarshal = _unmarshal_bus_bind_ack;
+	call->Call.cb = UDI_GCB(cb);
+	call->Call.Handler = (udi_op_t*)ops->bus_bind_ack_op;
+	call->dma_constraints = dma_constraints;
+	call->preferred_endianness = preferred_endianness;
+	call->status = status;
+	UDI_int_AddDeferred(&call->Call);
 }