/*
* Copyright (C) 2009 Johannes Berg <johannes@sipsolutions.net>
*
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation;
* version 2.1 of the License (not later!)
*
* 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 Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser 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 <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "parse-events.h"
#define INDENT 65
/* return -1 (field not found/not valid number), 0 (ok), 1 (buffer full) */
static int _print_field(struct trace_seq *s, const char *fmt,
struct event_format *event, const char *name, const void *data)
{
struct format_field *f = pevent_find_field(event, name);
unsigned long long val;
if (!f)
return -1;
if (pevent_read_number_field(f, data, &val))
return -1;
return trace_seq_printf(s, fmt, val);
}
/* return 0 (ok), 1 (buffer full) */
static void print_field(struct trace_seq *s, const char *fmt,
struct event_format *event, const char *name, const void *data)
{
int ret = _print_field(s, fmt, event, name, data);
if (ret == -1)
trace_seq_printf(s, "NOTFOUND:%s", name);
}
static void print_string(struct trace_seq *s, struct event_format *event,
const char *name, const void *data)
{
struct format_field *f = pevent_find_field(event, name);
int offset;
int length;
if (!f) {
trace_seq_printf(s, "NOTFOUND:%s", name);
return;
}
offset = f->offset;
length = f->size;
if (!strncmp(f->type, "__data_loc", 10)) {
unsigned long long v;
if (pevent_read_number_field(f, data, &v)) {
trace_seq_printf(s, "invalid_data_loc");
return;
}
offset = v & 0xffff;
length = v >> 16;
}
trace_seq_printf(s, "%.*s", length, (char *)data + offset);
}
struct value_name {
unsigned long long value;
const char *name;
};
static void _print_enum(struct trace_seq *s, struct event_format *event,
const char *name, const void *data,
const struct value_name *names, int n_names)
{
struct format_field *f = pevent_find_field(event, name);
unsigned long long val;
int i;
if (!f) {
trace_seq_puts(s, "field-not-found");
return;
}
if (pevent_read_number_field(f, data, &val)) {
trace_seq_puts(s, "field-invalid");
return;
}
for (i = 0; i < n_names; i++) {
if (names[i].value == val) {
trace_seq_puts(s, names[i].name);
return;
}
}
trace_seq_printf(s, "%llu", val);
}
#define print_enum(s, ev, name, data, enums...) \
({ static const struct value_name __n[] = { enums }; \
_print_enum(s, ev, name, data, __n, sizeof(__n)/sizeof(__n[0])); \
})
static void _print_flag(struct trace_seq *s, struct event_format *event,
const char *name, const void *data,
const struct value_name *names, int n_names)
{
struct format_field *f = pevent_find_field(event, name);
unsigned long long val;
int i, j, found, first = 1;
if (!f) {
trace_seq_puts(s, "field-not-found");
return;
}
if (pevent_read_number_field(f, data, &val)) {
trace_seq_puts(s, "field-invalid");
return;
}
for (i = 0; i < 64; i++) {
if (!(val & (1ULL<<i)))
continue;
if (!first)
trace_seq_putc(s, '|');
first = 0;
found = 0;
for (j = 0; j < n_names; j++) {
if (j == names[i].value) {
trace_seq_puts(s, names[i].name);
found = 1;
break;
}
}
if (!found)
trace_seq_printf(s, "b%d", i);
}
}
#define print_flag(s, ev, name, data, enums...) \
({ static const struct value_name __n[] = { enums }; \
_print_flag(s, ev, name, data, __n, sizeof(__n)/sizeof(__n[0])); \
})
#define SF(fn) _print_field(s, fn ":%d", event, fn, data)
#define SFX(fn) _print_field(s, fn ":%#x", event, fn, data)
#define SP() trace_seq_putc(s, ' ')
static int drv_bss_info_changed(struct trace_seq *s, struct record *record,
struct event_format *event)
{
void *data = record->data;
print_string(s, event, "wiphy_name", data);
trace_seq_printf(s, " vif:");
print_string(s, event, "vif_name", data);
print_field(s, "(%d)", event, "vif_type", data);
trace_seq_printf(s, "\n%*s", INDENT, "");
SF("assoc"); SP();
SF("aid"); SP();
SF("cts"); SP();
SF("shortpre"); SP();
SF("shortslot"); SP();
SF("dtimper"); SP();
trace_seq_printf(s, "\n%*s", INDENT, "");
SF("bcnint"); SP();
SFX("assoc_cap"); SP();
SFX("basic_rates"); SP();
SF("enable_beacon");
trace_seq_printf(s, "\n%*s", INDENT, "");
SF("ht_operation_mode");
return 0;
}
static int drv_config(struct trace_seq *s, struct record *record,
struct event_format *event)
{
void *data = record->data;
print_string(s, event, "wiphy_name", data);
trace_seq_putc(s, ' ');
print_flag(s, event, "flags", data,
{ 0, "MONITOR" },
{ 1, "PS" },
{ 2, "IDLE" });
print_field(s, " chan:%d/", event, "center_freq", data);
print_enum(s, event, "channel_type", data,
{ 0, "noht" },
{ 1, "ht20" },
{ 2, "ht40-" },
{ 3, "ht40+" });
trace_seq_putc(s, ' ');
SF("power_level");
return 0;
}
int PEVENT_PLUGIN_LOADER(struct pevent *pevent)
{
pevent_register_event_handler(pevent, -1, "mac80211", "drv_bss_info_changed",
drv_bss_info_changed);
pevent_register_event_handler(pevent, -1, "mac80211", "drv_config",
drv_config);
return 0;
}
