/[rdesktop]/sourceforge.net/trunk/rdesktop/mcs.c
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Diff of /sourceforge.net/trunk/rdesktop/mcs.c

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

sourceforge.net/branches/RDESKTOP/rdesktop/mcs.c revision 3 by matty, Wed May 10 07:36:34 2000 UTC sourceforge.net/trunk/rdesktop/mcs.c revision 24 by matty, Sat Jan 6 03:12:10 2001 UTC
# Line 18  Line 18 
18     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19  */  */
20    
21  #include "includes.h"  #include "rdesktop.h"
22    
23  /* Establish a connection up to the MCS layer */  uint16 mcs_userid;
 HCONN mcs_connect(char *server)  
 {  
         HCONN conn;  
         MCS_CONNECT_RESPONSE mcr;  
         MCS_AUCF aucf;  
24    
25          if ((conn = iso_connect(server)) == NULL)  /* Parse an ASN.1 BER header */
26                  return NULL;  static BOOL ber_parse_header(STREAM s, int tagval, int *length)
27    {
28            int tag, len;
29    
30          mcs_send_connect_initial(conn);          if (tagval > 0xff)
         if (!iso_recv(conn) || !mcs_io_connect_response(&conn->in, &mcr))  
31          {          {
32                  fprintf(stderr, "MCS error, expected Connect-Response\n");                  in_uint16_be(s, tag);
                 iso_disconnect(conn);  
                 return NULL;  
33          }          }
34            else
         if (mcr.result != 0)  
         {  
                 fprintf(stderr, "MCS-Connect-Initial failed, result %d\n",  
                         mcr.result);  
                 iso_disconnect(conn);  
                 return NULL;  
         }  
   
         mcs_send_edrq(conn);  
   
         mcs_send_aurq(conn);  
         if (!iso_recv(conn) || !mcs_io_aucf(&conn->in, &aucf))  
35          {          {
36                  fprintf(stderr, "MCS error, expected AUcf\n");          in_uint8(s, tag)}
                 mcs_disconnect(conn);  
                 return NULL;  
         }  
37    
38          if (aucf.result != 0)          if (tag != tagval)
39          {          {
40                  fprintf(stderr, "AUrq failed, result %d\n", mcr.result);                  ERROR("expected tag %d, got %d\n", tagval, tag);
41                  mcs_disconnect(conn);                  return False;
                 return NULL;  
42          }          }
43    
44          conn->mcs_userid = aucf.userid;          in_uint8(s, len);
45    
46          if (!mcs_join_channel(conn, aucf.userid + 1001)          if (len & 0x80)
             || !mcs_join_channel(conn, MCS_GLOBAL_CHANNEL))  
47          {          {
48                  mcs_disconnect(conn);                  len &= ~0x80;
49                  return NULL;                  *length = 0;
50                    while (len--)
51                            next_be(s, *length);
52          }          }
53            else
54                    *length = len;
55    
56          return conn;          return s_check(s);
57  }  }
58    
59  BOOL mcs_join_channel(HCONN conn, uint16 chanid)  /* Output an ASN.1 BER header */
60    static void ber_out_header(STREAM s, int tagval, int length)
61  {  {
62          MCS_CJCF cjcf;          if (tagval > 0xff)
   
         mcs_send_cjrq(conn, chanid);  
         if (!iso_recv(conn) || !mcs_io_cjcf(&conn->in, &cjcf))  
63          {          {
64                  fprintf(stderr, "MCS error, expected CJcf\n");                  out_uint16_be(s, tagval);
                 return False;  
65          }          }
66            else
         if (cjcf.result != 0)  
67          {          {
68                  fprintf(stderr, "CJrq failed, result %d\n", cjcf.result);                  out_uint8(s, tagval);
                 return False;  
69          }          }
70    
71          return True;          if (length >= 0x80)
72            {
73                    out_uint8(s, 0x82);
74                    out_uint16_be(s, length);
75            }
76            else
77                    out_uint8(s, length);
78  }  }
79    
80  /* Disconnect from the MCS layer */  /* Output an ASN.1 BER integer */
81  void mcs_disconnect(HCONN conn)  static void ber_out_integer(STREAM s, int value)
82  {  {
83          /* Not complete */          ber_out_header(s, BER_TAG_INTEGER, 2);
84          iso_disconnect(conn);          out_uint16_be(s, value);
85  }  }
86    
87  /* Send a Connect-Initial message */  /* Output a DOMAIN_PARAMS structure (ASN.1 BER) */
88  void mcs_send_connect_initial(HCONN conn)  static void mcs_out_domain_params(STREAM s, int max_channels, int max_users,
89                                      int max_tokens, int max_pdusize)
90  {  {
91          MCS_CONNECT_INITIAL mci;          ber_out_header(s, MCS_TAG_DOMAIN_PARAMS, 32);
92            ber_out_integer(s, max_channels);
93          iso_init(conn);          ber_out_integer(s, max_users);
94          mcs_make_connect_initial(&mci);          ber_out_integer(s, max_tokens);
95          mcs_io_connect_initial(&conn->out, &mci);          ber_out_integer(s, 1);  /* num_priorities */
96          MARK_END(conn->out);          ber_out_integer(s, 0);  /* min_throughput */
97          iso_send(conn);          ber_out_integer(s, 1);  /* max_height */
98            ber_out_integer(s, max_pdusize);
99            ber_out_integer(s, 2);  /* ver_protocol */
100  }  }
101    
102  /* Send a EDrq message */  /* Parse a DOMAIN_PARAMS structure (ASN.1 BER) */
103  void mcs_send_edrq(HCONN conn)  static BOOL mcs_parse_domain_params(STREAM s)
104  {  {
105          MCS_EDRQ edrq;          int length;
   
         iso_init(conn);  
         edrq.height = edrq.interval = 1;  
         mcs_io_edrq(&conn->out, &edrq);  
         MARK_END(conn->out);  
         iso_send(conn);  
 }  
106    
107  /* Send a AUrq message */          ber_parse_header(s, MCS_TAG_DOMAIN_PARAMS, &length);
108  void mcs_send_aurq(HCONN conn)          in_uint8s(s, length);
 {  
         MCS_AURQ aurq;  
109    
110          iso_init(conn);          return s_check(s);
         mcs_io_aurq(&conn->out, &aurq);  
         MARK_END(conn->out);  
         iso_send(conn);  
111  }  }
112    
113  /* Send a CJrq message */  /* Send an MCS_CONNECT_INITIAL message (ASN.1 BER) */
114  void mcs_send_cjrq(HCONN conn, uint16 chanid)  static void mcs_send_connect_initial(STREAM mcs_data)
115  {  {
116          MCS_CJRQ cjrq;          int datalen = mcs_data->end - mcs_data->data;
117            int length = 7 + 3 * 34 + 4 + datalen;
118            STREAM s;
119    
120          iso_init(conn);          s = iso_init(length + 5);
         cjrq.userid = conn->mcs_userid;  
         cjrq.chanid = chanid;  
         mcs_io_cjrq(&conn->out, &cjrq);  
         MARK_END(conn->out);  
         iso_send(conn);  
 }  
121    
122  /* Initialise MCS transport data packet */          ber_out_header(s, MCS_CONNECT_INITIAL, length);
123  void mcs_init_data(HCONN conn)          ber_out_header(s, BER_TAG_OCTET_STRING, 0);     /* calling domain */
124  {          ber_out_header(s, BER_TAG_OCTET_STRING, 0);     /* called domain */
         iso_init(conn);  
         PUSH_LAYER(conn->out, mcs_offset, 8);  
 }  
125    
126  /* Transmit MCS transport data packet */          ber_out_header(s, BER_TAG_BOOLEAN, 1);
127  void mcs_send_data(HCONN conn, uint16 chanid, BOOL request)          out_uint8(s, 0xff);     /* upward flag */
 {  
         MCS_DATA dt;  
128    
129          POP_LAYER(conn->out, mcs_offset);          mcs_out_domain_params(s, 2, 2, 0, 0xffff);      /* target params */
130          dt.userid = conn->mcs_userid;          mcs_out_domain_params(s, 1, 1, 1, 0x420);       /* min params */
131          dt.chanid = chanid;          mcs_out_domain_params(s, 0xffff, 0xfc17, 0xffff, 0xffff);       /* max params */
         dt.flags = 0x70;  
         dt.length = conn->out.end - conn->out.offset - 8;  
         mcs_io_data(&conn->out, &dt, request);  
         iso_send(conn);  
 }  
132    
133  /* Receive a message on the MCS layer */          ber_out_header(s, BER_TAG_OCTET_STRING, datalen);
134  BOOL mcs_recv(HCONN conn, BOOL request)          out_uint8p(s, mcs_data->data, datalen);
 {  
         MCS_DATA data;  
135    
136          return (iso_recv(conn)) && mcs_io_data(&conn->in, &data, request);          s_mark_end(s);
137            iso_send(s);
138  }  }
139    
140  /* Initialise a DOMAIN_PARAMS structure */  /* Expect a MCS_CONNECT_RESPONSE message (ASN.1 BER) */
141  void mcs_make_domain_params(DOMAIN_PARAMS *dp, uint16 max_channels,  static BOOL mcs_recv_connect_response(STREAM mcs_data)
               uint16 max_users, uint16 max_tokens, uint16 max_pdusize)  
