--- sourceforge.net/branches/RDESKTOP/rdesktop/mcs.c 2000/05/10 07:36:34 3 +++ sourceforge.net/trunk/rdesktop/mcs.c 2004/07/05 19:09:07 733 @@ -1,7 +1,7 @@ -/* +/* -*- c-basic-offset: 8 -*- rdesktop: A Remote Desktop Protocol client. Protocol services - Multipoint Communications Service - Copyright (C) Matthew Chapman 1999-2000 + Copyright (C) Matthew Chapman 1999-2002 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 @@ -18,527 +18,403 @@ Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ -#include "includes.h" +#include "rdesktop.h" -/* Establish a connection up to the MCS layer */ -HCONN mcs_connect(char *server) -{ - HCONN conn; - MCS_CONNECT_RESPONSE mcr; - MCS_AUCF aucf; +uint16 g_mcs_userid; +extern VCHANNEL g_channels[]; +extern unsigned int g_num_channels; - if ((conn = iso_connect(server)) == NULL) - return NULL; +/* Parse an ASN.1 BER header */ +static BOOL +ber_parse_header(STREAM s, int tagval, int *length) +{ + int tag, len; - mcs_send_connect_initial(conn); - if (!iso_recv(conn) || !mcs_io_connect_response(&conn->in, &mcr)) + if (tagval > 0xff) { - fprintf(stderr, "MCS error, expected Connect-Response\n"); - iso_disconnect(conn); - return NULL; + in_uint16_be(s, tag); } - - 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)) + else { - fprintf(stderr, "MCS error, expected AUcf\n"); - mcs_disconnect(conn); - return NULL; - } + in_uint8(s, tag)} - if (aucf.result != 0) + if (tag != tagval) { - fprintf(stderr, "AUrq failed, result %d\n", mcr.result); - mcs_disconnect(conn); - return NULL; + error("expected tag %d, got %d\n", tagval, tag); + return False; } - conn->mcs_userid = aucf.userid; + in_uint8(s, len); - if (!mcs_join_channel(conn, aucf.userid + 1001) - || !mcs_join_channel(conn, MCS_GLOBAL_CHANNEL)) + if (len & 0x80) { - mcs_disconnect(conn); - return NULL; + len &= ~0x80; + *length = 0; + while (len--) + next_be(s, *length); } + else + *length = len; - return conn; + return s_check(s); } -BOOL mcs_join_channel(HCONN conn, uint16 chanid) +/* Output an ASN.1 BER header */ +static void +ber_out_header(STREAM s, int tagval, int length) { - MCS_CJCF cjcf; - - mcs_send_cjrq(conn, chanid); - if (!iso_recv(conn) || !mcs_io_cjcf(&conn->in, &cjcf)) + if (tagval > 0xff) { - fprintf(stderr, "MCS error, expected CJcf\n"); - return False; + out_uint16_be(s, tagval); } - - if (cjcf.result != 0) + else { - fprintf(stderr, "CJrq failed, result %d\n", cjcf.result); - return False; + out_uint8(s, tagval); } - return True; + if (length >= 0x80) + { + out_uint8(s, 0x82); + out_uint16_be(s, length); + } + else + out_uint8(s, length); } -/* Disconnect from the MCS layer */ -void mcs_disconnect(HCONN conn) +/* Output an ASN.1 BER integer */ +static void +ber_out_integer(STREAM s, int value) { - /* Not complete */ - iso_disconnect(conn); + ber_out_header(s, BER_TAG_INTEGER, 2); + out_uint16_be(s, value); } -/* Send a Connect-Initial message */ -void mcs_send_connect_initial(HCONN conn) +/* 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) { - MCS_CONNECT_INITIAL mci; - - iso_init(conn); - mcs_make_connect_initial(&mci); - mcs_io_connect_initial(&conn->out, &mci); - MARK_END(conn->out); - iso_send(conn); + 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 */ } -/* Send a EDrq message */ -void mcs_send_edrq(HCONN conn) +/* Parse a DOMAIN_PARAMS structure (ASN.1 BER) */ +static BOOL +mcs_parse_domain_params(STREAM s) { - 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); -} + ber_parse_header(s, MCS_TAG_DOMAIN_PARAMS, &length); + in_uint8s(s, length); -/* Send a AUrq message */ -void mcs_send_aurq(HCONN conn) -{ - MCS_AURQ aurq; - - iso_init(conn); - mcs_io_aurq(&conn->out, &aurq); - MARK_END(conn->out); - iso_send(conn); + return s_check(s); } -/* Send a CJrq message */ -void mcs_send_cjrq(HCONN conn, uint16 chanid) +/* Send an MCS_CONNECT_INITIAL message (ASN.1 BER) */ +static void +mcs_send_connect_initial(STREAM mcs_data) { - MCS_CJRQ cjrq; + int datalen = mcs_data->end - mcs_data->data; + int length = 9 + 3 * 34 + 4 + datalen; + STREAM s; - iso_init(conn); - cjrq.userid = conn->mcs_userid; - cjrq.chanid = chanid; - mcs_io_cjrq(&conn->out, &cjrq); - MARK_END(conn->out); - iso_send(conn); -} + s = iso_init(length + 5); -/* Initialise MCS transport data packet */ -void mcs_init_data(HCONN conn) -{ - iso_init(conn); - PUSH_LAYER(conn->out, mcs_offset, 8); -} + ber_out_header(s, MCS_CONNECT_INITIAL, length); + ber_out_header(s, BER_TAG_OCTET_STRING, 1); /* calling domain */ + out_uint8(s, 1); + ber_out_header(s, BER_TAG_OCTET_STRING, 1); /* called domain */ + out_uint8(s, 1); -/* Transmit MCS transport data packet */ -void mcs_send_data(HCONN conn, uint16 chanid, BOOL request) -{ - MCS_DATA dt; + ber_out_header(s, BER_TAG_BOOLEAN, 1); + out_uint8(s, 0xff); /* upward flag */ - POP_LAYER(conn->out, mcs_offset); - dt.userid = conn->mcs_userid; - dt.chanid = chanid; - dt.flags = 0x70; - dt.length = conn->out.end - conn->out.offset - 8; - mcs_io_data(&conn->out, &dt, request); - iso_send(conn); -} + mcs_out_domain_params(s, 34, 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 */ -/* Receive a message on the MCS layer */ -BOOL mcs_recv(HCONN conn, BOOL request) -{ - MCS_DATA data; + ber_out_header(s, BER_TAG_OCTET_STRING, datalen); + out_uint8p(s, mcs_data->data, datalen); - return (iso_recv(conn)) && mcs_io_data(&conn->in, &data, request); + s_mark_end(s); + iso_send(s); } -/* Initialise a DOMAIN_PARAMS structure */ -void mcs_make_domain_params(DOMAIN_PARAMS *dp, uint16 max_channels, - uint16 max_users, uint16 max_tokens, uint16 max_pdusize) +/* Expect a MCS_CONNECT_RESPONSE message (ASN.1 BER) */ +static BOOL +mcs_recv_connect_response(STREAM mcs_data) { - dp->max_channels = max_channels; - dp->max_users = max_users; - dp->max_tokens = max_tokens; - dp->num_priorities = 1; - dp->min_throughput = 0; - dp->max_height = 1; - dp->max_pdusize = max_pdusize; - dp->ver_protocol = 2; -} + uint8 result; + int length; + STREAM s; -/* 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 }; + s = iso_recv(NULL); + if (s == NULL) + return False; -/* 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; + ber_parse_header(s, MCS_CONNECT_RESPONSE, &length); - mci->called_domain.length = 0; - mci->called_domain.data = NULL; + ber_parse_header(s, BER_TAG_RESULT, &length); + in_uint8(s, result); + if (result != 0) + { + error("MCS connect: %d\n", result); + return False; + } - mci->upward_flag = 0xff; + ber_parse_header(s, BER_TAG_INTEGER, &length); + in_uint8s(s, length); /* connect id */ + mcs_parse_domain_params(s); - 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); + ber_parse_header(s, BER_TAG_OCTET_STRING, &length); - mci->user_data.length = sizeof(precanned_connect_userdata); - mci->user_data.data = precanned_connect_userdata; + sec_process_mcs_data(s); + /* + if (length > mcs_data->size) + { + error("MCS data length %d, expected %d\n", length, + mcs_data->size); + length = mcs_data->size; + } - mci->length = 2*2 + 3 + 3*34 + 4 + mci->user_data.length; + 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); } -/* Marshall/demarshall an ASN.1 BER header */ -BOOL ber_io_header(STREAM s, BOOL islong, int tagval, int *length) +/* Send an EDrq message (ASN.1 PER) */ +static void +mcs_send_edrq(void) { - uint16 word_tag; - uint8 byte_tag; - uint16 word_len; - uint8 byte_len; - uint8 byte_int; - int tag; - BOOL res; + STREAM s; - /* Read/write tag */ - 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; - } + s = iso_init(5); - if (!res || (tag != tagval)) { - fprintf(stderr, "Invalid ASN.1 tag\n"); - return False; - } + out_uint8(s, (MCS_EDRQ << 2)); + out_uint16_be(s, 1); /* height */ + out_uint16_be(s, 1); /* interval */ - /* Read/write length */ - if (s->marshall) - { - if (*length >= 0x80) - { - 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); - } - } - else - { - if (!prs_io_uint8(s, &byte_len)) - return False; + s_mark_end(s); + iso_send(s); +} - if (byte_len & 0x80) - { - byte_len &= ~0x80; - *length = 0; - while (byte_len--) - { - if (!prs_io_uint8(s, &byte_int)) - return False; - - *length <<= 8; - *length += byte_int; - } - } - else *length = byte_len; - } +/* Send an AUrq message (ASN.1 PER) */ +static void +mcs_send_aurq(void) +{ + STREAM s; + + s = iso_init(1); - return res; + out_uint8(s, (MCS_AURQ << 2)); + + s_mark_end(s); + iso_send(s); } -/* Marshall/demarshall an octet string (ASN.1 BER) */ -BOOL ber_io_octet_string(STREAM s, OCTET_STRING *os) +/* Expect a AUcf message (ASN.1 PER) */ +static BOOL +mcs_recv_aucf(uint16 * mcs_userid) { - if (!ber_io_header(s, False, 4, &os->length)) - return False; + uint8 opcode, result; + STREAM s; - if (os->length > s->end - s->offset) + s = iso_recv(NULL); + if (s == NULL) return False; - if (s->marshall) + in_uint8(s, opcode); + if ((opcode >> 2) != MCS_AUCF) { - memcpy(s->data + s->offset, os->data, os->length); + error("expected AUcf, got %d\n", opcode); + return False; } - else + + in_uint8(s, result); + if (result != 0) { - os->data = malloc(os->length); - memcpy(os->data, s->data + s->offset, os->length); + error("AUrq: %d\n", result); + return False; } - s->offset += os->length; - return True; + if (opcode & 2) + in_uint16_be(s, *mcs_userid); + + return s_check_end(s); } -/* Marshall/demarshall an integer (ASN.1 BER) */ -BOOL ber_io_integer(STREAM s, uint16 *word_int) +/* Send a CJrq message (ASN.1 PER) */ +static void +mcs_send_cjrq(uint16 chanid) { - int length = 2; - uint8 byte_int; - BOOL res; + STREAM s; - if (!ber_io_header(s, False, 2, &length)) - return False; + DEBUG_RDP5(("Sending CJRQ for channel #%d\n", chanid)); - if (s->marshall) - { - res = msb_io_uint16(s, word_int); - } - else - { - *word_int = 0; - while (length--) - { - if (!prs_io_uint8(s, &byte_int)) - return False; + s = iso_init(5); - *word_int <<= 8; - *word_int += byte_int; - } - } + out_uint8(s, (MCS_CJRQ << 2)); + out_uint16_be(s, g_mcs_userid); + out_uint16_be(s, chanid); - return res; + s_mark_end(s); + iso_send(s); } -/* Marshall/demarshall a simple uint8 type (ASN.1 BER) */ -BOOL ber_io_uint8(STREAM s, uint8 *i, int tagval) +/* Expect a CJcf message (ASN.1 PER) */ +static BOOL +mcs_recv_cjcf(void) { - int length = 1; + uint8 opcode, result; + STREAM s; - if (!ber_io_header(s, False, tagval, &length)) + s = iso_recv(NULL); + if (s == NULL) return False; - if (length != 1) + in_uint8(s, opcode); + if ((opcode >> 2) != MCS_CJCF) { - fprintf(stderr, "Wrong length for simple type\n"); + error("expected CJcf, got %d\n", opcode); return False; } - return prs_io_uint8(s, i); -} - -/* Marshall/demarshall a DOMAIN_PARAMS structure (ASN.1 BER) */ -BOOL mcs_io_domain_params(STREAM s, DOMAIN_PARAMS *dp) -{ - int length = 32; - BOOL res; + in_uint8(s, result); + if (result != 0) + { + error("CJrq: %d\n", result); + return False; + } - res = ber_io_header(s, False, 0x30, &length); - res = res ? ber_io_integer(s, &dp->max_channels ) : False; - 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; + in_uint8s(s, 4); /* mcs_userid, req_chanid */ + if (opcode & 2) + in_uint8s(s, 2); /* join_chanid */ - return res; + return s_check_end(s); } -/* Marshall/demarshall a MCS_CONNECT_INITIAL structure (ASN.1 BER) */ -BOOL mcs_io_connect_initial(STREAM s, MCS_CONNECT_INITIAL *mci) +/* Initialise an MCS transport data packet */ +STREAM +mcs_init(int length) { - BOOL res; + STREAM s; - res = ber_io_header(s, True, 0x7f65, &mci->length); - 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; + s = iso_init(length + 8); + s_push_layer(s, mcs_hdr, 8); - return res; + return s; } -/* Marshall/demarshall a MCS_CONNECT_RESPONSE structure (ASN.1 BER) */ -BOOL mcs_io_connect_response(STREAM s, MCS_CONNECT_RESPONSE *mcr) +/* Send an MCS transport data packet to a specific channel */ +void +mcs_send_to_channel(STREAM s, uint16 channel) { - BOOL res; + uint16 length; + + s_pop_layer(s, mcs_hdr); + length = s->end - s->p - 8; + length |= 0x8000; - 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; + out_uint8(s, (MCS_SDRQ << 2)); + out_uint16_be(s, g_mcs_userid); + out_uint16_be(s, channel); + out_uint8(s, 0x70); /* flags */ + out_uint16_be(s, length); - return res; + iso_send(s); } -/* Marshall/demarshall an EDrq structure (ASN.1 PER) */ -BOOL mcs_io_edrq(STREAM s, MCS_EDRQ *edrq) +/* Send an MCS transport data packet to the global channel */ +void +mcs_send(STREAM s) { - uint8 opcode = (1) << 2; - uint8 pkt_opcode = opcode; - BOOL res; - - res = prs_io_uint8(s, &pkt_opcode); - if (pkt_opcode != opcode) - { - fprintf(stderr, "Expected EDrq, received %x\n", pkt_opcode); - return False; - } - - res = res ? msb_io_uint16(s, &edrq->height ) : False; - res = res ? msb_io_uint16(s, &edrq->interval) : False; - - return res; + mcs_send_to_channel(s, MCS_GLOBAL_CHANNEL); } -/* Marshall/demarshall an AUrq structure (ASN.1 PER) */ -BOOL mcs_io_aurq(STREAM s, MCS_AURQ *aurq) +/* Receive an MCS transport data packet */ +STREAM +mcs_recv(uint16 * channel, uint8 * rdpver) { - uint8 opcode = (10) << 2; - uint8 pkt_opcode = opcode; - BOOL res; + uint8 opcode, appid, length; + STREAM s; - res = prs_io_uint8(s, &pkt_opcode); - if (pkt_opcode != opcode) + s = iso_recv(rdpver); + if (s == NULL) + return NULL; + if (rdpver != NULL) + if (*rdpver != 3) + return s; + in_uint8(s, opcode); + appid = opcode >> 2; + if (appid != MCS_SDIN) { - fprintf(stderr, "Expected AUrq, received %x\n", pkt_opcode); - return False; + if (appid != MCS_DPUM) + { + error("expected data, got %d\n", opcode); + } + return NULL; } - - return res; + in_uint8s(s, 2); /* userid */ + in_uint16_be(s, *channel); + in_uint8s(s, 1); /* flags */ + in_uint8(s, length); + if (length & 0x80) + in_uint8s(s, 1); /* second byte of length */ + return s; } -/* Marshall/demarshall an AUcf structure (ASN.1 PER) */ -BOOL mcs_io_aucf(STREAM s, MCS_AUCF *aucf) +/* Establish a connection up to the MCS layer */ +BOOL +mcs_connect(char *server, STREAM mcs_data, char *username) { - uint8 opcode = (11) << 2; - uint8 pkt_opcode = opcode | 2; - BOOL res; + unsigned int i; - res = prs_io_uint8(s, &pkt_opcode); - if ((pkt_opcode & 0xfc) != opcode) - { - fprintf(stderr, "Expected AUcf, received %x\n", pkt_opcode); + if (!iso_connect(server, username)) return False; - } - res = res ? prs_io_uint8 (s, &aucf->result) : False; - if (pkt_opcode & 2) - res = res ? msb_io_uint16(s, &aucf->userid) : False; + mcs_send_connect_initial(mcs_data); + if (!mcs_recv_connect_response(mcs_data)) + goto error; - return res; -} + mcs_send_edrq(); -/* Marshall/demarshall an CJrq structure (ASN.1 PER) */ -BOOL mcs_io_cjrq(STREAM s, MCS_CJRQ *cjrq) -{ - uint8 opcode = (14) << 2; - uint8 pkt_opcode = opcode; - BOOL res; + mcs_send_aurq(); + if (!mcs_recv_aucf(&g_mcs_userid)) + goto error; - res = prs_io_uint8(s, &pkt_opcode); - if (pkt_opcode != opcode) - { - fprintf(stderr, "Expected CJrq, received %x\n", pkt_opcode); - return False; - } + mcs_send_cjrq(g_mcs_userid + MCS_USERCHANNEL_BASE); - res = res ? msb_io_uint16(s, &cjrq->userid) : False; - res = res ? msb_io_uint16(s, &cjrq->chanid) : False; + if (!mcs_recv_cjcf()) + goto error; - return res; -} - -/* Marshall/demarshall an CJcf structure (ASN.1 PER) */ -BOOL mcs_io_cjcf(STREAM s, MCS_CJCF *cjcf) -{ - uint8 opcode = (15) << 2; - uint8 pkt_opcode = opcode | 2; - BOOL res; + mcs_send_cjrq(MCS_GLOBAL_CHANNEL); + if (!mcs_recv_cjcf()) + goto error; - res = prs_io_uint8(s, &pkt_opcode); - if ((pkt_opcode & 0xfc) != opcode) + for (i = 0; i < g_num_channels; i++) { - fprintf(stderr, "Expected CJcf, received %x\n", pkt_opcode); - return False; + mcs_send_cjrq(g_channels[i].mcs_id); + if (!mcs_recv_cjcf()) + goto error; } + return True; - res = res ? prs_io_uint8 (s, &cjcf->result) : False; - res = res ? msb_io_uint16(s, &cjcf->userid) : False; - res = res ? msb_io_uint16(s, &cjcf->req_chanid) : False; - if (pkt_opcode & 2) - res = res ? msb_io_uint16(s, &cjcf->join_chanid) : False; - - return res; + error: + iso_disconnect(); + return False; } -/* Marshall/demarshall an SDrq or SDin packet (ASN.1 PER) */ -BOOL mcs_io_data(STREAM s, MCS_DATA *dt, BOOL request) +/* Disconnect from the MCS layer */ +void +mcs_disconnect(void) { - uint8 opcode = (request ? 25 : 26) << 2; - uint8 pkt_opcode = opcode; - BOOL res; - - res = prs_io_uint8(s, &pkt_opcode); - if (pkt_opcode != opcode) - { - fprintf(stderr, "Expected MCS data, received %x\n", pkt_opcode); - return False; - } - - dt->length |= 0x8000; - - res = res ? msb_io_uint16(s, &dt->userid) : False; - 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; - - return res; + iso_disconnect(); }