xref: /external/bluetooth/hcidump/parser/hci.c

/*
	HCIDump - HCI packet analyzer
	Copyright (C) 2000-2001 Maxim Krasnyansky <maxk@qualcomm.com>

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License version 2 as
	published by the Free Software Foundation;

	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
	OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
	IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY CLAIM,
	OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES WHATSOEVER
	RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
	NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE
	USE OR PERFORMANCE OF THIS SOFTWARE.

	ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, COPYRIGHTS,
	TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS SOFTWARE IS DISCLAIMED.
*/

/*
 * $Id$
 */

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <errno.h>
#include <string.h>

#include <sys/socket.h>
#include <sys/types.h>
#include <asm/types.h>

#include <bluetooth/bluetooth.h>
#include <bluetooth/hci.h>

#include "parser.h"

char *event_map[] = {
	"Unknown",
	"Inquiry Complete",
	"Inquiry Result",
	"Connect Complete",
	"Connect Request",
	"Disconn Complete",
	"Auth Complete",
	"Remote Name Req Complete",
	"Encryp Change",
	"Change Connection Link Key Complete",
	"Master Link Key Complete",
	"Read Remote Supported Features",
	"Read Remote Ver Info Complete",
	"QoS Setup Complete",
	"Command Complete",
	"Command Status",
	"Hardware Error",
	"Flush Occurred",
	"Role Change",
	"Number of Completed Packets",
	"Mode Change",
	"Return Link Keys",
	"PIN Code Request",
	"Link Key Request",
	"Link Key Notification",
	"Loopback Command",
	"Data Buffer Overflow",
	"Max Slots Change",
	"Read Clock Offset Complete",
	"Connection Packet Type Changed",
	"QoS Violation",
	"Page Scan Mode Change",
	"Page Scan Repetition Mode Change"
};
#define EVENTS_NUM	32

static inline void command_dump(void *ptr, int len)
{
	hci_command_hdr *hdr = ptr;
	__u16 opcode = __le16_to_cpu(hdr->opcode);

	ptr += HCI_COMMAND_HDR_SIZE;
	len -= HCI_COMMAND_HDR_SIZE;

	printf("HCI Command: ogf 0x%x ocf 0x%x plen %d\n",
		cmd_opcode_ogf(opcode), cmd_opcode_ocf(opcode), hdr->plen);
	raw_dump(1, ptr, len);
}

static inline void event_dump(void *ptr, int len)
{
	hci_event_hdr *hdr = ptr;

	ptr += HCI_EVENT_HDR_SIZE;
	len -= HCI_EVENT_HDR_SIZE;

	if (hdr->evt <= EVENTS_NUM)
		printf("HCI Event: %s(0x%2.2x) plen %d\n",
			event_map[hdr->evt], hdr->evt, hdr->plen);
	else
		printf("HCI Event: code 0x%2.2x plen %d\n", hdr->evt, hdr->plen);
	raw_dump(1, ptr, len);
}

static inline void acl_dump(void *ptr, int len)
{
	hci_acl_hdr *hdr = ptr;
	__u16 handle = __le16_to_cpu(hdr->handle);
	__u16 dlen = __le16_to_cpu(hdr->dlen);
	__u8 flags = acl_flags(handle);

	printf("ACL data: handle 0x%4.4x flags 0x%2.2x dlen %d\n",
		acl_handle(handle), flags, dlen);

	ptr += HCI_ACL_HDR_SIZE;
	len -= HCI_ACL_HDR_SIZE;

	if (flags & ACL_START) {
		l2cap_dump(1, ptr, len, flags);
	} else {
		raw_dump(1, ptr, len);
	}
}

void hci_dump(int level, __u8 *data, int len)
{
	unsigned char *ptr = data;
	__u8 type;

	type = *ptr++; len--;

	switch (type) {
	case HCI_COMMAND_PKT:
		command_dump(ptr, len);
		break;

	case HCI_EVENT_PKT:
		event_dump(ptr, len);
		break;

	case HCI_ACLDATA_PKT:
		acl_dump(ptr, len);
		break;

	default:
		printf("Unknown: type 0x%2.2x len %d\n", type, len);
		raw_dump(1, ptr, len);
		break;
	}
}