trunk/rdesktop/mcs.c

/*
   rdesktop: A Remote Desktop Protocol client.
   Protocol services - Multipoint Communications Service
   Copyright (C) Matthew Chapman 1999-2000
   
   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License as published by
   the Free Software Foundation; either version 2 of the License, or
   (at your option) any later version.
   
   This program is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   GNU General Public License for more details.
   
   You should have received a copy of the GNU General Public License
   along with this program; if not, write to the Free Software
   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#include "rdesktop.h"

uint16 mcs_userid;

/* Parse an ASN.1 BER header */
static BOOL ber_parse_header(STREAM s, int tagval, int *length)
{
        int tag, len;

        if (tagval > 0xff)
        {
                in_uint16_be(s, tag);
        }
        else
        {
        in_uint8(s, tag)}

        if (tag != tagval)
        {
                ERROR("expected tag %d, got %d\n", tagval, tag);
                return False;
        }

        in_uint8(s, len);

        if (len & 0x80)
        {
                len &= ~0x80;
                *length = 0;
                while (len--)
                        next_be(s, *length);
        }
        else
                *length = len;

        return s_check(s);
}

/* Output an ASN.1 BER header */
static void ber_out_header(STREAM s, int tagval, int length)
{
        if (tagval > 0xff)
        {
                out_uint16_be(s, tagval);
        }
        else
        {
                out_uint8(s, tagval);
        }

        if (length >= 0x80)
        {
                out_uint8(s, 0x82);
                out_uint16_be(s, length);
        }
        else
                out_uint8(s, length);
}

/* Output an ASN.1 BER integer */
static void ber_out_integer(STREAM s, int value)
{
        ber_out_header(s, BER_TAG_INTEGER, 2);
        out_uint16_be(s, value);
}

/* Output a DOMAIN_PARAMS structure (ASN.1 BER) */
static void mcs_out_domain_params(STREAM s, int max_channels, int max_users,
                                  int max_tokens, int max_pdusize)
{
        ber_out_header(s, MCS_TAG_DOMAIN_PARAMS, 32);
        ber_out_integer(s, max_channels);
        ber_out_integer(s, max_users);
        ber_out_integer(s, max_tokens);
        ber_out_integer(s, 1);  /* num_priorities */
        ber_out_integer(s, 0);  /* min_throughput */
        ber_out_integer(s, 1);  /* max_height */
        ber_out_integer(s, max_pdusize);
        ber_out_integer(s, 2);  /* ver_protocol */
}

/* Parse a DOMAIN_PARAMS structure (ASN.1 BER) */
static BOOL mcs_parse_domain_params(STREAM s)
{
        int length;

        ber_parse_header(s, MCS_TAG_DOMAIN_PARAMS, &length);
        in_uint8s(s, length);

        return s_check(s);
}

/* Send an MCS_CONNECT_INITIAL message (ASN.1 BER) */
static void mcs_send_connect_initial(STREAM mcs_data)
{
        int datalen = mcs_data->end - mcs_data->data;
        int length = 7 + 3 * 34 + 4 + datalen;
        STREAM s;

        s = iso_init(length + 5);

        ber_out_header(s, MCS_CONNECT_INITIAL, length);
        ber_out_header(s, BER_TAG_OCTET_STRING, 0);     /* calling domain */
        ber_out_header(s, BER_TAG_OCTET_STRING, 0);     /* called domain */

        ber_out_header(s, BER_TAG_BOOLEAN, 1);
        out_uint8(s, 0xff);     /* upward flag */

        mcs_out_domain_params(s, 2, 2, 0, 0xffff);      /* target params */
        mcs_out_domain_params(s, 1, 1, 1, 0x420);       /* min params */
        mcs_out_domain_params(s, 0xffff, 0xfc17, 0xffff, 0xffff);       /* max params */

        ber_out_header(s, BER_TAG_OCTET_STRING, datalen);
        out_uint8p(s, mcs_data->data, datalen);

        s_mark_end(s);
        iso_send(s);
}

