/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2004-2011 Marcel Holtmann <marcel@holtmann.org>
*
*
* 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#define _GNU_SOURCE
#include <stdio.h>
#include <errno.h>
#include <ctype.h>
#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include "parser.h"
#define CAPI_U8(frm) (p_get_u8(frm))
#define CAPI_U16(frm) (btohs(htons(p_get_u16(frm))))
#define CAPI_U32(frm) (btohl(htonl(p_get_u32(frm))))
static char *cmd2str(uint8_t cmd)
{
switch (cmd) {
case 0x01:
return "ALERT";
case 0x02:
return "CONNECT";
case 0x03:
return "CONNECT_ACTIVE";
case 0x04:
return "DISCONNECT";
case 0x05:
return "LISTEN";
case 0x08:
return "INFO";
case 0x20:
return "INTEROPERABILITY";
case 0x41:
return "SELECT_B_PROTOCOL";
case 0x80:
return "FACILITY";
case 0x82:
return "CONNECT_B3";
case 0x83:
return "CONNECT_B3_ACTIVE";
case 0x84:
return "DISCONNECT_B3";
case 0x86:
return "DATA_B3";
case 0x87:
return "RESET_B3";
case 0x88:
return "CONNECT_B3_T90_ACTIVE";
case 0xff:
return "MANUFACTURER";
default:
return "UNKNOWN";
}
}
static char *subcmd2str(uint8_t subcmd)
{
switch (subcmd) {
case 0x80:
return "REQ";
case 0x81:
return "CONF";
case 0x82:
return "IND";
case 0x83:
return "RESP";
default:
return "UNKN";
}
}
static char *interopsel2str(uint16_t sel)
{
switch (sel) {
case 0x0000:
return "USB Device Management";
case 0x0001:
return "Bluetooth Device Management";
default:
return "Unknown";
}
}
static char *func2str(uint16_t func)
{
switch (func) {
case 0:
return "Register";
case 1:
return "Release";
case 2:
return "Get_Profile";
case 3:
return "Get_Manufacturer";
case 4:
return "Get_Version";
case 5:
return "Get_Serial_Number";
case 6:
return "Manufacturer";
case 7:
return "Echo_Loopback";
default:
return "Unknown";
}
}
static char *facilitysel2str(uint16_t sel)
{
switch (sel) {
case 0x0000:
return "Handset";
case 0x0001:
return "DTMF";
case 0x0002:
return "V.42 bis";
case 0x0003:
return "Supplementary Services";
case 0x0004:
return "Power management wakeup";
case 0x0005:
return "Line Interconnect";
case 0x0006:
return "DTMF";
default:
return "Unknown";
}
}
static char *info2str(uint16_t info)
{
switch (info) {
case 0x0000:
return "No error";
case 0x0001:
return "NCPI not supported by current protocol, NCPI ignored";
case 0x0002:
return "Flags not supported by current protocol, flags ignored";
case 0x2001:
return "Message not supported in current state";
case 0x2002:
return "Incorrect Controller/PLCI/NCCI";
case 0x2003:
return "No PLCI available";
case 0x2004:
return "No NCCI available";
case 0x2005:
return "No Listen resources available";
case 0x2007:
return "Illegal message parameter coding";
case 0x2008:
return "No interconnection resources available";
case 0x3001:
return "B1 protocol not supported";
case 0x3002:
return "B2 protocol not supported";
case 0x3003:
return "B3 protocol not supported";
case 0x3004:
return "B1 protocol parameter not supported";
case 0x3005:
return "B2 protocol parameter not supported";
case 0x3006:
return "B3 protocol parameter not supported";
case 0x3007:
return "B protocol combination not supported";
case 0x3008:
return "NCPI not supported";
case 0x3009:
return "CIP Value unknown";
case 0x300A:
return "Flags not supported (reserved bits)";
case 0x300B:
return "Facility not supported";
case 0x300C:
return "Data length not supported by current protocol";
case 0x300D:
return "Reset procedure not supported by current protocol";
case 0x300F:
return "Unsupported interoperability";
case 0x3011:
return "Facility specific function not supported";
case 0x3301:
return "Protocol error, Layer 1";
case 0x3302:
return "Protocol error, Layer 2";
case 0x3303:
return "Protocol error, Layer 3";
case 0x3304:
return "Another application got that call";
case 0x3305:
return "Cleared by Call Control Supervision";
case 0x3400:
/* The cause value received from the network in a cause
* information element (Octet 4) is indicated in the field 00 */
return "Disconnect cause from the network in accordance with Q.850/ETS 300 102-1";
default:
return "Unknown";
}
}
static void profile(int level, struct frame *frm)
{
uint16_t nctr, nchn;
uint32_t value;
nctr = CAPI_U16(frm);
nchn = CAPI_U16(frm);
if (nchn > 0) {
p_indent(level, frm);
printf("Controller: %d\n", nctr);
p_indent(level, frm);
printf("Number of B-channels: %d\n", nchn);
value = CAPI_U32(frm);
p_indent(level, frm);
printf("Global options: 0x%04x\n", value);
value = CAPI_U32(frm);
p_indent(level, frm);
printf("B1 protocol support: 0x%08x\n", value);
value = CAPI_U32(frm);
p_indent(level, frm);
printf("B2 protocol support: 0x%08x\n", value);
value = CAPI_U32(frm);
p_indent(level, frm);
printf("B3 protocol support: 0x%08x\n", value);
frm->ptr += 24;
frm->len -= 24;
p_indent(level, frm);
printf("Manufacturer-specific information:\n");
hex_dump(level, frm, 20);
} else {
p_indent(level, frm);
printf("Number of controllers: %d\n", nctr);
}
}
static void cmd_common(int level, uint8_t subcmd, struct frame *frm)
{
uint32_t val;
uint16_t info, ncci;
uint8_t ctr, plci;
val = CAPI_U32(frm);
ctr = val & 0xff;
plci = (val & 0xff00) >> 8;
ncci = (val & 0xffff0000) >> 16;
p_indent(level, frm);
printf("Controller: %d %s\n", ctr & 0x7f, ctr & 0x80 ? "Ext." : "Int.");
if (plci > 0) {
p_indent(level, frm);
printf("PLCI: 0x%02x\n", plci);
}
if (ncci > 0) {
p_indent(level, frm);
printf("NCCI: 0x%04x\n", ncci);
}
if (subcmd == 0x81) {
info = CAPI_U16(frm);
p_indent(level, frm);
printf("Info: 0x%04x (%s)\n", info, info2str(info));
}
}
static void cmd_alert(int level, uint8_t subcmd, struct frame *frm)
{
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x80) {
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Additional info:\n");
hex_dump(level, frm, len);
}
}
}
static void cmd_connect(int level, uint8_t subcmd, struct frame *frm)
{
uint16_t cip;
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x81)
return;
cip = CAPI_U16(frm);
p_indent(level, frm);
printf("CIP value: 0x%04x\n", cip);
len = CAPI_U8(frm);
frm->ptr += len;
frm->len -= len;
len = CAPI_U8(frm);
frm->ptr += len;
frm->len -= len;
len = CAPI_U8(frm);
frm->ptr += len;
frm->len -= len;
len = CAPI_U8(frm);
frm->ptr += len;
frm->len -= len;
raw_dump(level, frm);
}
static void cmd_disconnect(int level, uint8_t subcmd, struct frame *frm)
{
uint16_t reason;
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x80) {
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Additional info:\n");
hex_dump(level, frm, len);
}
}
if (subcmd == 0x82) {
reason = CAPI_U16(frm);
p_indent(level, frm);
printf("Reason: 0x%04x (%s)\n", reason, info2str(reason));
}
}
static void cmd_connect_active(int level, uint8_t subcmd, struct frame *frm)
{
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x82) {
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Connected number:\n");
hex_dump(level, frm, len);
}
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Connected subaddress:\n");
hex_dump(level, frm, len);
}
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("LLC:\n");
hex_dump(level, frm, len);
}
}
}
static void cmd_listen(int level, uint8_t subcmd, struct frame *frm)
{
uint32_t mask;
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x80) {
mask = CAPI_U32(frm);
p_indent(level, frm);
printf("Info mask: 0x%08x\n", mask);
mask = CAPI_U32(frm);
p_indent(level, frm);
printf("CIP mask: 0x%08x", mask);
mask = CAPI_U32(frm);
if (mask > 0)
printf(" 0x%08x\n", mask);
else
printf("\n");
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Calling party number:\n");
hex_dump(level, frm, len);
}
frm->ptr += len;
frm->len -= len;
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Calling party subaddress:\n");
hex_dump(level, frm, len);
}
frm->ptr += len;
frm->len -= len;
}
}
static void cmd_info(int level, uint8_t subcmd, struct frame *frm)
{
uint8_t len;
uint16_t info;
cmd_common(level, subcmd, frm);
switch (subcmd) {
case 0x80:
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Called party number:\n");
hex_dump(level, frm, len);
}
frm->ptr += len;
frm->len -= len;
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Additional info:\n");
hex_dump(level, frm, len);
}
break;
case 0x82:
info = CAPI_U16(frm);
p_indent(level, frm);
printf("Info number: %d\n", info);
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("Info element:\n");
hex_dump(level, frm, len);
}
break;
}
}
static void cmd_interoperability(int level, uint8_t subcmd, struct frame *frm)
{
uint16_t sel, func, info;
uint16_t nconn, datablkcnt, datablklen;
uint32_t ctr, value, major, minor;
info = (subcmd == 0x81) ? CAPI_U16(frm) : 0;
sel = CAPI_U16(frm);
CAPI_U8(frm);
if (subcmd != 0x83) {
func = CAPI_U16(frm);
CAPI_U8(frm);
} else
func = 0;
p_indent(level, frm);
printf("Selector: 0x%04x (%s)\n", sel, interopsel2str(sel));
switch (sel) {
case 0x0001:
p_indent(level, frm);
printf("Function: %d (%s)\n", func, func2str(func));
switch (subcmd) {
case 0x80:
switch (func) {
case 0:
nconn = CAPI_U16(frm);
p_indent(level + 1, frm);
printf("maxLogicalConnections: %d\n", nconn);
datablkcnt = CAPI_U16(frm);
p_indent(level + 1, frm);
printf("maxBDataBlocks: %d\n", datablkcnt);
datablklen = CAPI_U16(frm);
p_indent(level + 1, frm);
printf("maxBDataLen: %d\n", datablklen);
break;
case 2:
case 3:
case 4:
case 5:
ctr = CAPI_U32(frm);
p_indent(level + 1, frm);
printf("Controller: %d\n", ctr);
break;
default:
raw_dump(level + 1, frm);
break;
}
break;
case 0x81:
switch (func) {
case 0:
case 1:
info = CAPI_U16(frm);
p_indent(level + 1, frm);
printf("Info: 0x%04x (%s)\n", info, info2str(info));
break;
case 2:
info = CAPI_U16(frm);
p_indent(level + 1, frm);
printf("Info: 0x%04x (%s)\n", info, info2str(info));
CAPI_U8(frm);
profile(level + 1, frm);
break;
case 3:
info = CAPI_U16(frm);
p_indent(level + 1, frm);
printf("Info: 0x%04x (%s)\n", info, info2str(info));
ctr = CAPI_U32(frm);
p_indent(level + 1, frm);
printf("Controller: %d\n", ctr);
CAPI_U8(frm);
p_indent(level + 1, frm);
printf("Identification: \"%s\"\n", (char *) frm->ptr);
break;
case 4:
value = CAPI_U32(frm);
p_indent(level + 1, frm);
printf("Return value: 0x%04x\n", value);
ctr = CAPI_U32(frm);
p_indent(level + 1, frm);
printf("Controller: %d\n", ctr);
p_indent(level + 1, frm);
major = CAPI_U32(frm);
minor = CAPI_U32(frm);
printf("CAPI: %d.%d\n", major, minor);
major = CAPI_U32(frm);
minor = CAPI_U32(frm);
p_indent(level + 1, frm);
printf("Manufacture: %u.%01x%01x-%02u (%d.%d)\n",
(major & 0xf0) >> 4, (major & 0x0f) << 4,
(minor & 0xf0) >> 4, minor & 0x0f,
major, minor);
break;
case 5:
value = CAPI_U32(frm);
p_indent(level + 1, frm);
printf("Return value: 0x%04x\n", value);
ctr = CAPI_U32(frm);
p_indent(level + 1, frm);
printf("Controller: %d\n", ctr);
CAPI_U8(frm);
p_indent(level + 1, frm);
printf("Serial number: %.7s\n", (char *) frm->ptr);
break;
default:
raw_dump(level + 1, frm);
break;
}
break;
default:
raw_dump(level, frm);
break;
}
break;
default:
p_indent(level, frm);
printf("Function: %d\n", func);
if (subcmd == 0x81) {
p_indent(level, frm);
printf("Info: 0x%04x (%s)\n", info, info2str(info));
}
raw_dump(level + 1, frm);
break;
}
}
static void cmd_facility(int level, uint8_t subcmd, struct frame *frm)
{
uint16_t sel;
cmd_common(level, subcmd, frm);
sel = CAPI_U16(frm);
CAPI_U8(frm);
p_indent(level, frm);
printf("Selector: 0x%04x (%s)\n", sel, facilitysel2str(sel));
raw_dump(level, frm);
}
static void cmd_connect_b3(int level, uint8_t subcmd, struct frame *frm)
{
uint16_t reject;
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x81)
return;
if (subcmd == 0x83) {
reject = CAPI_U16(frm);
p_indent(level, frm);
printf("Reject: 0x%04x (%s)\n", reject, info2str(reject));
}
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("NCPI:\n");
hex_dump(level, frm, len);
}
}
static void cmd_connect_b3_active(int level, uint8_t subcmd, struct frame *frm)
{
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x82) {
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("NCPI:\n");
hex_dump(level, frm, len);
}
}
}
static void cmd_disconnect_b3(int level, uint8_t subcmd, struct frame *frm)
{
uint16_t reason;
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x82) {
reason = CAPI_U16(frm);
p_indent(level, frm);
printf("Reason: 0x%04x (%s)\n", reason, info2str(reason));
}
if (subcmd == 0x80 || subcmd == 0x82) {
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("NCPI:\n");
hex_dump(level, frm, len);
}
}
}
static void cmd_data_b3(int level, uint8_t subcmd, struct frame *frm)
{
uint32_t data;
uint16_t length, handle, flags, info;
cmd_common(level, 0x00, frm);
if (subcmd == 0x81 || subcmd == 0x83) {
handle = CAPI_U16(frm);
p_indent(level, frm);
printf("Data handle: 0x%04x\n", handle);
if (subcmd == 0x81) {
info = CAPI_U16(frm);
p_indent(level, frm);
printf("Info: 0x%04x (%s)\n", info, info2str(info));
}
} else {
data = CAPI_U32(frm);
length = CAPI_U16(frm);
p_indent(level, frm);
printf("Data length: 0x%04x (%d bytes)\n", length, length);
handle = CAPI_U16(frm);
p_indent(level, frm);
printf("Data handle: 0x%04x\n", handle);
flags = CAPI_U16(frm);
p_indent(level, frm);
printf("Flags: 0x%04x\n", flags);
if (data == 0)
(void) p_get_u64(frm);
raw_dump(level, frm);
}
}
static void cmd_reset_b3(int level, uint8_t subcmd, struct frame *frm)
{
uint8_t len;
cmd_common(level, subcmd, frm);
if (subcmd == 0x80 || subcmd == 0x82) {
len = CAPI_U8(frm);
if (len > 0) {
p_indent(level, frm);
printf("NCPI:\n");
hex_dump(level, frm, len);
}
}
}
static void cmd_manufacturer(int level, uint8_t subcmd, struct frame *frm)
{
uint32_t ctr, class, func;
uint16_t len;
unsigned char *id;
ctr = CAPI_U32(frm);
p_indent(level, frm);
printf("Controller: %d\n", ctr);
id = (unsigned char *) frm->ptr;
p_indent(level, frm);
if (isprint(id[0]) && isprint(id[1]) && isprint(id[2]) && isprint(id[3]))
printf("Manufacturer: %.4s", id);
else
printf("Manufacturer: 0x%02x 0x%02x 0x%02x 0x%02x",
id[0], id[1], id[2], id[3]);
frm->ptr += 4;
frm->len -= 4;
if (!strncmp((char *) id, "AVM!", 4)) {
class = CAPI_U32(frm);
func = CAPI_U32(frm);
len = CAPI_U8(frm);
if (len == 0xff)
len = CAPI_U16(frm);
printf(" [class %d func %d len %d]\n", class, func, len);
} else
printf("\n");
raw_dump(level, frm);
}
void capi_dump(int level, struct frame *frm)
{
uint16_t len, appl, msgnum;
uint8_t cmd, subcmd;
len = CAPI_U16(frm) - 8;
appl = CAPI_U16(frm);
cmd = CAPI_U8(frm);
subcmd = CAPI_U8(frm);
msgnum = CAPI_U16(frm);
p_indent(level, frm);
printf("CAPI_%s_%s: appl %d msgnum %d len %d\n",
cmd2str(cmd), subcmd2str(subcmd), appl, msgnum, len);
switch (cmd) {
case 0x01:
cmd_alert(level + 1, subcmd, frm);
break;
case 0x02:
cmd_connect(level + 1, subcmd, frm);
break;
case 0x03:
cmd_connect_active(level + 1, subcmd, frm);
break;
case 0x04:
cmd_disconnect(level + 1, subcmd, frm);
break;
case 0x05:
cmd_listen(level + 1, subcmd, frm);
break;
case 0x08:
cmd_info(level + 1, subcmd, frm);
break;
case 0x20:
cmd_interoperability(level + 1, subcmd, frm);
break;
case 0x80:
cmd_facility(level + 1, subcmd, frm);
break;
case 0x82:
cmd_connect_b3(level + 1, subcmd, frm);
break;
case 0x83:
case 0x88:
cmd_connect_b3_active(level + 1, subcmd, frm);
break;
case 0x84:
cmd_disconnect_b3(level + 1, subcmd, frm);
break;
case 0x86:
cmd_data_b3(level + 1, subcmd, frm);
break;
case 0x87:
cmd_reset_b3(level + 1, subcmd, frm);
break;
case 0xff:
cmd_manufacturer(level + 1, subcmd, frm);
break;
default:
raw_dump(level, frm);
frm->ptr += len;
frm->len -= len;
break;
}
}