Blame tools/parser/hcrp.c

Packit 34410b
/*
Packit 34410b
 *
Packit 34410b
 *  BlueZ - Bluetooth protocol stack for Linux
Packit 34410b
 *
Packit 34410b
 *  Copyright (C) 2004-2011  Marcel Holtmann <marcel@holtmann.org>
Packit 34410b
 *
Packit 34410b
 *
Packit 34410b
 *  This program is free software; you can redistribute it and/or modify
Packit 34410b
 *  it under the terms of the GNU General Public License as published by
Packit 34410b
 *  the Free Software Foundation; either version 2 of the License, or
Packit 34410b
 *  (at your option) any later version.
Packit 34410b
 *
Packit 34410b
 *  This program is distributed in the hope that it will be useful,
Packit 34410b
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
Packit 34410b
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
Packit 34410b
 *  GNU General Public License for more details.
Packit 34410b
 *
Packit 34410b
 *  You should have received a copy of the GNU General Public License
Packit 34410b
 *  along with this program; if not, write to the Free Software
Packit 34410b
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
Packit 34410b
 *
Packit 34410b
 */
Packit 34410b
Packit 34410b
#ifdef HAVE_CONFIG_H
Packit 34410b
#include <config.h>
Packit 34410b
#endif
Packit 34410b
Packit 34410b
#define _GNU_SOURCE
Packit 34410b
#include <stdio.h>
Packit 34410b
#include <errno.h>
Packit 34410b
#include <unistd.h>
Packit 34410b
#include <stdlib.h>
Packit 34410b
#include <string.h>
Packit 34410b
Packit 34410b
#include "parser.h"
Packit 34410b
Packit 34410b
static char *pid2str(uint16_t pid)
Packit 34410b
{
Packit 34410b
	switch (pid) {
Packit 34410b
	case 0x0001:
Packit 34410b
		return "CreditGrant";
Packit 34410b
	case 0x0002:
Packit 34410b
		return "CreditRequest";
Packit 34410b
	case 0x0003:
Packit 34410b
		return "CreditReturn";
Packit 34410b
	case 0x0004:
Packit 34410b
		return "CreditQuery";
Packit 34410b
	case 0x0005:
Packit 34410b
		return "GetLPTStatus";
Packit 34410b
	case 0x0006:
Packit 34410b
		return "Get1284ID";
Packit 34410b
	case 0x0007:
Packit 34410b
		return "SoftReset";
Packit 34410b
	case 0x0008:
Packit 34410b
		return "HardRest";
Packit 34410b
	case 0x0009:
Packit 34410b
		return "RegisterNotification";
Packit 34410b
	case 0x000A:
Packit 34410b
		return "NotificationConnectionAlive";
Packit 34410b
	default:
Packit 34410b
		return "Reserved";
Packit 34410b
	}
Packit 34410b
}
Packit 34410b
Packit 34410b
static char *status2str(uint16_t status)
Packit 34410b
{
Packit 34410b
	switch (status) {
Packit 34410b
	case 0x0000:
Packit 34410b
		return "Feature unsupported";
Packit 34410b
	case 0x0001:
Packit 34410b
		return "Success";
Packit 34410b
	case 0x0002:
Packit 34410b
		return "Credit synchronization error";
Packit 34410b
	case 0xFFFF:
Packit 34410b
		return "Generic error";
Packit 34410b
	default:
Packit 34410b
		return "Unknown";
Packit 34410b
	}
Packit 34410b
}
Packit 34410b
Packit 34410b
void hcrp_dump(int level, struct frame *frm)
Packit 34410b
{
Packit 34410b
	uint16_t pid, tid, plen, status;
Packit 34410b
	uint32_t credits;
Packit 34410b
Packit 34410b
	pid = p_get_u16(frm);
Packit 34410b
	tid = p_get_u16(frm);
Packit 34410b
	plen = p_get_u16(frm);
Packit 34410b
Packit 34410b
	p_indent(level, frm);
Packit 34410b
Packit 34410b
	printf("HCRP %s %s: tid 0x%x plen %d",
Packit 34410b
			pid2str(pid), frm->in ? "rsp" : "cmd",  tid, plen);
Packit 34410b
Packit 34410b
	if (frm->in) {
Packit 34410b
		status = p_get_u16(frm);
Packit 34410b
		printf(" status %d (%s)\n", status, status2str(status));
Packit 34410b
	} else
Packit 34410b
		printf("\n");
Packit 34410b
Packit 34410b
	if (pid == 0x0001 && !frm->in) {
Packit 34410b
		credits = p_get_u32(frm);
Packit 34410b
		p_indent(level + 1, frm);
Packit 34410b
		printf("credits %d\n", credits);
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (pid == 0x0002 && frm->in) {
Packit 34410b
		credits = p_get_u32(frm);
Packit 34410b
		p_indent(level + 1, frm);
Packit 34410b
		printf("credits %d\n", credits);
Packit 34410b
	}
Packit 34410b
Packit 34410b
	raw_dump(level + 1, frm);
Packit 34410b
}