FreeCalypso > hg > fc-selenite
diff src/gpf/frame/cust_os/osx.c @ 6:8b2a9a374324
src/gpf: addition of Magnetite src/gpf2
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 15 Jul 2018 08:15:49 +0000 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/gpf/frame/cust_os/osx.c Sun Jul 15 08:15:49 2018 +0000 @@ -0,0 +1,225 @@ +/* + * This C module is a reconstruction based on the disassembly of + * osx.obj in osx_na7_db.lib from the Leonardo package. + */ + +/* reconstructed set of included headers from COFF symtab: */ +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include "typedefs.h" +#include "vsi.h" +#include "cust_os.h" + +int osx_config = 2; +int _caller; +T_OSX_REGISTER _osx_registry[MAX_OSX_QUEUE]; + +void +int_osx_send_sig(int caller, unsigned long opc, void *signal_ptr, + int queue_handle) +{ + T_QMSG Message; + int status; + + TRACE_ASSERT(queue_handle != 0); + Message.MsgType = MSG_SIGNAL; + Message.Msg.Signal.SigOPC = opc; + Message.Msg.Signal.SigBuffer = signal_ptr; + Message.Msg.Signal.SigLen = sizeof(xSignalHeaderRec); + status = vsi_c_send(caller, queue_handle, &Message FILE_LINE_MACRO); + TRACE_ASSERT(status == VSI_OK); +} + +void +osx_send_sig(unsigned long opc, void *signal_ptr, T_ENUM_OS_QUEUE queue_type) +{ + int caller, queue_handle; + + caller = _osx_registry[queue_type].caller; + queue_handle = _osx_registry[queue_type].queue_handle; + TRACE_ASSERT(queue_handle != 0); + int_osx_send_sig(caller, opc, signal_ptr, queue_handle); +} + +void +int_osx_free_prim(int caller, xSignalHeaderRec *prim_ptr) +{ + vsi_c_free(caller, (T_VOID_STRUCT **) &prim_ptr FILE_LINE_MACRO); +} + +void +int_osx_send_prim(int caller, xSignalHeaderRec *prim_ptr, int queue_handle) +{ + T_QMSG Message; + int status; + + if (osx_config & 1 && prim_ptr->SignalCode == 0x7D) { + vsi_c_free(caller, (T_VOID_STRUCT **) &prim_ptr + FILE_LINE_MACRO); + return; + } + TRACE_ASSERT(queue_handle != 0); + Message.MsgType = MSG_PRIMITIVE; + Message.Msg.Primitive.Prim = (T_VOID_STRUCT *) prim_ptr; + Message.Msg.Primitive.PrimLen = sizeof(xSignalHeaderRec); + status = vsi_c_send(caller, queue_handle, &Message FILE_LINE_MACRO); + TRACE_ASSERT(status == VSI_OK); +} + +void +osx_send_prim(xSignalHeaderRec *prim_ptr, T_ENUM_OS_QUEUE queue_type) +{ + 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; + 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) + message->SigP = *(DummyStruct **)(message + 1); + else + message->SigP = (DummyStruct *)(message + 1); + if (opc != 0x8000) + return(message); + vsi_c_primitive(caller, message); + } +} + +xSignalHeaderRec * +osx_receive_prim(T_ENUM_OS_QUEUE queue_type) +{ + return int_osx_receive_prim(_osx_registry[queue_type].caller, + _osx_registry[queue_type].queue_handle); +} + +void +osx_free_prim(xSignalHeaderRec *prim_ptr) +{ + vsi_c_free(_caller, (T_VOID_STRUCT **) &prim_ptr FILE_LINE_MACRO); +} + +void +int_osx_free_mem(int caller, void *mem_ptr) +{ + int status; + + TRACE_ASSERT(mem_ptr != 0); + status = D_FREE(mem_ptr); + TRACE_ASSERT(status == VSI_OK); +} + +void +osx_free_mem(void *mem_ptr) +{ + int_osx_free_mem(_caller, mem_ptr); +} + +xSignalHeaderRec * +int_osx_alloc_prim(int caller, unsigned long len, int pool_group_handle) +{ + xSignalHeaderRec *prim_ptr; + + prim_ptr = (xSignalHeaderRec *) vsi_c_new(caller, + (len & 0xFFFF) + sizeof(xSignalHeaderRec), 0 + FILE_LINE_MACRO); + /* This check is a FreeCalypso addition */ + TRACE_ASSERT(prim_ptr != 0); + prim_ptr->SigP = (DummyStruct *)(prim_ptr + 1); + return(prim_ptr); +} + +xSignalHeaderRec * +osx_alloc_prim(unsigned long len) +{ + xSignalHeaderRec *prim_ptr; + + prim_ptr = (xSignalHeaderRec *) vsi_c_new(_caller, + (len & 0xFFFF) + sizeof(xSignalHeaderRec), 0 + FILE_LINE_MACRO); + /* This check is a FreeCalypso addition */ + TRACE_ASSERT(prim_ptr != 0); + prim_ptr->SigP = (DummyStruct *)(prim_ptr + 1); + return(prim_ptr); +} + +void * +int_osx_alloc_mem(int caller, unsigned long len) +{ + void *mem_ptr; + + DMALLOC(mem_ptr, len); + TRACE_ASSERT(mem_ptr != 0); + return(mem_ptr); +} + +void * +osx_alloc_mem(unsigned long len) +{ + return int_osx_alloc_mem(_caller, len); +} + +int +_osx_open(int caller, unsigned short queue_type, int queue_handle) +{ + if (!queue_type && !queue_handle) { + _caller = caller; + return(OSX_ERROR); + } + if (queue_type >= MAX_OSX_QUEUE) + return(OSX_ERROR); + if (_osx_registry[queue_type].queue_handle != queue_handle && + _osx_registry[queue_type].queue_handle != -1) + return(OSX_ERROR); + _osx_registry[queue_type].queue_handle = queue_handle; + _osx_registry[queue_type].caller = caller; + return(OSX_OK); +} + +void +_osx_init(void) +{ + USHORT i; + + for (i = 0; i < MAX_OSX_QUEUE; i++) + _osx_registry[i].queue_handle = -1; +} + +int +_osx_config(const char *config) +{ + if (!strcmp(config, L1S_TRACE_DISABLE)) { + osx_config |= 1; + return(OSX_OK); + } + if (!strcmp(config, L1S_TRACE_ENABLE)) { + osx_config &= ~1; + return(OSX_OK); + } + if (!strcmp(config, NO_SPECIAL_MPHC_RXLEV_REQ)) { + osx_config &= ~2; + return(OSX_OK); + } + return(OSX_ERROR); +}