Blame src/daemon/ptyc_daemon_loop.c

778de5
/*********************************************************/
778de5
/*  ptycon: a pty-console bridge                         */
778de5
/*  Copyright (C) 2016  Z. Gilboa                        */
778de5
/*  Released under GPLv2 and GPLv3; see COPYING.PTYCON.  */
778de5
/*********************************************************/
778de5
778de5
#include <psxtypes/psxtypes.h>
778de5
#include <ntapi/ntapi.h>
778de5
778de5
#include <ptycon/ptycon.h>
778de5
#include "ptycon_daemon_impl.h"
778de5
#include "ptycon_driver_impl.h"
778de5
08072c
#define PTYC_VTBL_ELEMENTS   PTYC_DAEMON_OPCODE_CAP - PTYC_DAEMON_OPCODE_BASE
08072c
08072c
static ptyc_daemon_routine * ptyc_daemon_vtbl[PTYC_VTBL_ELEMENTS] = {
08072c
	ptyc_daemon_connect,
08072c
	0,
87ae0a
	ptyc_daemon_signal,
08072c
	0,
08072c
	0,
08072c
	0
08072c
};
08072c
778de5
int32_t __stdcall ptyc_daemon_loop(void * ctx)
778de5
{
08072c
	struct ptyc_daemon_ctx *	dctx;
08072c
	nt_rtdata *			rtdata;
08072c
08072c
	nt_tty_port_msg			inbuf;
08072c
	nt_tty_port_msg			outbuf;
08072c
08072c
	nt_tty_port_msg *		request;
08072c
	nt_tty_port_msg *		reply;
08072c
08072c
	intptr_t			port_id;
08072c
	int32_t				opcode;
08072c
08072c
	if (ntapi->tt_get_runtime_data(&rtdata,0))
08072c
		return NT_STATUS_INTERNAL_ERROR;
08072c
08072c
	dctx = (struct ptyc_daemon_ctx *)ctx;
08072c
08072c
	/* init */
08072c
	request = &inbuf;
08072c
	ntapi->tt_aligned_block_memset(
08072c
		request,0,sizeof(*request));
08072c
08072c
	/* get first message */
08072c
	ntapi->zw_reply_wait_receive_port(
08072c
		dctx->hport_daemon,
08072c
		&port_id,
08072c
		0,(nt_port_message *)request);
08072c
08072c
	/* message loop */
08072c
	do {
08072c
		switch (request->header.msg_type) {
08072c
			case NT_LPC_REQUEST:
08072c
			case NT_LPC_DATAGRAM:
08072c
				opcode = request->ttyinfo.opcode;
08072c
				break;
08072c
08072c
			case NT_LPC_CONNECTION_REQUEST:
08072c
				opcode = PTYC_DAEMON_CONNECT;
08072c
				break;
08072c
08072c
			default:
08072c
				opcode = -1;
08072c
				break;
08072c
		}
08072c
08072c
		/* dispatch */
08072c
		reply = &outbuf;
08072c
08072c
		ntapi->tt_aligned_block_memcpy(
08072c
			(uintptr_t *)reply,
08072c
			(uintptr_t *)request,
08072c
			sizeof(*reply));
08072c
08072c
		reply->header.msg_type = NT_LPC_REPLY;
08072c
08072c
		if ((opcode >= PTYC_DAEMON_OPCODE_BASE) && (opcode < PTYC_DAEMON_OPCODE_CAP)) {
08072c
			reply->ttyinfo.reserved = (void *)request->header.client_id.process_id;
08072c
			opcode -= PTYC_DAEMON_OPCODE_BASE;
08072c
08072c
			if (ptyc_daemon_vtbl[opcode])
08072c
				reply->ttyinfo.status = ptyc_daemon_vtbl[opcode](reply);
08072c
			else
08072c
				reply->ttyinfo.status = NT_STATUS_NOT_IMPLEMENTED;
08072c
		} else {
08072c
			reply->ttyinfo.reserved = NT_INVALID_HANDLE_VALUE;
08072c
			reply->ttyinfo.status   = NT_STATUS_LPC_INVALID_CONNECTION_USAGE;
08072c
		}
08072c
08072c
		ntapi->tt_aligned_block_memset(
08072c
			request,0,sizeof(*request));
08072c
08072c
		reply = reply->ttyinfo.reserved
08072c
			? &outbuf : 0;
08072c
08072c
		if (!reply)
08072c
			ntapi->zw_reply_wait_receive_port(
08072c
				dctx->hport_daemon,
08072c
				&port_id,
08072c
				0,&request->header);
08072c
		else if (reply->header.client_id.process_id == rtdata->cid_self.process_id)
08072c
			ntapi->zw_reply_wait_receive_port(
08072c
				dctx->hport_daemon,
08072c
				&port_id,
08072c
				&reply->header,
08072c
				&request->header);
08072c
		else {
08072c
			ntapi->zw_reply_port(
08072c
				dctx->hport_daemon,
08072c
				&reply->header);
08072c
08072c
			ntapi->zw_reply_wait_receive_port(
08072c
				dctx->hport_daemon,
08072c
				&port_id,
08072c
				0,&request->header);
08072c
		}
08072c
	} while (request->header.msg_id);
08072c
08072c
	return NT_STATUS_INTERNAL_ERROR;
778de5
}