obex.c

来自「linux操作系统下的红外驱动的测试程序」· C语言 代码 · 共 338 行

/*********************************************************************
 *                
 * Filename:      obex.c
 * Version:       
 * Description:   
 * Status:        Experimental.
 * Author:        Dag Brattli <[e-mail]>
 * Created at:    Wed Mar 31 14:09:47 1999
 * Modified at:   Wed Apr 21 15:52:03 1999
 * Modified by:   Dag Brattli <[e-mail]>
 * 
 *     Copyright (c) 1999 Dag Brattli, All Rights Reserved.
 *     Copyright (c) 1999 Jean Tourrilhes, All Rights Reserved.
 *     
 *     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., 59 Temple Place, Suite 330, Boston, 
 *     MA 02111-1307 USA
 *     
 ********************************************************************/

#include "irdadump.h"
#include "obex.h"

#include <stdio.h>
#include <string.h>
#include <netinet/in.h>		/* ntohs */

void unicode_to_char(guint8 *buf)
{
	guint8 *buf2 = buf;
	int n=0;
	
	while ((buf2[n] = buf[n*2+1]))
		n++;
}

/*
 * Function parse_obex_header (buf)
 *
 *    
 *
 */
int parse_obex_header(GNetBuf *buf, GString *str, int istext)
{
	char string[255];
	guint32 tmp_int;
	guint16 tmp_short;
	int len = 0;

	/* g_print("%s()", __FUNCTION__);fflush(stdout); */

	switch (buf->data[0] & OBEX_HI_MASK) {
	case OBEX_UNICODE:
		/* g_print("OBEX_UNICODE");fflush(stdout); */
		memcpy(&tmp_short, buf->data+1, 2); /* Align value */
		tmp_short = GINT16_FROM_BE(tmp_short) - 3;
		len += 3;
		
		memcpy(string, buf->data+3, tmp_short);
		unicode_to_char(string);
		len += tmp_short;

		/* g_print("%s ", string);fflush(stdout); */
		g_string_sprintfa(str, "\"%s\" ", string);
		break;
	case OBEX_BYTE_STREAM:
                /* g_print("OBEX_BYTE_STREAM");fflush(stdout); */
		memcpy(&tmp_short, buf->data+1, 2); /* Align value */
		tmp_short = GINT16_FROM_BE(tmp_short) - 3;
		len += tmp_short + 3;
		if(istext) {
			memcpy(string, buf->data+3, tmp_short);
			string[tmp_short] = '\0';
			g_string_sprintfa(str, "\"%s\" ", string);
		} else
			g_string_sprintfa(str, "[%d bytes] ", tmp_short);
		break;
	case OBEX_BYTE:
		/* g_print("OBEX_BYTE");fflush(stdout); */
		g_string_sprintfa(str, "%d ", buf->data[0]);
                len += 2;
		break;
	case OBEX_INT:
		/* g_print("OBEX_INT");fflush(stdout); */
		memcpy(&tmp_int, buf->data+1, 4); /* Align value */
		len += 5;
		/* printf("%ld ", ntohl(tmp_int));fflush(stdout); */
		g_string_sprintfa(str, "%d ", GINT32_FROM_BE(tmp_int));
		break;
	default:
		g_print("******");fflush(stdout);
		break;
	}
	
	return len;
}

/*
 * Function parse_obex_put (buf)
 *
 *    Parse an OBEX put command
 *
 */
inline void parse_obex_headers(GNetBuf *buf, GString *str)
{
	struct obex_minimal_frame *frame;
	int final;
	guint16 size;
	int len;

	frame = (struct obex_minimal_frame *) buf->data;

	/* We know it's a put frame, but we have to check if it's the final */
	final = frame->opcode & OBEX_FINAL;

	/* Length of this frame */
	size = ntohs(frame->len);
	
	/* Remove the OBEX common header */
	g_netbuf_pull(buf, 3);

	g_string_sprintfa(str, "final=%d len=%d ", final >> 7, size);

	/* Parse all headers */
	while (buf->len > 0) {
		/* Read the header identifier */
		/* g_print("hi=%02x", buf->data[0]);fflush(stdout); */
		switch (buf->data[0]) {
		case HEADER_NAME:
		case HEADER_ANAME:
			g_string_append(str, "Name=");
			len = parse_obex_header(buf, str, 1);
			break;
		case HEADER_DESCRIPTION:
			g_string_append(str, "Description=");
			len = parse_obex_header(buf, str, 0);
			break;
		case HEADER_LENGTH:
			g_string_append(str, "Lenght=");
			len = parse_obex_header(buf, str, 0);
			break;
		case HEADER_TYPE:
			g_string_append(str, "Type=");
			len = parse_obex_header(buf, str, 1);
			break;
		case HEADER_TARGET:
			g_string_append(str, "Target=");
			len = parse_obex_header(buf, str, 1);
			break;
		case HEADER_BODY:
			g_string_append(str, "body=");
			len = parse_obex_header(buf, str, 0);
			break;
		case HEADER_BODY_END:
			g_string_append(str, "body-end=");
			len = parse_obex_header(buf, str, 0);
			break;
		default:
			g_string_append(str, "custom=");
			len = parse_obex_header(buf, str, 0);
			break;
		}
                /* g_print("len=%d\n", len);fflush(stdout); */
		if(g_netbuf_pull(buf, len) == NULL) {
			g_string_append(str, "{unterminated} ");
			break;
		}
	}
}

