summaryrefslogtreecommitdiffhomepage
path: root/src/afl/ntapi_afl_connect.c
blob: c5098d6a8437ab658e9f590d711dfd97718c7510 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
/********************************************************/
/*  ntapi: Native API core library                      */
/*  Copyright (C) 2013--2021  SysDeer Technologies, LLC */
/*  Released under GPLv2 and GPLv3; see COPYING.NTAPI.  */
/********************************************************/

#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_afl.h>
#include <ntapi/ntapi.h>
#include "ntapi_impl.h"

static const nt_guid	g_aflpid    = NT_IPC_GUID_AFLPID;
static const wchar16_t	p_aflpid[6] = NT_IPC_OBJDIR_PREFIX_AFLPID;

static int32_t __aflctl_get_service_attr(
	nt_rtdata *		rtdata,
	nt_tty_service_info *	aflctl)
{
	nt_iosb iosb;

	/* inherited runtime data? */
	if (rtdata->aflctl_keys[0]) {
		aflctl->attr.ver_major = 0;
		aflctl->attr.ver_minor = 0;
		aflctl->attr.options   = 0;
		aflctl->attr.flags     = 0;

		aflctl->attr.type    = rtdata->aflctl_type;
		aflctl->attr.subtype = rtdata->aflctl_subtype;

		aflctl->attr.keys.key[0] = rtdata->aflctl_keys[0];
		aflctl->attr.keys.key[1] = rtdata->aflctl_keys[1];
		aflctl->attr.keys.key[2] = rtdata->aflctl_keys[2];
		aflctl->attr.keys.key[3] = rtdata->aflctl_keys[3];
		aflctl->attr.keys.key[4] = rtdata->aflctl_keys[4];
		aflctl->attr.keys.key[5] = rtdata->aflctl_keys[5];

		__ntapi->tt_guid_copy(
			&aflctl->attr.guid,
			&rtdata->aflctl_guid);

		return NT_STATUS_SUCCESS;
	}

	/* obtain service info */
	return __ntapi->tty_query_information_service(
		0,&iosb,aflctl,
		&(nt_guid)NT_PORT_GUID_AFLCTL,
		0,0);
}

static int32_t __aflctl_server_connect(
	nt_rtdata *		rtdata,
	nt_tty_service_info *	aflctl)
{
	int32_t status;

	/* already cononected? */
	if (rtdata->haflctl)
		return NT_STATUS_SUCCESS;

	/* connect */
	if ((status = __ntapi->ipc_connect_by_attr(
			&rtdata->haflctl,
			&aflctl->attr,
			false)))
		return status;

	/* update */
	rtdata->aflctl_type    = aflctl->attr.type;
	rtdata->aflctl_subtype = aflctl->attr.subtype;

	rtdata->aflctl_keys[0] = aflctl->attr.keys.key[0];
	rtdata->aflctl_keys[1] = aflctl->attr.keys.key[1];
	rtdata->aflctl_keys[2] = aflctl->attr.keys.key[2];
	rtdata->aflctl_keys[3] = aflctl->attr.keys.key[3];
	rtdata->aflctl_keys[4] = aflctl->attr.keys.key[4];
	rtdata->aflctl_keys[5] = aflctl->attr.keys.key[5];

	__ntapi->tt_guid_copy(
		&rtdata->aflctl_guid,
		&aflctl->attr.guid);

	return NT_STATUS_SUCCESS;
}

static int32_t __aflpid_symlink_set(
	nt_rtdata *		rtdata,
	nt_tty_service_info *	aflctl)
{
	int32_t			status;
	void *			hpiddir;
	nt_port_name		svcname;
	nt_unicode_string	str;

	if (rtdata->haflpid)
		return NT_STATUS_SUCCESS;

	if (!rtdata->haflpiddir) {
		if ((status = __ntapi->tt_open_ipc_object_directory(
				&hpiddir,
				NT_SEC_READ_CONTROL
					| NT_DIRECTORY_QUERY
					| NT_DIRECTORY_TRAVERSE
					| NT_DIRECTORY_CREATE_OBJECT
					| NT_DIRECTORY_CREATE_SUBDIRECTORY,
				p_aflpid,&g_aflpid)))
			return status;

		if (at_locked_cas((intptr_t *)&rtdata->haflpiddir,0,(intptr_t)hpiddir))
			__ntapi->zw_close(hpiddir);
	}

	__ntapi->tt_port_name_from_attr(
		&svcname,&aflctl->attr);

	str.strlen = (uint16_t)(__offsetof(nt_port_name,null_termination));
	str.maxlen = sizeof(nt_port_name);
	str.buffer = svcname.base_named_objects;

	return __ntapi->tt_create_ipc_object_directory_entry(
		&rtdata->haflpid,
		NT_SEC_STANDARD_RIGHTS_ALL,
		rtdata->haflpiddir,
		0,&str,
		pe_get_current_process_id());

}