/* Expect a MCS_CONNECT_RESPONSE message (ASN.1 BER) */
static BOOL mcs_recv_connect_response(STREAM mcs_data)
{
        uint8 result;
        int length;
        STREAM s;

        s = iso_recv();
        if (s == NULL)
                return False;

        ber_parse_header(s, MCS_CONNECT_RESPONSE, &length);

        ber_parse_header(s, BER_TAG_RESULT, &length);
        in_uint8(s, result);
        if (result != 0)
        {
                ERROR("MCS connect: %d\n", result);
                return False;
        }

        ber_parse_header(s, BER_TAG_INTEGER, &length);
        in_uint8s(s, length);   /* connect id */
        mcs_parse_domain_params(s);

        ber_parse_header(s, BER_TAG_OCTET_STRING, &length);
        if (length > mcs_data->size)
        {
                WARN("MCS data length %d\n", length);
                length = mcs_data->size;
        }

        in_uint8a(s, mcs_data->data, length);
        mcs_data->p = mcs_data->data;
        mcs_data->end = mcs_data->data + length;

        return s_check_end(s);
}

/* Send an EDrq message (ASN.1 PER) */
static void mcs_send_edrq()
{
        STREAM s;

        s = iso_init(5);

        out_uint8(s, (MCS_EDRQ << 2));
        out_uint16_be(s, 1);    /* height */
        out_uint16_be(s, 1);    /* interval */

        s_mark_end(s);
        iso_send(s);
}

/* Send an AUrq message (ASN.1 PER) */
static void mcs_send_aurq()
{
        STREAM s;

        s = iso_init(1);

        out_uint8(s, (MCS_AURQ << 2));

        s_mark_end(s);
        iso_send(s);
}

/* Expect a AUcf message (ASN.1 PER) */
static BOOL mcs_recv_aucf(uint16 *mcs_userid)
{
        uint8 opcode, result;
        STREAM s;

        s = iso_recv();
        if (s == NULL)
                return False;

        in_uint8(s, opcode);
        if ((opcode >> 2) != MCS_AUCF)
        {
                ERROR("expected AUcf, got %d\n", opcode);
                return False;
        }

        in_uint8(s, result);
        if (result != 0)
        {
                ERROR("AUrq: %d\n", result);
                return False;
        }

        if (opcode & 2)
                in_uint16_be(s, *mcs_userid);

        return s_check_end(s);
}

/* Send a CJrq message (ASN.1 PER) */
static void mcs_send_cjrq(uint16 chanid)
{
        STREAM s;

        s = iso_init(5);

        out_uint8(s, (MCS_CJRQ << 2));
        out_uint16_be(s, mcs_userid);
        out_uint16_be(s, chanid);

        s_mark_end(s);
        iso_send(s);
}

/* Expect a CJcf message (ASN.1 PER) */
static BOOL mcs_recv_cjcf()
{
        uint8 opcode, result;
        STREAM s;

        s = iso_recv();
        if (s == NULL)
                return False;

        in_uint8(s, opcode);
        if ((opcode >> 2) != MCS_CJCF)
        {
                ERROR("expected CJcf, got %d\n", opcode);
                return False;
        }

        in_uint8(s, result);
        if (result != 0)
        {
                ERROR("CJrq: %d\n", result);
                return False;
        }

        in_uint8s(s, 4);        /* mcs_userid, req_chanid */
        if (opcode & 2)
                in_uint8s(s, 2);        /* join_chanid */

        return s_check_end(s);
}

/* Initialise an MCS transport data packet */
STREAM mcs_init(int length)
{
        STREAM s;

        s = iso_init(length + 8);
        s_push_layer(s, mcs_hdr, 8);

        return s;
}

