mirror of
https://git.rwth-aachen.de/acs/public/villas/node/
synced 2025-03-09 00:00:00 +01:00
135 lines
3.2 KiB
C++
135 lines
3.2 KiB
C++
/* Helpers for USB node-types.
|
|
*
|
|
* Author: Steffen Vogel <post@steffenvogel.de>
|
|
* SPDX-FileCopyrightText: 2014-2023 Institute for Automation of Complex Power Systems, RWTH Aachen University
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <villas/log.hpp>
|
|
#include <villas/usb.hpp>
|
|
|
|
using namespace villas;
|
|
using namespace villas::usb;
|
|
|
|
static struct libusb_context *context = nullptr;
|
|
|
|
static int context_users = 0;
|
|
|
|
static Logger logger;
|
|
|
|
static enum libusb_log_level spdlog_to_libusb_log_level(Log::Level lvl) {
|
|
switch (lvl) {
|
|
case Log::Level::trace:
|
|
case Log::Level::debug:
|
|
return LIBUSB_LOG_LEVEL_DEBUG;
|
|
|
|
case Log::Level::info:
|
|
return LIBUSB_LOG_LEVEL_INFO;
|
|
|
|
case Log::Level::warn:
|
|
return LIBUSB_LOG_LEVEL_WARNING;
|
|
|
|
case Log::Level::err:
|
|
case Log::Level::critical:
|
|
return LIBUSB_LOG_LEVEL_ERROR;
|
|
|
|
default:
|
|
case Log::Level::off:
|
|
return LIBUSB_LOG_LEVEL_NONE;
|
|
}
|
|
}
|
|
|
|
static Log::Level libusb_to_spdlog_log_level(enum libusb_log_level lvl) {
|
|
switch (lvl) {
|
|
case LIBUSB_LOG_LEVEL_ERROR:
|
|
return Log::Level::err;
|
|
|
|
case LIBUSB_LOG_LEVEL_WARNING:
|
|
return Log::Level::warn;
|
|
|
|
case LIBUSB_LOG_LEVEL_INFO:
|
|
return Log::Level::info;
|
|
|
|
case LIBUSB_LOG_LEVEL_DEBUG:
|
|
return Log::Level::debug;
|
|
|
|
case LIBUSB_LOG_LEVEL_NONE:
|
|
default:
|
|
return Log::Level::off;
|
|
}
|
|
}
|
|
|
|
static void log_cb(struct libusb_context *ctx, enum libusb_log_level lvl,
|
|
const char *str) {
|
|
auto level = libusb_to_spdlog_log_level(lvl);
|
|
|
|
logger->log(level, str);
|
|
}
|
|
|
|
void villas::usb::detach(struct libusb_device_handle *handle, int iface) {
|
|
int ret;
|
|
|
|
ret = libusb_detach_kernel_driver(handle, iface);
|
|
if (ret != LIBUSB_SUCCESS)
|
|
throw Error(ret, "Failed to detach USB device from kernel driver");
|
|
}
|
|
|
|
struct libusb_context *villas::usb::init() {
|
|
int ret;
|
|
struct libusb_context *ctx;
|
|
|
|
logger = Log::get("usb");
|
|
|
|
ret = libusb_init(&ctx);
|
|
if (ret)
|
|
throw Error(ret, "Failed to initialize libusb context");
|
|
|
|
auto lvl = spdlog_to_libusb_log_level(logger->level());
|
|
#if LIBUSBX_API_VERSION < 0x01000106
|
|
libusb_set_debug(ctx, lvl);
|
|
#else
|
|
ret = libusb_set_option(ctx, LIBUSB_OPTION_LOG_LEVEL, lvl);
|
|
if (ret)
|
|
throw Error(ret, "Failed to set libusb log level");
|
|
#endif
|
|
|
|
libusb_set_log_cb(ctx, log_cb, LIBUSB_LOG_CB_GLOBAL);
|
|
|
|
return ctx;
|
|
}
|
|
|
|
void villas::usb::deinit_context(struct libusb_context *ctx) {
|
|
context_users--;
|
|
|
|
if (context_users == 0) {
|
|
libusb_exit(ctx);
|
|
context = nullptr;
|
|
}
|
|
}
|
|
|
|
struct libusb_context *villas::usb::get_context() {
|
|
if (context == nullptr)
|
|
context = init();
|
|
|
|
context_users++;
|
|
|
|
return context;
|
|
}
|
|
|
|
bool Device::match(const Filter *flt) const {
|
|
return (flt->bus < 0 || flt->bus == getBus()) &&
|
|
(flt->port < 0 || flt->port == getPort()) &&
|
|
(flt->vendor_id < 0 || flt->vendor_id == getDescriptor().idVendor) &&
|
|
(flt->product_id < 0 || flt->product_id == getDescriptor().idProduct);
|
|
}
|
|
|
|
std::string Device::getStringDescriptor(uint8_t desc_id) const {
|
|
int ret;
|
|
unsigned char buf[256];
|
|
|
|
ret = libusb_get_string_descriptor_ascii(handle, desc_id, buf, sizeof(buf));
|
|
if (ret != LIBUSB_SUCCESS)
|
|
throw RuntimeError("Failed to get USB string descriptor");
|
|
|
|
return (char *)buf;
|
|
}
|