From 2d75ab55e70a9200da315603ad09ebec795d51c1 Mon Sep 17 00:00:00 2001 From: Marcel Holtmann Date: Fri, 8 Aug 2014 15:40:43 -0700 Subject: [PATCH] tools: Add simple utility for interacting with mac80221_hwsim --- .gitignore | 1 + Makefile.am | 4 +- tools/hwsim.c | 265 ++++++++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 269 insertions(+), 1 deletion(-) create mode 100644 tools/hwsim.c diff --git a/.gitignore b/.gitignore index 4ccf0c54..17ef27b1 100644 --- a/.gitignore +++ b/.gitignore @@ -21,6 +21,7 @@ ell src/iwd client/iwctl monitor/iwmon +tools/hwsim unit/test-pbkdf2-sha1 unit/test-prf-sha1 unit/*.log diff --git a/Makefile.am b/Makefile.am index 351b332a..81025863 100644 --- a/Makefile.am +++ b/Makefile.am @@ -53,7 +53,9 @@ monitor_iwmon_SOURCES = monitor/main.c linux/nl80211.h \ monitor/pcap.h monitor/pcap.c monitor_iwmon_LDADD = ell/libell-internal.la -noinst_PROGRAMS = +noinst_PROGRAMS = tools/hwsim + +tools_hwsim_LDADD = ell/libell-internal.la unit_tests = unit/test-pbkdf2-sha1 unit/test-prf-sha1 unit/test-ie diff --git a/tools/hwsim.c b/tools/hwsim.c new file mode 100644 index 00000000..32c5c462 --- /dev/null +++ b/tools/hwsim.c @@ -0,0 +1,265 @@ +/* + * + * Wireless daemon for Linux + * + * Copyright (C) 2013-2014 Intel Corporation. All rights reserved. + * + * This library 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; either + * version 2.1 of the License, or (at your option) any later version. + * + * This library 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 library; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + * + */ + +#ifdef HAVE_CONFIG_H +#include +#endif + +#include +#include +#include +#include + +enum { + HWSIM_CMD_UNSPEC, + HWSIM_CMD_REGISTER, + HWSIM_CMD_FRAME, + HWSIM_CMD_TX_INFO_FRAME, + HWSIM_CMD_CREATE_RADIO, + HWSIM_CMD_DESTROY_RADIO, + __HWSIM_CMD_MAX, +}; +#define HWSIM_CMD_MAX (_HWSIM_CMD_MAX - 1) + +enum { + HWSIM_ATTR_UNSPEC, + HWSIM_ATTR_ADDR_RECEIVER, + HWSIM_ATTR_ADDR_TRANSMITTER, + HWSIM_ATTR_FRAME, + HWSIM_ATTR_FLAGS, + HWSIM_ATTR_RX_RATE, + HWSIM_ATTR_SIGNAL, + HWSIM_ATTR_TX_INFO, + HWSIM_ATTR_COOKIE, + HWSIM_ATTR_CHANNELS, + HWSIM_ATTR_RADIO_ID, + HWSIM_ATTR_REG_HINT_ALPHA2, + HWSIM_ATTR_REG_CUSTOM_REG, + HWSIM_ATTR_REG_STRICT_REG, + HWSIM_ATTR_SUPPORT_P2P_DEVICE, + HWSIM_ATTR_USE_CHANCTX, + __HWSIM_ATTR_MAX, +}; +#define HWSIM_ATTR_MAX (__HWSIM_ATTR_MAX - 1) + +static struct l_genl_family *hwsim; + +static bool create_action = false; +static const char *destroy_action = NULL; + +static void do_debug(const char *str, void *user_data) +{ + const char *prefix = user_data; + + l_info("%s%s", prefix, str); +} + +static void create_callback(struct l_genl_msg *msg, void *user_data) +{ + struct l_genl_attr attr; + uint16_t type, len; + const void *data; + uint32_t radio_id = 0; + + if (!l_genl_attr_init(&attr, msg)) { + l_warn("Failed to initialize create return attributes"); + goto done; + } + + while (l_genl_attr_next(&attr, &type, &len, &data)) { + switch (type) { + case HWSIM_ATTR_RADIO_ID: + if (len != sizeof(uint32_t)) { + l_warn("Invalid radio id attribute"); + return; + } + + radio_id = *((uint32_t *) data); + break; + } + } + + l_info("Created new radio with id %u", radio_id); + +done: + l_main_quit(); +} + +static void destroy_callback(struct l_genl_msg *msg, void *user_data) +{ + struct l_genl_attr attr; + uint16_t type, len; + const void *data; + + if (!l_genl_attr_init(&attr, msg)) { + l_warn("Failed to initialize destroy return attributes"); + goto done; + } + + while (l_genl_attr_next(&attr, &type, &len, &data)) { + } + + l_info("Destroyed radio"); + +done: + l_main_quit(); +} + +static void hwsim_ready(void *user_data) +{ + struct l_genl_msg *msg; + + if (create_action) { + msg = l_genl_msg_new(HWSIM_CMD_CREATE_RADIO); + l_genl_family_send(hwsim, msg, create_callback, NULL, NULL); + l_genl_msg_unref(msg); + return; + } else if (destroy_action) { + uint32_t id = atoi(destroy_action); + + msg = l_genl_msg_new_sized(HWSIM_CMD_DESTROY_RADIO, 8); + l_genl_msg_append_attr(msg, HWSIM_ATTR_RADIO_ID, 4, &id); + l_genl_family_send(hwsim, msg, destroy_callback, NULL, NULL); + l_genl_msg_unref(msg); + } else + l_main_quit(); +} + +static void signal_handler(struct l_signal *signal, uint32_t signo, + void *user_data) +{ + switch (signo) { + case SIGINT: + case SIGTERM: + l_main_quit(); + break; + } +} + +static void usage(void) +{ + printf("hwsim - Wireless simulator\n" + "Usage:\n"); + printf("\thwsim [options]\n"); + printf("Options:\n" + "\t-C, --create Create new simulated radio\n" + "\t-D, --destroy Destroy existing radio\n" + "\t-h, --help Show help options\n"); +} + +static const struct option main_options[] = { + { "create", no_argument, NULL, 'C' }, + { "destroy", required_argument, NULL, 'D' }, + { "version", no_argument, NULL, 'v' }, + { "help", no_argument, NULL, 'h' }, + { } +}; + +int main(int argc, char *argv[]) +{ + struct l_signal *signal; + struct l_genl *genl; + sigset_t mask; + int exit_status; + + for (;;) { + int opt; + + opt = getopt_long(argc, argv, "CD:vh", main_options, NULL); + if (opt < 0) + break; + + switch (opt) { + case 'C': + create_action = true; + break; + case 'D': + destroy_action = optarg; + break; + case 'v': + printf("%s\n", VERSION); + return EXIT_SUCCESS; + case 'h': + usage(); + return EXIT_SUCCESS; + default: + return EXIT_FAILURE; + } + } + + if (argc - optind > 0) { + fprintf(stderr, "Invalid command line parameters\n"); + return EXIT_FAILURE; + } + + if (create_action && destroy_action) { + fprintf(stderr, "Only one action can be specified\n"); + return EXIT_FAILURE; + } + + if (!create_action && !destroy_action) { + fprintf(stderr, "No action has been specified\n"); + return EXIT_FAILURE; + } + + sigemptyset(&mask); + sigaddset(&mask, SIGINT); + sigaddset(&mask, SIGTERM); + + signal = l_signal_create(&mask, signal_handler, NULL, NULL); + + l_log_set_stderr(); + + printf("Wireless simulator ver %s\n", VERSION); + + genl = l_genl_new_default(); + if (!genl) { + fprintf(stderr, "Failed to initialize generic netlink\n"); + exit_status = EXIT_FAILURE; + goto done; + } + + if (getenv("HWSIM_DEBUG")) + l_genl_set_debug(genl, do_debug, "[GENL] ", NULL); + + hwsim = l_genl_family_new(genl, "MAC80211_HWSIM"); + if (!hwsim) { + fprintf(stderr, "Failed to create generic netlink family\n"); + l_genl_unref(genl); + exit_status = EXIT_FAILURE; + goto done; + } + + l_genl_family_set_watches(hwsim, hwsim_ready, NULL, NULL, NULL); + + l_main_run(); + + l_genl_family_unref(hwsim); + l_genl_unref(genl); + + exit_status = EXIT_SUCCESS; + +done: + l_signal_remove(signal); + + return exit_status; +}