| |
| |
| |
| |
| |
| |
| #include <psxtypes/psxtypes.h> |
| #include <ntapi/nt_file.h> |
| #include <ntapi/nt_string.h> |
| #include <ntapi/nt_atomic.h> |
| #include <ntapi/nt_port.h> |
| #include <ntapi/nt_ipc.h> |
| #include <ntapi/nt_sem.h> |
| #include <ntapi/ntapi.h> |
| #include "ntapi_impl.h" |
| |
| static int32_t __sem_set_return( |
| void * mapaddr, |
| intptr_t volatile * hlock, |
| int32_t status) |
| { |
| if (hlock) |
| at_store(hlock,0); |
| |
| if (mapaddr) |
| __ntapi->zw_unmap_view_of_section( |
| NT_CURRENT_PROCESS_HANDLE, |
| mapaddr); |
| |
| return status; |
| } |
| |
| int32_t __stdcall __ntapi_sem_set( |
| __in nt_sem_info * sem, |
| __out nt_io_status_block * iosb, |
| __in void * sem_info, |
| __in uint32_t sem_info_length, |
| __in int32_t sem_ipc_cmd) |
| { |
| int32_t status; |
| void * mapaddr; |
| void * hsection; |
| void * secaddr; |
| size_t secsize; |
| nt_sem_info_msg msg; |
| intptr_t volatile * hlock; |
| |
| |
| if (!iosb) |
| return NT_STATUS_INVALID_PARAMETER; |
| |
| else if (!sem_info) |
| return NT_STATUS_INVALID_PARAMETER; |
| |
| else if (!sem_info_length) |
| return NT_STATUS_INVALID_PARAMETER; |
| |
| else if (sem_ipc_cmd != NT_SEM_CMD_SETALL) |
| if (sem_info_length != sizeof(nt_sem_info)) |
| return NT_STATUS_INFO_LENGTH_MISMATCH; |
| |
| |
| hlock = 0; |
| |
| |
| hsection = 0; |
| secaddr = 0; |
| secsize = 0; |
| |
| |
| if (sem_ipc_cmd == NT_SEM_CMD_SETALL) { |
| if (sem->section_addr) { |
| hsection = sem->section; |
| secaddr = sem->section_addr; |
| secsize = sem->section_size; |
| mapaddr = 0; |
| |
| } else if ((status = __ntapi->ipc_init_section_by_port( |
| sem->hport,&hsection, |
| &secaddr,&secsize))) { |
| return status; |
| |
| } else { |
| mapaddr = secaddr; |
| } |
| |
| |
| if (secsize < sem_info_length) |
| return __sem_set_return( |
| mapaddr,0, |
| NT_STATUS_DATA_OVERRUN); |
| |
| |
| hlock = &(__ntapi_internals()->hlock); |
| |
| while (at_locked_cas(hlock,0,1)) |
| __ntapi->zw_delay_execution( |
| NT_SYNC_NON_ALERTABLE, |
| &(nt_timeout){{0,0}}); |
| |
| |
| __ntapi->tt_generic_memcpy( |
| secaddr,sem_info, |
| sem_info_length); |
| } |
| |
| |
| __ntapi->tt_aligned_block_memset( |
| &msg,0,sizeof(msg)); |
| |
| msg.header.msg_type = NT_LPC_NEW_MESSAGE; |
| msg.header.data_size = sizeof(msg.data); |
| msg.header.msg_size = sizeof(msg); |
| msg.data.ttyinfo.opcode = NT_TTY_SEM_SET; |
| |
| msg.data.seminfo.semcmd = sem_ipc_cmd; |
| msg.data.seminfo.semkey = sem->semkey; |
| msg.data.seminfo.semid = sem->semid; |
| msg.data.seminfo.semnum = sem->semnum; |
| msg.data.seminfo.semval = sem->semval; |
| msg.data.seminfo.section_addr = secaddr; |
| msg.data.seminfo.section_size = sem_info_length; |
| |
| if ((status = __ntapi->zw_request_wait_reply_port(sem->hport,&msg,&msg))) |
| return __sem_set_return(mapaddr,hlock,status); |
| else if (msg.data.ttyinfo.status) |
| return __sem_set_return(mapaddr,hlock,msg.data.ttyinfo.status); |
| |
| |
| iosb->status = NT_STATUS_SUCCESS; |
| iosb->info = 0; |
| |
| return __sem_set_return(mapaddr,hlock,NT_STATUS_SUCCESS); |
| } |