inline void parse_obex_connect(GNetBuf *buf, GString *str)
{
	struct obex_connect_frame *frame;
	guint16 length;
	guint8 version;
	int flags;
	guint16 mtu;
	
	frame = (struct obex_connect_frame *) buf->data;

	length  = ntohs(frame->len);

	/* Check if it contains connection setup parameters - Jean II */
	if(length == 7) {
		version = frame->version;
		flags   = frame->flags;
		mtu     = ntohs(frame->mtu);

		g_string_sprintfa(str,
				  "CONNECT len=%d ver=%d.%d flags=%d mtu=%d ", 
				  length, ((version & 0xf0) >> 4),
				  version & 0x0f, flags, mtu);
	} else
		g_string_sprintfa(str, "CONNECT len=%d ", length);
}

/*
 * The first success frame contains the negociated Obex parameters
 * We also need to parse the anser to GET request properly
 * Jean II
 */
inline void parse_obex_success(GNetBuf *buf, GString *str)
{
	struct obex_connect_frame *frame;
	guint16 length;
	guint8 version;
	int flags;
	guint16 mtu;
	
	frame = (struct obex_connect_frame *) buf->data;

	length  = ntohs(frame->len);

	switch(length) {
	case 7:
		/* Frame contains connection setup parameters */
		version = frame->version;
		flags   = frame->flags;
		mtu     = ntohs(frame->mtu);

		g_string_sprintfa(str,
				  "SUCCESS len=%d ver=%d.%d flags=%d mtu=%d ", 
				  length, ((version & 0xf0) >> 4),
				  version & 0x0f, flags, mtu);
		break;
	case 3:
		/* Frame contains nothing */
		g_string_sprintfa(str, "SUCCESS len=%d ", length);
		break;
	default:
		/* Frame contains some headers (probably a GET reply) */
		g_string_append(str, "SUCCESS ");
		parse_obex_headers(buf, str);
		break;
	}
}

/*
 * Function parse_obex (buf)
 *
 *    Parse OBEX commands and responses
 *
 */
inline void parse_obex(GNetBuf *buf, GString *str, int cmd)
{
	guint8	opcode;
	int	len;

	/* g_print(__FUNCTION__);fflush(stdout); */

	g_string_append(str, "\n\tOBEX ");

	/* Check for empty frames - Jean II */
	len = g_netbuf_get_len(buf);
	if(len == 0)
	  return;

	opcode = buf->data[0] & ~OBEX_FINAL; /* Remove final bit */

	/* Check if it's a command or response frame - Jean II */
	if (!cmd) {
		switch (opcode) {
		case OBEX_CONTINUE:
			g_string_append(str, "CONTINUE ");
			parse_obex_headers(buf, str);
			break;
		case OBEX_SWITCH_PRO:
			g_string_append(str, "SWITCH_PRO ");
			break;
		case OBEX_SUCCESS:
			parse_obex_success(buf, str);
			break;
		case OBEX_CREATED:
			g_string_append(str, "CREATED ");
			break;
		case OBEX_ACCEPTED:
			g_string_append(str, "ACCEPTED ");
			break;
		case OBEX_BAD_REQUEST:
			g_string_append(str, "BAD REQUEST ");
			break;
		case OBEX_FORBIDDEN:
			g_string_append(str, "FORBIDDEN ");
			break;
		case OBEX_CONFLICT:
			g_string_append(str, "CONFLICT ");
			break;
		default:
			g_string_sprintfa(str, "Unknown response %02x ", 
					  opcode);
			break;
		}
	} else {
		switch (opcode) {
		case OBEX_CONNECT:
			parse_obex_connect(buf, str);
			break;
		case OBEX_PUT:
			g_string_append(str, "PUT ");
			parse_obex_headers(buf, str);
			break;
		case OBEX_GET:
			g_string_append(str, "GET ");
			parse_obex_headers(buf, str);
			break;
		case OBEX_DISCONNECT:
			g_string_append(str, "DISC ");
			break;
		case OBEX_ABORT:
			g_string_append(str, "ABORT ");
			break;
		case OBEX_SETPATH:
			g_string_append(str, "SETPATH ");
			break;
		default:
			if ((opcode > 0x04) && (opcode < 0x10))
				g_string_append(str, "RESERVED ");
			else if ((opcode > 0x0f) && (opcode < 0x20))
				g_string_append(str, "USER_DEFINED ");
			else 
				g_string_sprintfa(str, "unknown opcode %#x ",
						 opcode);
			break;
		}
	}
}