changeset 498:0be71d13b6e7

osx.c: int_osx_receive_prim() done
author Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date Tue, 01 Jul 2014 18:12:50 +0000
parents f11f7cb7c353
children 4d2c0430851a
files gsm-fw/gpf/osx/osx.c
diffstat 1 files changed, 34 insertions(+), 0 deletions(-) [+]
line wrap: on
line diff
--- a/gsm-fw/gpf/osx/osx.c	Tue Jul 01 13:21:41 2014 +0000
+++ b/gsm-fw/gpf/osx/osx.c	Tue Jul 01 18:12:50 2014 +0000
@@ -73,3 +73,37 @@
 	int_osx_send_prim(_osx_registry[queue_type].caller, prim_ptr,
 			  _osx_registry[queue_type].queue_handle);
 }
+
+xSignalHeaderRec *
+int_osx_receive_prim(int caller, int queue_handle)
+{
+	T_QMSG Message;
+	unsigned opc, len;
+	xSignalHeaderRec *message;
+	int status;
+
+	TRACE_ASSERT(queue_handle != OSX_ERROR);
+	for (;;) {
+		status = vsi_c_await(caller, queue_handle, &Message,
+					0xFFFFFFFF);
+		TRACE_ASSERT(status == VSI_OK);
+		/*
+		 * Disassembly reveals that the original code expects
+		 * the received message to be a primitive, rather than
+		 * a signal or a timeout.  If one of the latter comes
+		 * in, the original code would go haywire.  Hence the
+		 * following TRACE_ASSERT is a FreeCalypso addition.
+		 */
+		TRACE_ASSERT(Message.MsgType == MSG_PRIMITIVE);
+		message = (xSignalHeaderRec *) Message.Msg.Primitive.Prim;
+		opc = message->SignalCode & 0xFFFF;
+		if (opc == 11 && osx_config & 2)
+			len = *(unsigned *)(message + 1);
+		else
+			len = sizeof(xSignalHeaderRec);
+		message->SigP = (DummyStruct *)((char *)message + len);
+		if (opc != 0x8000)
+			return(message);
+		vsi_c_primitive(caller, message);
+	}
+}