tools/parser/ericsson.c

   1 /*
   2  *
   3  *  BlueZ - Bluetooth protocol stack for Linux
   4  *
   5  *  Copyright (C) 2004-2011  Marcel Holtmann <marcel@holtmann.org>
   6  *
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or
  11  *  (at your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  21  *
  22  */
  23
  24 #ifdef HAVE_CONFIG_H
  25 #include <config.h>
  26 #endif
  27
  28 #include <stdio.h>
  29 #include <errno.h>
  30
  31 #include "parser.h"
  32
  33 void ericsson_dump(int level, struct frame *frm)
  34 {
  35         uint8_t event = p_get_u8(frm);
  36         uint8_t *buf = (uint8_t *) frm->ptr;
  37
  38         if (event != 0x10) {
  39                 p_indent(level, frm);
  40                 printf("Ericsson: event 0x%2.2x\n", event);
  41                 raw_dump(level, frm);
  42         }
  43
  44         frm->master = !(buf[0] & 0x01);
  45         frm->handle = buf[1] | (buf[2] << 8);
  46
  47         buf[5] = (buf[5] << 1) | (buf[3] & 0x01);
  48
  49         frm->ptr += 5;
  50         frm->len -= 5;
  51
  52         lmp_dump(level, frm);
  53 }