142  {  {
143          dp->max_channels   = max_channels;          uint8 result;
144          dp->max_users      = max_users;          int length;
145          dp->max_tokens     = max_tokens;          STREAM s;
         dp->num_priorities = 1;  
         dp->min_throughput = 0;  
         dp->max_height     = 1;  
         dp->max_pdusize    = max_pdusize;  
         dp->ver_protocol   = 2;  
 }  
   
 /* RDP-specific 'user data'. Let's just get this right for now - to be  
    decoded later. */  
 char precanned_connect_userdata[] = {  
    0x00,0x05,0x00,0x14,0x7c,0x00,0x01,0x80,0x9e,0x00,0x08,0x00,0x10,0x00,  
    0x01,0xc0,0x00,0x44,0x75,0x63,0x61,0x80,0x90,0x01,0xc0,0x88,0x00,0x01,  
    0x00,0x08,0x00,0x80,0x02,0xe0,0x01,0x01,0xca,0x03,0xaa,0x09,0x04,0x00,  
    0x00,0xa3,0x01,0x00,0x00,0x52,0x00,0x45,0x00,0x53,0x00,0x31,0x00,0x2d,  
    0x00,0x4e,0x00,0x45,0x00,0x57,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,  
    0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x04,0x00,0x00,0x00,0x00,  
    0x00,0x00,0x00,0x0c,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,  
    0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,  
    0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,  
    0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,  
    0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,  
    0x00,0x01,0xca,0x00,0x00,0x02,0xc0,0x08,0x00,0x00,0x00,0x00,0x00 };  
   
 /* Initialise a MCS_CONNECT_INITIAL structure */  
 void mcs_make_connect_initial(MCS_CONNECT_INITIAL *mci)  
 {  
         mci->calling_domain.length = 0;  
         mci->calling_domain.data = NULL;  
   
         mci->called_domain.length = 0;  
         mci->called_domain.data = NULL;  
   
         mci->upward_flag = 0xff;  
   
         mcs_make_domain_params(&mci->target_params,  2, 2, 0, 0xffff);  
         mcs_make_domain_params(&mci->minimum_params, 1, 1, 1, 0x420);  
         mcs_make_domain_params(&mci->maximum_params, 0xffff, 0xfc17, 0xffff,  
                                0xffff);  
146    
147          mci->user_data.length = sizeof(precanned_connect_userdata);          s = iso_recv();
148          mci->user_data.data = precanned_connect_userdata;          if (s == NULL)
149                    return False;
         mci->length = 2*2 + 3 + 3*34 + 4 + mci->user_data.length;  
 }  
   
 /* Marshall/demarshall an ASN.1 BER header */  
 BOOL ber_io_header(STREAM s, BOOL islong, int tagval, int *length)  
 {  
         uint16 word_tag;  
         uint8 byte_tag;  
         uint16 word_len;  
         uint8 byte_len;  
         uint8 byte_int;  
         int tag;  
         BOOL res;  
150    
151          /* Read/write tag */          ber_parse_header(s, MCS_CONNECT_RESPONSE, &length);
         if (islong) {  
                 word_tag = tagval;  
                 res = msb_io_uint16(s, &word_tag);  
                 tag = word_tag;  
         } else {  
                 byte_tag = tagval;  
                 res = prs_io_uint8(s, &byte_tag);  
                 tag = byte_tag;  
         }  
152    
153          if (!res || (tag != tagval)) {          ber_parse_header(s, BER_TAG_RESULT, &length);
154                  fprintf(stderr, "Invalid ASN.1 tag\n");          in_uint8(s, result);
155            if (result != 0)
156            {
157                    ERROR("MCS connect: %d\n", result);
158                  return False;                  return False;
159          }          }
160    
161          /* Read/write length */          ber_parse_header(s, BER_TAG_INTEGER, &length);
162          if (s->marshall)          in_uint8s(s, length);   /* connect id */
163            mcs_parse_domain_params(s);
164    
165            ber_parse_header(s, BER_TAG_OCTET_STRING, &length);
166            if (length > mcs_data->size)
167          {          {
168                  if (*length >= 0x80)                  WARN("MCS data length %d\n", length);
169                  {                  length = mcs_data->size;
                         byte_len = 0x82;  
                         word_len = (uint16)*length;  
                         res = prs_io_uint8(s, &byte_len);  
                         res = res ? msb_io_uint16(s, &word_len) : False;  
                 }  
                 else  
                 {  
                         byte_len = (uint8)*length;  
                         res = prs_io_uint8(s, &byte_len);  
                 }  
170          }          }
         else  
         {  
                 if (!prs_io_uint8(s, &byte_len))  
                         return False;  
171    
172                  if (byte_len & 0x80)          in_uint8a(s, mcs_data->data, length);
173                  {          mcs_data->p = mcs_data->data;
174                          byte_len &= ~0x80;          mcs_data->end = mcs_data->data + length;
                         *length = 0;  
                         while (byte_len--)  
                         {  
                                 if (!prs_io_uint8(s, &byte_int))  
                                         return False;  
   
                                 *length <<= 8;  
                                 *length += byte_int;  
                         }  
                 }  
                 else *length = byte_len;  
         }  
175    
176          return res;          return s_check_end(s);
177  }  }
178    
179  /* Marshall/demarshall an octet string (ASN.1 BER) */  /* Send an EDrq message (ASN.1 PER) */
180  BOOL ber_io_octet_string(STREAM s, OCTET_STRING *os)  static void mcs_send_edrq()
181  {  {
182          if (!ber_io_header(s, False, 4, &os->length))          STREAM s;
                 return False;  
183    
184          if (os->length > s->end - s->offset)          s = iso_init(5);
                 return False;  
185    
186          if (s->marshall)          out_uint8(s, (MCS_EDRQ << 2));
187          {          out_uint16_be(s, 1);    /* height */
188                  memcpy(s->data + s->offset, os->data, os->length);          out_uint16_be(s, 1);    /* interval */
         }  
         else  
         {  
                 os->data = malloc(os->length);  
                 memcpy(os->data, s->data + s->offset, os->length);  
         }  
189    
190          s->offset += os->length;          s_mark_end(s);
191          return True;          iso_send(s);
192  }  }
193    
194  /* Marshall/demarshall an integer (ASN.1 BER) */  /* Send an AUrq message (ASN.1 PER) */
195  BOOL ber_io_integer(STREAM s, uint16 *word_int)  static void mcs_send_aurq()
196  {  {
197          int length = 2;          STREAM s;
         uint8 byte_int;  
         BOOL res;  
   
         if (!ber_io_header(s, False, 2, &length))  
                 return False;  
198    
199          if (s->marshall)          s = iso_init(1);
         {  
                 res = msb_io_uint16(s, word_int);  
         }  
         else  
         {  
                 *word_int = 0;  
                 while (length--)  
                 {  
                         if (!prs_io_uint8(s, &byte_int))  
                                 return False;  
200    
201                          *word_int <<= 8;          out_uint8(s, (MCS_AURQ << 2));
                         *word_int += byte_int;  
                 }  
         }  
202    
203          return res;          s_mark_end(s);
204            iso_send(s);
205  }  }
206    
207  /* Marshall/demarshall a simple uint8 type (ASN.1 BER) */  /* Expect a AUcf message (ASN.1 PER) */
208  BOOL ber_io_uint8(STREAM s, uint8 *i, int tagval)  static BOOL mcs_recv_aucf(uint16 *mcs_userid)
209  {  {
210          int length = 1;          uint8 opcode, result;
211            STREAM s;
212    
213          if (!ber_io_header(s, False, tagval, &length))          s = iso_recv();
214            if (s == NULL)
215                  return False;                  return False;
216    
217          if (length != 1)          in_uint8(s, opcode);
218            if ((opcode >> 2) != MCS_AUCF)
219          {          {
220                  fprintf(stderr, "Wrong length for simple type\n");                  ERROR("expected AUcf, got %d\n", opcode);
221                  return False;                  return False;
222          }          }
223    
224          return prs_io_uint8(s, i);          in_uint8(s, result);
225  }          if (result != 0)
226            {
227  /* Marshall/demarshall a DOMAIN_PARAMS structure (ASN.1 BER) */                  ERROR("AUrq: %d\n", result);
228  BOOL mcs_io_domain_params(STREAM s, DOMAIN_PARAMS *dp)                  return False;
229  {          }
         int length = 32;  
         BOOL res;  
230    
231          res = ber_io_header(s, False, 0x30, &length);          if (opcode & 2)
232          res = res ? ber_io_integer(s, &dp->max_channels  ) : False;                  in_uint16_be(s, *mcs_userid);
         res = res ? ber_io_integer(s, &dp->max_users     ) : False;  
         res = res ? ber_io_integer(s, &dp->max_tokens    ) : False;  
         res = res ? ber_io_integer(s, &dp->num_priorities) : False;  
         res = res ? ber_io_integer(s, &dp->min_throughput) : False;  
         res = res ? ber_io_integer(s, &dp->max_height    ) : False;  
         res = res ? ber_io_integer(s, &dp->max_pdusize   ) : False;  
         res = res ? ber_io_integer(s, &dp->ver_protocol  ) : False;  
233    
234          return res;          return s_check_end(s);
235  }  }
236    
237  /* Marshall/demarshall a MCS_CONNECT_INITIAL structure (ASN.1 BER) */  /* Send a CJrq message (ASN.1 PER) */
238  BOOL mcs_io_connect_initial(STREAM s, MCS_CONNECT_INITIAL *mci)  static void mcs_send_cjrq(uint16 chanid)
239  {  {
240          BOOL res;          STREAM s;
241    
242          res = ber_io_header(s, True, 0x7f65, &mci->length);          s = iso_init(5);
         res = res ? ber_io_octet_string (s, &mci->calling_domain) : False;  
         res = res ? ber_io_octet_string (s, &mci->called_domain ) : False;  
         res = res ? ber_io_uint8        (s, &mci->upward_flag, 1) : False;  
         res = res ? mcs_io_domain_params(s, &mci->target_params ) : False;  
         res = res ? mcs_io_domain_params(s, &mci->minimum_params) : False;  
         res = res ? mcs_io_domain_params(s, &mci->maximum_params) : False;  
         res = res ? ber_io_octet_string (s, &mci->user_data     ) : False;  
243    
244          return res;          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  }  }
251    
252  /* Marshall/demarshall a MCS_CONNECT_RESPONSE structure (ASN.1 BER) */  /* Expect a CJcf message (ASN.1 PER) */
253  BOOL mcs_io_connect_response(STREAM s, MCS_CONNECT_RESPONSE *mcr)  static BOOL mcs_recv_cjcf()
254  {  {
255          BOOL res;          uint8 opcode, result;
256            STREAM s;
         res = ber_io_header(s, True, 0x7f66, &mcr->length);  
         res = res ? ber_io_uint8        (s, &mcr->result, 10   ) : False;  
         res = res ? ber_io_integer      (s, &mcr->connect_id   ) : False;  
         res = res ? mcs_io_domain_params(s, &mcr->domain_params) : False;  
         res = res ? ber_io_octet_string (s, &mcr->user_data    ) : False;  
257    
258          return res;          s = iso_recv();
259  }          if (s == NULL)
260                    return False;
261    
262  /* Marshall/demarshall an EDrq structure (ASN.1 PER) */          in_uint8(s, opcode);
263  BOOL mcs_io_edrq(STREAM s, MCS_EDRQ *edrq)          if ((opcode >> 2) != MCS_CJCF)
264  {          {
265          uint8 opcode = (1) << 2;                  ERROR("expected CJcf, got %d\n", opcode);
266          uint8 pkt_opcode = opcode;                  return False;
267          BOOL res;          }
268    
269          res = prs_io_uint8(s, &pkt_opcode);          in_uint8(s, result);
270          if (pkt_opcode != opcode)          if (result != 0)
271          {          {
272                  fprintf(stderr, "Expected EDrq, received %x\n", pkt_opcode);                  ERROR("CJrq: %d\n", result);
273                  return False;                  return False;
274          }          }
275    
276          res = res ? msb_io_uint16(s, &edrq->height  ) : False;          in_uint8s(s, 4);        /* mcs_userid, req_chanid */
277          res = res ? msb_io_uint16(s, &edrq->interval) : False;          if (opcode & 2)
278                    in_uint8s(s, 2);        /* join_chanid */
279    
280          return res;          return s_check_end(s);
281  }  }
282    
283  /* Marshall/demarshall an AUrq structure (ASN.1 PER) */  /* Initialise an MCS transport data packet */
284  BOOL mcs_io_aurq(STREAM s, MCS_AURQ *aurq)  STREAM mcs_init(int length)
285  {  {
286          uint8 opcode = (10) << 2;          STREAM s;
         uint8 pkt_opcode = opcode;  
         BOOL res;  
287    
288          res = prs_io_uint8(s, &pkt_opcode);          s = iso_init(length + 8);
289          if (pkt_opcode != opcode)          s_push_layer(s, mcs_hdr, 8);
         {  
                 fprintf(stderr, "Expected AUrq, received %x\n", pkt_opcode);  
                 return False;  
         }  
290    
291          return res;          return s;
292  }  }
293    
294  /* Marshall/demarshall an AUcf structure (ASN.1 PER) */  /* Send an MCS transport data packet */
295  BOOL mcs_io_aucf(STREAM s, MCS_AUCF *aucf)  void mcs_send(STREAM s)
296  {  {
297          uint8 opcode = (11) << 2;          uint16 length;
         uint8 pkt_opcode = opcode | 2;  
         BOOL res;  
298    
299          res = prs_io_uint8(s, &pkt_opcode);          s_pop_layer(s, mcs_hdr);
300          if ((pkt_opcode & 0xfc) != opcode)          length = s->end - s->p - 8;
301          {          length |= 0x8000;
                 fprintf(stderr, "Expected AUcf, received %x\n", pkt_opcode);  
                 return False;  
         }  
302    
303          res = res ? prs_io_uint8 (s, &aucf->result) : False;          out_uint8(s, (MCS_SDRQ << 2));
304          if (pkt_opcode & 2)          out_uint16_be(s, mcs_userid);
305                  res = res ? msb_io_uint16(s, &aucf->userid) : False;          out_uint16_be(s, MCS_GLOBAL_CHANNEL);
306            out_uint8(s, 0x70);     /* flags */
307            out_uint16_be(s, length);
308    
309          return res;          iso_send(s);
310  }  }
311    
312  /* Marshall/demarshall an CJrq structure (ASN.1 PER) */  /* Receive an MCS transport data packet */
313  BOOL mcs_io_cjrq(STREAM s, MCS_CJRQ *cjrq)  STREAM mcs_recv()
314  {  {
315          uint8 opcode = (14) << 2;          uint8 opcode, appid, length;
316          uint8 pkt_opcode = opcode;          STREAM s;
317          BOOL res;  
318            s = iso_recv();
319            if (s == NULL)
320                    return NULL;
321    
322          res = prs_io_uint8(s, &pkt_opcode);          in_uint8(s, opcode);
323          if (pkt_opcode != opcode)          appid = opcode >> 2;
324            if (appid != MCS_SDIN)
325          {          {
326                  fprintf(stderr, "Expected CJrq, received %x\n", pkt_opcode);                  if (appid != MCS_DPUM)
327                  return False;                  {
328                            ERROR("expected data, got %d\n", opcode);
329                    }
330                    return NULL;
331          }          }
332    
333          res = res ? msb_io_uint16(s, &cjrq->userid) : False;          in_uint8s(s, 5);        /* userid, chanid, flags */
334          res = res ? msb_io_uint16(s, &cjrq->chanid) : False;          in_uint8(s, length);
335            if (length & 0x80)
336                    in_uint8s(s, 1);        /* second byte of length */
337    
338          return res;          return s;
339  }  }
340    
341  /* Marshall/demarshall an CJcf structure (ASN.1 PER) */  /* Establish a connection up to the MCS layer */
342  BOOL mcs_io_cjcf(STREAM s, MCS_CJCF *cjcf)  BOOL mcs_connect(char *server, STREAM mcs_data)
343  {  {
344          uint8 opcode = (15) << 2;          if (!iso_connect(server))
         uint8 pkt_opcode = opcode | 2;  
         BOOL res;  
   
         res = prs_io_uint8(s, &pkt_opcode);  
         if ((pkt_opcode & 0xfc) != opcode)  
         {  
                 fprintf(stderr, "Expected CJcf, received %x\n", pkt_opcode);  
345                  return False;                  return False;
         }  
346    
347          res = res ? prs_io_uint8 (s, &cjcf->result) : False;          mcs_send_connect_initial(mcs_data);
348          res = res ? msb_io_uint16(s, &cjcf->userid) : False;          if (!mcs_recv_connect_response(mcs_data))
349          res = res ? msb_io_uint16(s, &cjcf->req_chanid) : False;                  goto error;
         if (pkt_opcode & 2)  
                 res = res ? msb_io_uint16(s, &cjcf->join_chanid) : False;  
350    
351          return res;          mcs_send_edrq();
 }  
352    
353  /* Marshall/demarshall an SDrq or SDin packet (ASN.1 PER) */          mcs_send_aurq();
354  BOOL mcs_io_data(STREAM s, MCS_DATA *dt, BOOL request)          if (!mcs_recv_aucf(&mcs_userid))
355  {                  goto error;
         uint8 opcode = (request ? 25 : 26) << 2;  
         uint8 pkt_opcode = opcode;  
         BOOL res;  
356    
357          res = prs_io_uint8(s, &pkt_opcode);          mcs_send_cjrq(mcs_userid + 1001);
358          if (pkt_opcode != opcode)          if (!mcs_recv_cjcf())
359          {                  goto error;
                 fprintf(stderr, "Expected MCS data, received %x\n", pkt_opcode);  
                 return False;  
         }  
360    
361          dt->length |= 0x8000;          mcs_send_cjrq(MCS_GLOBAL_CHANNEL);
362            if (!mcs_recv_cjcf())
363                    goto error;
364    
365          res = res ? msb_io_uint16(s, &dt->userid) : False;          return True;
         res = res ? msb_io_uint16(s, &dt->chanid) : False;  
         res = res ? prs_io_uint8 (s, &dt->flags ) : False;  
         res = res ? msb_io_uint16(s, &dt->length) : False;  
366    
367          return res;        error:
368            iso_disconnect();
369            return False;
370    }
371    
372    /* Disconnect from the MCS layer */
373    void mcs_disconnect()
374    {
375            iso_disconnect();
376  }  }
Legend:
Removed from v.3  
changed lines
  Added in v.24
  ViewVC Help
Powered by ViewVC 1.1.26