obex_connect.c

来自「sparc硬件平台上的红外协议」· C语言 代码 · 共 118 行

/*********************************************************************
*                
* Filename:      obex_connect.c
* Version:       0.9
* Description:   Parse and create connect-command.
* Status:        Stable
* Author:        Dag Brattli <[e-mail]>
* Created at:    Wed May  5 11:53:44 1999
* CVS ID:        $Id: obex_connect.c,v 1.9 2006/05/04 11:24:21 holtmann Exp $
* 
*     Copyright (c) 2000 Pontus Fuchs, All Rights Reserved.
*     Copyright (c) 1999 Dag Brattli, All Rights Reserved.
*     
*     This library is free software; you can redistribute it and/or
*     modify it under the terms of the GNU Lesser General Public
*     License as published by the Free Software Foundation; either
*     version 2 of the License, or (at your option) any later version.
*
*     This library 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
*     Lesser General Public License for more details.
*
*     You should have received a copy of the GNU Lesser General Public
*     License along with this library; if not, write to the Free Software
*     Foundation, Inc., 59 Temple Place, Suite 330, Boston, 
*     MA  02111-1307  USA
*     
********************************************************************/


#include <stdio.h>
#include <string.h>

#include "obex_main.h"
#include "obex_object.h"
#include "obex_header.h"

#include "obex_connect.h"
#include "types.h"
/*
* Function obex_insert_connectframe ()
*
*    Add the data needed to send/reply to a connect
*
*/
int obex_insert_connectframe(obex_t *self, obex_object_t *object)
{
	obex_connect_hdr_t *conn_hdr;
	
	DEBUG(4, "\n");
	
	object->tx_nonhdr_data = buf_new(4);
	if(!object->tx_nonhdr_data) 
		return -1;
	conn_hdr = (obex_connect_hdr_t *) buf_reserve_end(object->tx_nonhdr_data, 4);
	conn_hdr->version = OBEX_VERSION; 
	conn_hdr->flags = 0x00;              /* Flags */
	//modify by xugangan
	conn_hdr->mtu = htons(self->mtu_rx); /* Max packet size */
	
	return 0;
}

/*
* Function obex_parse_connect_header ()
*
*    Parse a Connect
*
*/
int obex_parse_connect_header(obex_t *self, buf_t *msg)
{
	obex_connect_hdr_t *conn_hdr;
	obex_common_hdr_t *common_hdr;
	
	uint8_t version;
	int flags;
	uint16_t mtu;  /* Maximum send data unit */
	uint8_t opcode;
	uint16_t length;
	
	DEBUG(4, "\n");
	
	/* Remember opcode and size for later */
	common_hdr = (obex_common_hdr_t *) msg->data;
	opcode = common_hdr->opcode;
	//modify by xugangan
	length = ntohs(common_hdr->len);
	
	
	/* Parse beyond 3 bytes only if response is success */
	if( (opcode != (OBEX_RSP_SUCCESS | OBEX_FINAL)) && (opcode != (OBEX_CMD_CONNECT | OBEX_FINAL)))
		return 1;
	
	DEBUG(4, "Len: %d\n", msg->data_size);
	if(msg->data_size >= 7) {
		/* Get what we need */
		conn_hdr = (obex_connect_hdr_t *) ((msg->data) + 3);
		version = conn_hdr->version;
		flags   = conn_hdr->flags;
		//modify by xugangan
		mtu     = ntohs(conn_hdr->mtu);
		
		DEBUG(1, "version=%02x\n", version);
		
		/* Limit to some reasonable value (usually OBEX_DEFAULT_MTU) */
		if(mtu < self->mtu_tx_max)
			self->mtu_tx = mtu;
		else
			self->mtu_tx = self->mtu_tx_max;
		
		DEBUG(1, "requested MTU=%02x, used MTU=%02x\n", mtu, self->mtu_tx);
		return 1;
	}
	DEBUG(1, "Malformed connect-header received\n");
	return -1;
}