static int32_t	__stdcall __afl_open(
	void *			hipc,
	nt_afl_info *		afl,
	nt_iosb *		iosb,
	nt_guid *		afldev,
	uint32_t		opcode)
{
	int32_t			status;
	nt_tty_port_msg		msg;
	nt_iosb			siosb;
	nt_tty_service_info	aflctl;
	nt_runtime_data *	rtdata;

	/* init */
	rtdata = (__ntapi_internals())->rtdata;

	/* aflctl service attributes */
	if (!rtdata->haflpid)
		if ((status = __aflctl_get_service_attr(rtdata,&aflctl)))
			return status;

	/* aflctl server */
	if ((status = __aflctl_server_connect(rtdata,&aflctl)))
		return status;

	/* aflpid symlink */
	if ((status = __aflpid_symlink_set(rtdata,&aflctl)))
		return status;

	/* hipc */
	if (!hipc && (opcode == NT_TTY_AFL_ALLOC))
		hipc = (__ntapi_internals())->rtdata->haflctl;

	/* obtain afl info */
	__ntapi->tt_aligned_block_memset(
		&msg,0,sizeof(msg));

	if (!iosb)
		iosb = &siosb;

	msg.header.msg_type		= NT_LPC_NEW_MESSAGE;
	msg.header.data_size		= sizeof(nt_afl_info_msg) - sizeof(msg.header);
	msg.header.msg_size		= sizeof(msg);
	msg.ttyinfo.opcode		= opcode;

	__ntapi->tt_guid_copy(
		&msg.aflinfo.afldev,
		afldev);

	/* todo: device guid */

	if ((status = __ntapi->zw_request_wait_reply_port(hipc,&msg,&msg)))
		return status;
	else if (msg.ttyinfo.status)
		return msg.ttyinfo.status;

	iosb->info   = sizeof(msg.svcinfo);
	iosb->status = NT_STATUS_SUCCESS;

	/* new afl node? */
	if (opcode == NT_TTY_AFL_ALLOC)
		if ((status = __ntapi->ipc_connect_by_attr(
				&hipc,&msg.svcinfo.attr,
				false)))
			return status;

	/* all done */
	__ntapi->tt_aligned_block_memset(
		(uintptr_t *)afl,
		0,sizeof(*afl));

	afl->hport = hipc;

	__ntapi->tt_guid_copy(
		&afl->afldev,
		afldev);

	return NT_STATUS_SUCCESS;
}


int32_t	__stdcall __ntapi_afl_create(
	__in	void *			hport,
	__out	nt_afl_info *		afl,
	__in	nt_oa *			oa,
	__out	nt_iosb *		iosb)
{
	nt_guid afldev;

	/* validate */
	if (!oa->root_dir)
		return NT_STATUS_DIRECTORY_SERVICE_REQUIRED;

	if (!oa->obj_name)
		return NT_STATUS_INVALID_PARAMETER;

	if (oa->obj_name->strlen != sizeof(nt_guid_str_utf16))
		return NT_STATUS_OBJECT_NAME_INVALID;

	if (__ntapi->tt_string_to_guid_utf16(
			(nt_guid_str_utf16 *)oa->obj_name->buffer,
			&afldev))
		return NT_STATUS_OBJECT_NAME_INVALID;

	/* open afldev */
	return __afl_open(
		hport,afl,iosb,
		&afldev,
		NT_TTY_AFL_ALLOC);
}


int32_t	__stdcall __ntapi_afl_open(
	__in	void *			hport,
	__out	nt_afl_info *		afl,
	__in	nt_oa *			oa,
	__out	nt_iosb *		iosb)
{
	int32_t			status;
	nt_guid			afldev;
	void *			hsymlink;
	nt_oa			ipcoa;
	void *			hipc;
	nt_rtdata *		rtdata;
	nt_tty_service_info	aflctl;

	/* init */
	rtdata = (__ntapi_internals())->rtdata;

	/* validate */
	if (!oa->root_dir)
		return NT_STATUS_DIRECTORY_SERVICE_REQUIRED;

	if (!oa->obj_name)
		return NT_STATUS_INVALID_PARAMETER;

	if (oa->obj_name->strlen != sizeof(nt_guid_str_utf16))
		return NT_STATUS_OBJECT_NAME_INVALID;

	if (__ntapi->tt_string_to_guid_utf16(
			(nt_guid_str_utf16 *)oa->obj_name->buffer,
			&afldev))
		return NT_STATUS_OBJECT_NAME_INVALID;

	/* open symlink */
	ipcoa.len      = sizeof(ipcoa);
	ipcoa.root_dir = oa->root_dir;
	ipcoa.obj_name = oa->obj_name;
	ipcoa.obj_attr = 0;
	ipcoa.sec_desc = oa->sec_desc;
	ipcoa.sec_qos  = oa->sec_qos;

	status = __ntapi->zw_open_symbolic_link_object(
		&hsymlink,
		NT_SYMBOLIC_LINK_QUERY,
		&ipcoa);

	switch (status) {
		case NT_STATUS_SUCCESS:
			break;

		case NT_STATUS_OBJECT_NAME_NOT_FOUND:
		case NT_STATUS_OBJECT_PATH_NOT_FOUND:
			if (oa->obj_attr & NT_OBJ_OPENIF)
				return __afl_open(
					hport,afl,iosb,
					&afldev,
					NT_TTY_AFL_ALLOC);
			else
				return status;

		default:
			return status;
	}

	/* aflctl service attributes */
	if (!rtdata->haflpid)
		if ((status = __aflctl_get_service_attr(rtdata,&aflctl)))
			return status;

	/* aflctl server */
	if ((status = __aflctl_server_connect(rtdata,&aflctl)))
		return status;

	/* aflpid symlink */
	if ((status = __aflpid_symlink_set(rtdata,&aflctl)))
		return status;

	/* ipc connect */
	status = __ntapi->ipc_connect_by_symlink(
		&hipc,hsymlink,false);

	__ntapi->zw_close(
		hsymlink);

	if (status)
		return status;

	return __afl_open(
		hipc,afl,iosb,
		&afldev,
		NT_TTY_AFL_OPEN);
}