/* Send an MCS transport data packet */
void mcs_send(STREAM s)
{
        uint16 length;

        s_pop_layer(s, mcs_hdr);
        length = s->end - s->p - 8;
        length |= 0x8000;

        out_uint8(s, (MCS_SDRQ << 2));
        out_uint16_be(s, mcs_userid);
        out_uint16_be(s, MCS_GLOBAL_CHANNEL);
        out_uint8(s, 0x70);     /* flags */
        out_uint16_be(s, length);

        iso_send(s);
}

/* Receive an MCS transport data packet */
STREAM mcs_recv()
{
        uint8 opcode, appid, length;
        STREAM s;

        s = iso_recv();
        if (s == NULL)
                return NULL;

        in_uint8(s, opcode);
        appid = opcode >> 2;
        if (appid != MCS_SDIN)
        {
                if (appid != MCS_DPUM)
                {
                        ERROR("expected data, got %d\n", opcode);
                }
                return NULL;
        }

        in_uint8s(s, 5);        /* userid, chanid, flags */
        in_uint8(s, length);
        if (length & 0x80)
                in_uint8s(s, 1);        /* second byte of length */

        return s;
}

/* Establish a connection up to the MCS layer */
BOOL mcs_connect(char *server, STREAM mcs_data)
{
        if (!iso_connect(server))
                return False;

        mcs_send_connect_initial(mcs_data);
        if (!mcs_recv_connect_response(mcs_data))
                goto error;

        mcs_send_edrq();

        mcs_send_aurq();
        if (!mcs_recv_aucf(&mcs_userid))
                goto error;

        mcs_send_cjrq(mcs_userid + 1001);
        if (!mcs_recv_cjcf())
                goto error;

        mcs_send_cjrq(MCS_GLOBAL_CHANNEL);
        if (!mcs_recv_cjcf())
                goto error;

        return True;

      error:
        iso_disconnect();
        return False;
}

