First implementation of MCS_CONNECT_RESPONSE (send error for now)
[rdpsrv] / mcs.c
1 /* -*- c-basic-offset: 8 -*-
2    rdesktop: A Remote Desktop Protocol client.
3    Protocol services - Multipoint Communications Service
4    Copyright (C) Matthew Chapman 1999-2002
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 #include "rdesktop.h"
22
23 uint16 g_mcs_userid;
24 extern VCHANNEL g_channels[];
25 extern unsigned int g_num_channels;
26
27 /* Parse an ASN.1 BER header */
28 static BOOL
29 ber_parse_header(STREAM s, int tagval, int *length)
30 {
31         int tag, len;
32
33         if (tagval > 0xff)
34         {
35                 in_uint16_be(s, tag);
36         }
37         else
38         {
39         in_uint8(s, tag)}
40
41         if (tag != tagval)
42         {
43                 error("expected tag %d, got %d\n", tagval, tag);
44                 return False;
45         }
46
47         in_uint8(s, len);
48
49         if (len & 0x80)
50         {
51                 len &= ~0x80;
52                 *length = 0;
53                 while (len--)
54                         next_be(s, *length);
55         }
56         else
57                 *length = len;
58
59         return s_check(s);
60 }
61
62 /* Output an ASN.1 BER header */
63 static void
64 ber_out_header(STREAM s, int tagval, int length)
65 {
66         if (tagval > 0xff)
67         {
68                 out_uint16_be(s, tagval);
69         }
70         else
71         {
72                 out_uint8(s, tagval);
73         }
74
75         if (length >= 0x80)
76         {
77                 out_uint8(s, 0x82);
78                 out_uint16_be(s, length);
79         }
80         else
81                 out_uint8(s, length);
82 }
83
84 /* Output an ASN.1 BER integer */
85 static void
86 ber_out_integer(STREAM s, int value)
87 {
88         ber_out_header(s, BER_TAG_INTEGER, 2);
89         out_uint16_be(s, value);
90 }
91
92 /* Output a DOMAIN_PARAMS structure (ASN.1 BER) */
93 static void
94 mcs_out_domain_params(STREAM s, int max_channels, int max_users, int max_tokens, int max_pdusize)
95 {
96         ber_out_header(s, MCS_TAG_DOMAIN_PARAMS, 32);
97         ber_out_integer(s, max_channels);
98         ber_out_integer(s, max_users);
99         ber_out_integer(s, max_tokens);
100         ber_out_integer(s, 1);  /* num_priorities */
101         ber_out_integer(s, 0);  /* min_throughput */
102         ber_out_integer(s, 1);  /* max_height */
103         ber_out_integer(s, max_pdusize);
104         ber_out_integer(s, 2);  /* ver_protocol */
105 }
106
107 /* Parse a DOMAIN_PARAMS structure (ASN.1 BER) */
108 static BOOL
109 mcs_parse_domain_params(STREAM s)
110 {
111         int length;
112
113         ber_parse_header(s, MCS_TAG_DOMAIN_PARAMS, &length);
114         in_uint8s(s, length);
115
116         return s_check(s);
117 }
118
119 /* Expect a MCS_CONNECT_RESPONSE message (ASN.1 BER) */
120 BOOL
121 mcs_recv_connect_initial()
122 {
123         uint8 result;
124         int length;
125         STREAM s;
126         char *buf;
127
128         s = iso_recv();
129         if (s == NULL)
130                 return False;
131
132         ber_parse_header(s, MCS_CONNECT_INITIAL, &length);
133         printf("parsing MCS_CONNECT_INITIAL (len=%u)\n", length);
134         ber_parse_header(s, BER_TAG_OCTET_STRING, &length);   /* calling domain */
135         in_uint8(s, result);
136         ber_parse_header(s, BER_TAG_OCTET_STRING, &length);   /* called domain */
137         in_uint8(s, result);
138         
139         ber_parse_header(s, BER_TAG_BOOLEAN, &length);
140         in_uint8(s, result);
141
142         mcs_parse_domain_params(s);
143         mcs_parse_domain_params(s);
144         mcs_parse_domain_params(s);
145
146         ber_parse_header(s, BER_TAG_OCTET_STRING, &length);
147         in_uint8p(s, buf, length);
148
149         printf("Data from MCS connect: '%*s'\n", length, buf);
150         
151         return s_check_end(s);
152 }
153
154 void
155 mcs_send_connect_response()
156 {
157         STREAM s;
158
159         s = iso_init(2048);  // FIXME
160
161         ber_out_header(s, MCS_CONNECT_RESPONSE, 2048);
162         ber_out_header(s, BER_TAG_RESULT, 1);
163         out_uint8(s, 1);  // success
164         
165         s_mark_end(s);
166         iso_send(s);
167
168 }
169
170 /* Send an EDrq message (ASN.1 PER) */
171 static void
172 mcs_send_edrq(void)
173 {
174         STREAM s;
175
176         s = iso_init(5);
177
178         out_uint8(s, (MCS_EDRQ << 2));
179         out_uint16_be(s, 1);    /* height */
180         out_uint16_be(s, 1);    /* interval */
181
182         s_mark_end(s);
183         iso_send(s);
184 }
185
186 /* Send an AUrq message (ASN.1 PER) */
187 static void
188 mcs_send_aurq(void)
189 {
190         STREAM s;
191
192         s = iso_init(1);
193
194         out_uint8(s, (MCS_AURQ << 2));
195
196         s_mark_end(s);
197         iso_send(s);
198 }
199
200 /* Expect a AUcf message (ASN.1 PER) */
201 static BOOL
202 mcs_recv_aucf(uint16 * mcs_userid)
203 {
204         uint8 opcode, result;
205         STREAM s;
206
207         s = iso_recv();
208         if (s == NULL)
209                 return False;
210
211         in_uint8(s, opcode);
212         if ((opcode >> 2) != MCS_AUCF)
213         {
214                 error("expected AUcf, got %d\n", opcode);
215                 return False;
216         }
217
218         in_uint8(s, result);
219         if (result != 0)
220         {
221                 error("AUrq: %d\n", result);
222                 return False;
223         }
224
225         if (opcode & 2)
226                 in_uint16_be(s, *mcs_userid);
227
228         return s_check_end(s);
229 }
230
231 /* Send a CJrq message (ASN.1 PER) */
232 static void
233 mcs_send_cjrq(uint16 chanid)
234 {
235         STREAM s;
236
237         DEBUG_RDP5(("Sending CJRQ for channel #%d\n", chanid));
238
239         s = iso_init(5);
240
241         out_uint8(s, (MCS_CJRQ << 2));
242         out_uint16_be(s, g_mcs_userid);
243         out_uint16_be(s, chanid);
244
245         s_mark_end(s);
246         iso_send(s);
247 }
248
249 /* Expect a CJcf message (ASN.1 PER) */
250 static BOOL
251 mcs_recv_cjcf(void)
252 {
253         uint8 opcode, result;
254         STREAM s;
255
256         s = iso_recv();
257         if (s == NULL)
258                 return False;
259
260         in_uint8(s, opcode);
261         if ((opcode >> 2) != MCS_CJCF)
262         {
263                 error("expected CJcf, got %d\n", opcode);
264                 return False;
265         }
266
267         in_uint8(s, result);
268         if (result != 0)
269         {
270                 error("CJrq: %d\n", result);
271                 return False;
272         }
273
274         in_uint8s(s, 4);        /* mcs_userid, req_chanid */
275         if (opcode & 2)
276                 in_uint8s(s, 2);        /* join_chanid */
277
278         return s_check_end(s);
279 }
280
281 /* Initialise an MCS transport data packet */
282 STREAM
283 mcs_init(int length)
284 {
285         STREAM s;
286
287         s = iso_init(length + 8);
288         s_push_layer(s, mcs_hdr, 8);
289
290         return s;
291 }
292
293 /* Send an MCS transport data packet to a specific channel */
294 void
295 mcs_send_to_channel(STREAM s, uint16 channel)
296 {
297         uint16 length;
298
299         s_pop_layer(s, mcs_hdr);
300         length = s->end - s->p - 8;
301         length |= 0x8000;
302
303         out_uint8(s, (MCS_SDRQ << 2));
304         out_uint16_be(s, g_mcs_userid);
305         out_uint16_be(s, channel);
306         out_uint8(s, 0x70);     /* flags */
307         out_uint16_be(s, length);
308
309         iso_send(s);
310 }
311
312 /* Send an MCS transport data packet to the global channel */
313 void
314 mcs_send(STREAM s)
315 {
316         mcs_send_to_channel(s, MCS_GLOBAL_CHANNEL);
317 }
318
319 /* Receive an MCS transport data packet */
320 STREAM
321 mcs_recv(uint16 * channel)
322 {
323         uint8 opcode, appid, length;
324         STREAM s;
325
326         s = iso_recv();
327         if (s == NULL)
328                 return NULL;
329
330         in_uint8(s, opcode);
331         appid = opcode >> 2;
332         if (appid != MCS_SDIN)
333         {
334                 if (appid != MCS_DPUM)
335                 {
336                         error("expected data, got %d\n", opcode);
337                 }
338                 return NULL;
339         }
340
341         in_uint8s(s, 2);        /* userid */
342         in_uint16_be(s, *channel);
343         in_uint8s(s, 1);        /* flags */
344         in_uint8(s, length);
345         if (length & 0x80)
346                 in_uint8s(s, 1);        /* second byte of length */
347
348         return s;
349 }
350
351 /* Disconnect from the MCS layer */
352 void
353 mcs_disconnect(void)
354 {
355         iso_disconnect();
356 }