/* Disconnect from the MCS layer */
void mcs_disconnect()
{
        iso_disconnect();
}
1	matty	3	/*
2			rdesktop: A Remote Desktop Protocol client.
3			Protocol services - Multipoint Communications Service
4			Copyright (C) Matthew Chapman 1999-2000
5
6			This program is free software; you can redistribute it and/or modify
7			it under the terms of the GNU General Public License as published by
8			the Free Software Foundation; either version 2 of the License, or
9			(at your option) any later version.
10
11			This program is distributed in the hope that it will be useful,
12			but WITHOUT ANY WARRANTY; without even the implied warranty of
13			MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14			GNU General Public License for more details.
15
16			You should have received a copy of the GNU General Public License
17			along with this program; if not, write to the Free Software
18			Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19			*/
20
21	matty	10	#include "rdesktop.h"
22	matty	3
23	matty	10	uint16 mcs_userid;
24
25			/* Parse an ASN.1 BER header */
26			static BOOL ber_parse_header(STREAM s, int tagval, int *length)
27	matty	3	{
28	matty	10	int tag, len;
29	matty	3
30	matty	10	if (tagval > 0xff)
31	matty	3	{
32	matty	10	in_uint16_be(s, tag);
33	matty	3	}
34	matty	10	else
35	matty	3	{
36	matty	24	in_uint8(s, tag)}
37	matty	3
38	matty	10	if (tag != tagval)
39	matty	3	{
40	matty	10	ERROR("expected tag %d, got %d\n", tagval, tag);
41			return False;
42	matty	3	}
43
44	matty	10	in_uint8(s, len);
45	matty	3
46	matty	10	if (len & 0x80)
47	matty	3	{
48	matty	10	len &= ~0x80;
49			*length = 0;
50			while (len--)
51			next_be(s, *length);
52	matty	3	}
53	matty	24	else
54			*length = len;
55	matty	3
56	matty	10	return s_check(s);
57	matty	3	}
58
59	matty	10	/* Output an ASN.1 BER header */
60			static void ber_out_header(STREAM s, int tagval, int length)
61	matty	3	{
62	matty	10	if (tagval > 0xff)
63	matty	3	{
64	matty	10	out_uint16_be(s, tagval);
65	matty	3	}
66	matty	10	else
67			{
68			out_uint8(s, tagval);
69			}
70	matty	3
71	matty	10	if (length >= 0x80)
72	matty	3	{
73	matty	10	out_uint8(s, 0x82);
74			out_uint16_be(s, length);
75	matty	3	}
76	matty	24	else
77			out_uint8(s, length);
78	matty	3	}
79
80	matty	10	/* Output an ASN.1 BER integer */
81			static void ber_out_integer(STREAM s, int value)
82	matty	3	{
83	matty	10	ber_out_header(s, BER_TAG_INTEGER, 2);
84			out_uint16_be(s, value);
85	matty	3	}
86
87	matty	10	/* Output a DOMAIN_PARAMS structure (ASN.1 BER) */
88			static void mcs_out_domain_params(STREAM s, int max_channels, int max_users,
89	matty	24	int max_tokens, int max_pdusize)
90	matty	3	{
91	matty	10	ber_out_header(s, MCS_TAG_DOMAIN_PARAMS, 32);
92			ber_out_integer(s, max_channels);
93			ber_out_integer(s, max_users);
94			ber_out_integer(s, max_tokens);
95	matty	24	ber_out_integer(s, 1); /* num_priorities */
96			ber_out_integer(s, 0); /* min_throughput */
97			ber_out_integer(s, 1); /* max_height */
98	matty	10	ber_out_integer(s, max_pdusize);
99	matty	24	ber_out_integer(s, 2); /* ver_protocol */
100	matty	3	}
101
102	matty	10	/* Parse a DOMAIN_PARAMS structure (ASN.1 BER) */
103			static BOOL mcs_parse_domain_params(STREAM s)
104	matty	3	{
105	matty	10	int length;
106	matty	3
107	matty	10	ber_parse_header(s, MCS_TAG_DOMAIN_PARAMS, &length);
108			in_uint8s(s, length);
109
110			return s_check(s);
111	matty	3	}
112
113	matty	10	/* Send an MCS_CONNECT_INITIAL message (ASN.1 BER) */
114			static void mcs_send_connect_initial(STREAM mcs_data)
115	matty	3	{
116	matty	10	int datalen = mcs_data->end - mcs_data->data;
117	matty	24	int length = 7 + 3 * 34 + 4 + datalen;
118	matty	10	STREAM s;
119	matty	3
120	matty	10	s = iso_init(length + 5);
121	matty	3
122	matty	10	ber_out_header(s, MCS_CONNECT_INITIAL, length);
123	matty	24	ber_out_header(s, BER_TAG_OCTET_STRING, 0); /* calling domain */
124			ber_out_header(s, BER_TAG_OCTET_STRING, 0); /* called domain */
125	matty	3
126	matty	10	ber_out_header(s, BER_TAG_BOOLEAN, 1);
127	matty	24	out_uint8(s, 0xff); /* upward flag */
128	matty	3
129	matty	24	mcs_out_domain_params(s, 2, 2, 0, 0xffff); /* target params */
130			mcs_out_domain_params(s, 1, 1, 1, 0x420); /* min params */
131			mcs_out_domain_params(s, 0xffff, 0xfc17, 0xffff, 0xffff); /* max params */
132	matty	3
133	matty	10	ber_out_header(s, BER_TAG_OCTET_STRING, datalen);
134			out_uint8p(s, mcs_data->data, datalen);
135	matty	3
136	matty	10	s_mark_end(s);
137			iso_send(s);
138	matty	3	}
139
140	matty	10	/* Expect a MCS_CONNECT_RESPONSE message (ASN.1 BER) */
141			static BOOL mcs_recv_connect_response(STREAM mcs_data)
142	matty	3	{
143	matty	10	uint8 result;
144			int length;
145			STREAM s;
146	matty	3
147	matty	10	s = iso_recv();
148			if (s == NULL)
149	matty	7	return False;
150
151	matty	10	ber_parse_header(s, MCS_CONNECT_RESPONSE, &length);
152	matty	3
153	matty	10	ber_parse_header(s, BER_TAG_RESULT, &length);
154			in_uint8(s, result);
155			if (result != 0)
156	matty	7	{
157	matty	10	ERROR("MCS connect: %d\n", result);
158	matty	3	return False;
159			}
160
161	matty	10	ber_parse_header(s, BER_TAG_INTEGER, &length);
162	matty	24	in_uint8s(s, length); /* connect id */
163	matty	10	mcs_parse_domain_params(s);
164
165			ber_parse_header(s, BER_TAG_OCTET_STRING, &length);
166			if (length > mcs_data->size)
167	matty	3	{
168	matty	10	WARN("MCS data length %d\n", length);
169			length = mcs_data->size;
170	matty	3	}
171
172	matty	10	in_uint8a(s, mcs_data->data, length);
173			mcs_data->p = mcs_data->data;
174			mcs_data->end = mcs_data->data + length;
175	matty	3
176	matty	10	return s_check_end(s);
177	matty	3	}
178
179	matty	10	/* Send an EDrq message (ASN.1 PER) */
180			static void mcs_send_edrq()
181	matty	3	{
182	matty	10	STREAM s;
183	matty	3
184	matty	10	s = iso_init(5);
185	matty	3
186	matty	10	out_uint8(s, (MCS_EDRQ << 2));
187	matty	24	out_uint16_be(s, 1); /* height */
188			out_uint16_be(s, 1); /* interval */
189	matty	3
190	matty	10	s_mark_end(s);
191			iso_send(s);
192	matty	3	}
193
194	matty	10	/* Send an AUrq message (ASN.1 PER) */
195			static void mcs_send_aurq()
196	matty	3	{
197	matty	10	STREAM s;
198	matty	3
199	matty	10	s = iso_init(1);
200	matty	3
201	matty	10	out_uint8(s, (MCS_AURQ << 2));
202	matty	3
203	matty	10	s_mark_end(s);
204			iso_send(s);
205	matty	3	}
206
207	matty	10	/* Expect a AUcf message (ASN.1 PER) */
208			static BOOL mcs_recv_aucf(uint16 *mcs_userid)
209	matty	3	{
210	matty	10	uint8 opcode, result;
211			STREAM s;
212	matty	3
213	matty	10	s = iso_recv();
214			if (s == NULL)
215	matty	3	return False;
216
217	matty	10	in_uint8(s, opcode);
218			if ((opcode >> 2) != MCS_AUCF)
219	matty	3	{
220	matty	10	ERROR("expected AUcf, got %d\n", opcode);
221	matty	3	return False;
222			}
223
224	matty	10	in_uint8(s, result);
225			if (result != 0)
226			{
227			ERROR("AUrq: %d\n", result);
228			return False;
229			}
230	matty	3
231	matty	10	if (opcode & 2)
232			in_uint16_be(s, *mcs_userid);
233	matty	3
234	matty	10	return s_check_end(s);
235	matty	3	}
236
237	matty	10	/* Send a CJrq message (ASN.1 PER) */
238			static void mcs_send_cjrq(uint16 chanid)
239	matty	3	{
240	matty	10	STREAM s;
241	matty	3
242	matty	10	s = iso_init(5);
243	matty	3
244	matty	10	out_uint8(s, (MCS_CJRQ << 2));
245			out_uint16_be(s, mcs_userid);
246			out_uint16_be(s, chanid);
247
248			s_mark_end(s);
249			iso_send(s);
250	matty	3	}
251
252	matty	10	/* Expect a CJcf message (ASN.1 PER) */
253			static BOOL mcs_recv_cjcf()
254	matty	3	{
255	matty	10	uint8 opcode, result;
256			STREAM s;
257	matty	3
258	matty	10	s = iso_recv();
259			if (s == NULL)
260			return False;
261	matty	3
262	matty	10	in_uint8(s, opcode);
263			if ((opcode >> 2) != MCS_CJCF)
264			{
265			ERROR("expected CJcf, got %d\n", opcode);
266			return False;
267			}
268	matty	3
269	matty	10	in_uint8(s, result);
270			if (result != 0)
271	matty	3	{
272	matty	10	ERROR("CJrq: %d\n", result);
273	matty	3	return False;
274			}
275
276	matty	24	in_uint8s(s, 4); /* mcs_userid, req_chanid */
277	matty	10	if (opcode & 2)
278	matty	24	in_uint8s(s, 2); /* join_chanid */
279	matty	3
280	matty	10	return s_check_end(s);
281	matty	3	}
282
283	matty	10	/* Initialise an MCS transport data packet */
284			STREAM mcs_init(int length)
285	matty	3	{
286	matty	10	STREAM s;
287	matty	3
288	matty	10	s = iso_init(length + 8);
289			s_push_layer(s, mcs_hdr, 8);
290	matty	3
291	matty	10	return s;
292	matty	3	}
293
294	matty	10	/* Send an MCS transport data packet */
295			void mcs_send(STREAM s)
296	matty	3	{
297	matty	10	uint16 length;
298	matty	3
299	matty	10	s_pop_layer(s, mcs_hdr);
300			length = s->end - s->p - 8;
301			length \|= 0x8000;
302	matty	3
303	matty	10	out_uint8(s, (MCS_SDRQ << 2));
304			out_uint16_be(s, mcs_userid);
305			out_uint16_be(s, MCS_GLOBAL_CHANNEL);
306	matty	24	out_uint8(s, 0x70); /* flags */
307	matty	10	out_uint16_be(s, length);
308	matty	3
309	matty	10	iso_send(s);
310	matty	3	}
311
312	matty	10	/* Receive an MCS transport data packet */
313			STREAM mcs_recv()
314	matty	3	{
315	matty	10	uint8 opcode, appid, length;
316			STREAM s;
317	matty	3
318	matty	10	s = iso_recv();
319			if (s == NULL)
320			return NULL;
321
322			in_uint8(s, opcode);
323			appid = opcode >> 2;
324			if (appid != MCS_SDIN)
325	matty	3	{
326	matty	10	if (appid != MCS_DPUM)
327			{
328			ERROR("expected data, got %d\n", opcode);
329			}
330			return NULL;
331	matty	3	}
332
333	matty	24	in_uint8s(s, 5); /* userid, chanid, flags */
334	matty	10	in_uint8(s, length);
335			if (length & 0x80)
336	matty	24	in_uint8s(s, 1); /* second byte of length */
337	matty	3
338	matty	10	return s;
339	matty	3	}
340
341	matty	10	/* Establish a connection up to the MCS layer */
342			BOOL mcs_connect(char *server, STREAM mcs_data)
343	matty	3	{
344	matty	10	if (!iso_connect(server))
345	matty	3	return False;
346
347	matty	10	mcs_send_connect_initial(mcs_data);
348			if (!mcs_recv_connect_response(mcs_data))
349			goto error;
350	matty	3
351	matty	10	mcs_send_edrq();
352	matty	3
353	matty	10	mcs_send_aurq();
354			if (!mcs_recv_aucf(&mcs_userid))
355			goto error;
356	matty	3
357	matty	10	mcs_send_cjrq(mcs_userid + 1001);
358			if (!mcs_recv_cjcf())
359			goto error;
360	matty	3
361	matty	10	mcs_send_cjrq(MCS_GLOBAL_CHANNEL);
362			if (!mcs_recv_cjcf())
363			goto error;
364	matty	3
365	matty	10	return True;
366	matty	7
367	matty	24	error:
368	matty	10	iso_disconnect();
369			return False;
370	matty	3	}
371	matty	7
372	matty	10	/* Disconnect from the MCS layer */
373			void mcs_disconnect()
374			{
375			iso_disconnect();
376			}