// Copyright 2015 Dolphin Emulator Project // SPDX-License-Identifier: GPL-2.0-or-later #include #include #include #include #include #include #include #include #include #include "Common/Assert.h" #include "Common/Flag.h" #include "Common/Logging/Log.h" #include "Common/MathUtil.h" #include "Common/ScopeGuard.h" #include "Common/StringUtil.h" #include "Common/Thread.h" #include "InputCommon/ControllerInterface/ControllerInterface.h" #include "InputCommon/ControllerInterface/evdev/evdev.h" namespace ciface::evdev { class Input : public Core::Device::Input { public: Input(u16 code, libevdev* dev) : m_code(code), m_dev(dev) {} protected: const u16 m_code; libevdev* const m_dev; }; class Button : public Input { public: Button(u8 index, u16 code, libevdev* dev) : Input(code, dev), m_index(index) {} ControlState GetState() const final override { int value = 0; libevdev_fetch_event_value(m_dev, EV_KEY, m_code, &value); return value; } protected: std::optional GetEventCodeName() const { if (const char* code_name = libevdev_event_code_get_name(EV_KEY, m_code)) { const auto name = StripSpaces(code_name); for (auto remove_prefix : {"BTN_", "KEY_"}) { if (name.find(remove_prefix) == 0) return std::string(name.substr(std::strlen(remove_prefix))); } return std::string(name); } else { return std::nullopt; } } std::string GetIndexedName() const { return "Button " + std::to_string(m_index); } const u8 m_index; }; class NumberedButton final : public Button { public: using Button::Button; std::string GetName() const override { return GetIndexedName(); } }; class NamedButton final : public Button { public: using Button::Button; bool IsMatchingName(std::string_view name) const final override { // Match either the "START" naming provided by evdev or the "Button 0"-like naming. return name == GetEventCodeName() || name == GetIndexedName(); } std::string GetName() const override { return GetEventCodeName().value_or(GetIndexedName()); } }; class NamedButtonWithNoBackwardsCompat final : public Button { public: using Button::Button; std::string GetName() const override { return GetEventCodeName().value_or(GetIndexedName()); } }; class AnalogInput : public Input { public: using Input::Input; ControlState GetState() const final override { int value = 0; libevdev_fetch_event_value(m_dev, EV_ABS, m_code, &value); return (value - m_base) / m_range; } protected: ControlState m_range; int m_base; }; class Axis : public AnalogInput { public: Axis(u8 index, u16 code, bool upper, libevdev* dev) : AnalogInput(code, dev), m_index(index) { const int min = libevdev_get_abs_minimum(m_dev, m_code); const int max = libevdev_get_abs_maximum(m_dev, m_code); m_base = (max + min) / 2; m_range = (upper ? max : min) - m_base; } std::string GetName() const override { return GetIndexedName(); } protected: std::string GetIndexedName() const { return "Axis " + std::to_string(m_index) + (m_range < 0 ? '-' : '+'); } private: const u8 m_index; }; class MotionDataInput final : public AnalogInput { public: MotionDataInput(u16 code, ControlState resolution_scale, libevdev* dev) : AnalogInput(code, dev) { auto* const info = libevdev_get_abs_info(m_dev, m_code); // The average of the minimum and maximum value. (neutral value) m_base = (info->maximum + info->minimum) / 2; m_range = info->resolution / resolution_scale; } std::string GetName() const override { // Unfortunately there doesn't seem to be a "standard" orientation // so we can't use "Accel Up"-like names. constexpr std::array motion_data_names = {{ "Accel X", "Accel Y", "Accel Z", "Gyro X", "Gyro Y", "Gyro Z", }}; // Our name array relies on sane axis codes from 0 to 5. static_assert(ABS_X == 0, "evdev axis value sanity check"); static_assert(ABS_RX == 3, "evdev axis value sanity check"); return std::string(motion_data_names[m_code]) + (m_range < 0 ? '-' : '+'); } bool IsDetectable() const override { return false; } }; class CursorInput final : public Axis { public: using Axis::Axis; std::string GetName() const final override { // "Cursor X-" naming. return std::string("Cursor ") + char('X' + m_code) + (m_range < 0 ? '-' : '+'); } bool IsDetectable() const override { return false; } }; static std::thread s_hotplug_thread; static Common::Flag s_hotplug_thread_running; static int s_wakeup_eventfd; // There is no easy way to get the device name from only a dev node // during a device removed event, since libevdev can't work on removed devices; // sysfs is not stable, so this is probably the easiest way to get a name for a node. // This can, and will be modified by different thread, possibly concurrently, // as devices can be destroyed by any thread at any time. As of now it's protected // by ControllerInterface::m_devices_population_mutex. static std::map> s_devnode_objects; static std::shared_ptr FindDeviceWithUniqueIDAndPhysicalLocation(const char* unique_id, const char* physical_location) { if (!unique_id || !physical_location) return nullptr; for (auto& [node, dev] : s_devnode_objects) { if (const auto device = dev.lock()) { const auto* dev_uniq = device->GetUniqueID(); const auto* dev_phys = device->GetPhysicalLocation(); if (dev_uniq && dev_phys && std::strcmp(dev_uniq, unique_id) == 0 && std::strcmp(dev_phys, physical_location) == 0) { return device; } } } return nullptr; } static void AddDeviceNode(const char* devnode) { // Unfortunately udev gives us no way to filter out the non event device interfaces. // So we open it and see if it works with evdev ioctls or not. // The device file will be read on one of the main threads, so we open in non-blocking mode. const int fd = open(devnode, O_RDWR | O_NONBLOCK); if (fd == -1) { return; } libevdev* dev = nullptr; if (libevdev_new_from_fd(fd, &dev) != 0) { // This usually fails because the device node isn't an evdev device, such as /dev/input/js0 close(fd); return; } const auto uniq = libevdev_get_uniq(dev); const auto phys = libevdev_get_phys(dev); auto evdev_device = FindDeviceWithUniqueIDAndPhysicalLocation(uniq, phys); if (evdev_device) { NOTICE_LOG_FMT(CONTROLLERINTERFACE, "evdev combining devices with unique id: {}, physical location: {}", uniq, phys); evdev_device->AddNode(devnode, fd, dev); // Remove and re-add device as naming and inputs may have changed. // This will also give it the correct index and invoke device change callbacks. // Make sure to force the device removal immediately (as they are shared ptrs and // they could be kept alive, preventing us from re-creating the device) g_controller_interface.RemoveDevice( [&evdev_device](const auto* device) { return static_cast(device) == evdev_device.get(); }, true); g_controller_interface.AddDevice(evdev_device); } else { evdev_device = std::make_shared(); const bool was_interesting = evdev_device->AddNode(devnode, fd, dev); if (was_interesting) g_controller_interface.AddDevice(evdev_device); } // If the devices failed to be added to g_controller_interface, it will be added here but then // immediately removed in its destructor due to the shared ptr not having any references left s_devnode_objects.emplace(devnode, std::move(evdev_device)); } static void HotplugThreadFunc() { Common::SetCurrentThreadName("evdev Hotplug Thread"); NOTICE_LOG_FMT(CONTROLLERINTERFACE, "evdev hotplug thread started"); udev* const udev = udev_new(); Common::ScopeGuard udev_guard([udev] { udev_unref(udev); }); ASSERT_MSG(PAD, udev != nullptr, "Couldn't initialize libudev."); // Set up monitoring udev_monitor* const monitor = udev_monitor_new_from_netlink(udev, "udev"); Common::ScopeGuard monitor_guard([monitor] { udev_monitor_unref(monitor); }); udev_monitor_filter_add_match_subsystem_devtype(monitor, "input", nullptr); udev_monitor_enable_receiving(monitor); const int monitor_fd = udev_monitor_get_fd(monitor); while (s_hotplug_thread_running.IsSet()) { fd_set fds; FD_ZERO(&fds); FD_SET(monitor_fd, &fds); FD_SET(s_wakeup_eventfd, &fds); const int ret = select(std::max(monitor_fd, s_wakeup_eventfd) + 1, &fds, nullptr, nullptr, nullptr); if (ret < 1 || !FD_ISSET(monitor_fd, &fds)) continue; udev_device* const dev = udev_monitor_receive_device(monitor); Common::ScopeGuard dev_guard([dev] { udev_device_unref(dev); }); const char* const action = udev_device_get_action(dev); const char* const devnode = udev_device_get_devnode(dev); if (!devnode) continue; // Use g_controller_interface.PlatformPopulateDevices() to protect access around // s_devnode_objects. Note that even if we get these events at the same time as a // a PopulateDevices() request (e.g. on start up, we might get all the add events // for connected devices), this won't ever cause duplicate devices as AddDeviceNode() // automatically removes the old one if it already existed if (strcmp(action, "remove") == 0) { g_controller_interface.PlatformPopulateDevices([&devnode] { std::shared_ptr ptr; const auto it = s_devnode_objects.find(devnode); if (it != s_devnode_objects.end()) ptr = it->second.lock(); // If we don't recognize this device, ptr will be null and no device will be removed. g_controller_interface.RemoveDevice([&ptr](const auto* device) { return static_cast(device) == ptr.get(); }); }); } else if (strcmp(action, "add") == 0) { g_controller_interface.PlatformPopulateDevices([&devnode] { AddDeviceNode(devnode); }); } } NOTICE_LOG_FMT(CONTROLLERINTERFACE, "evdev hotplug thread stopped"); } static void StartHotplugThread() { // Mark the thread as running. if (!s_hotplug_thread_running.TestAndSet()) { // It was already running. return; } s_wakeup_eventfd = eventfd(0, 0); ASSERT_MSG(PAD, s_wakeup_eventfd != -1, "Couldn't create eventfd."); s_hotplug_thread = std::thread(HotplugThreadFunc); } static void StopHotplugThread() { // Tell the hotplug thread to stop. if (!s_hotplug_thread_running.TestAndClear()) { // It wasn't running, we're done. return; } // Write something to efd so that select() stops blocking. const uint64_t value = 1; static_cast(!write(s_wakeup_eventfd, &value, sizeof(uint64_t))); s_hotplug_thread.join(); close(s_wakeup_eventfd); } void Init() { StartHotplugThread(); } // Only call this when ControllerInterface::m_devices_population_mutex is locked void PopulateDevices() { // Don't run if we are not initialized if (!s_hotplug_thread_running.IsSet()) { return; } // We use udev to iterate over all /dev/input/event* devices. // Note: the Linux kernel is currently limited to just 32 event devices. If // this ever changes, hopefully udev will take care of this. udev* const udev = udev_new(); ASSERT_MSG(PAD, udev != nullptr, "Couldn't initialize libudev."); // List all input devices udev_enumerate* const enumerate = udev_enumerate_new(udev); udev_enumerate_add_match_subsystem(enumerate, "input"); udev_enumerate_scan_devices(enumerate); udev_list_entry* const devices = udev_enumerate_get_list_entry(enumerate); // Iterate over all input devices udev_list_entry* dev_list_entry; udev_list_entry_foreach(dev_list_entry, devices) { const char* path = udev_list_entry_get_name(dev_list_entry); udev_device* dev = udev_device_new_from_syspath(udev, path); if (const char* devnode = udev_device_get_devnode(dev)) AddDeviceNode(devnode); udev_device_unref(dev); } udev_enumerate_unref(enumerate); udev_unref(udev); } void Shutdown() { StopHotplugThread(); } bool evdevDevice::AddNode(std::string devnode, int fd, libevdev* dev) { m_nodes.emplace_back(Node{std::move(devnode), fd, dev}); // Take on the alphabetically first name. const auto potential_new_name = StripSpaces(libevdev_get_name(dev)); if (m_name.empty() || potential_new_name < m_name) m_name = potential_new_name; const bool is_motion_device = libevdev_has_property(dev, INPUT_PROP_ACCELEROMETER); const bool is_pointing_device = libevdev_has_property(dev, INPUT_PROP_BUTTONPAD); // If a device has BTN_JOYSTICK it probably uses event codes counting up from 0x120 // which have very useless and wrong names. const bool has_btn_joystick = libevdev_has_event_code(dev, EV_KEY, BTN_JOYSTICK); const bool has_sensible_button_names = !has_btn_joystick; // Buttons (and keyboard keys) int num_buttons = 0; for (int key = 0; key != KEY_CNT; ++key) { if (libevdev_has_event_code(dev, EV_KEY, key)) { if (is_pointing_device || is_motion_device) { // This node will probably be combined with another with regular buttons. // We don't want to match "Button 0" names here as it will name clash. AddInput(new NamedButtonWithNoBackwardsCompat(num_buttons, key, dev)); } else if (has_sensible_button_names) { AddInput(new NamedButton(num_buttons, key, dev)); } else { AddInput(new NumberedButton(num_buttons, key, dev)); } ++num_buttons; } } int num_axis = 0; if (is_motion_device) { // If INPUT_PROP_ACCELEROMETER is set then X,Y,Z,RX,RY,RZ contain motion data. auto add_motion_inputs = [&num_axis, dev, this](int first_code, double scale) { for (int i = 0; i != 3; ++i) { const int code = first_code + i; if (libevdev_has_event_code(dev, EV_ABS, code)) { AddInput(new MotionDataInput(code, scale * -1, dev)); AddInput(new MotionDataInput(code, scale, dev)); ++num_axis; } } }; // evdev resolution is specified in "g"s and deg/s. // Convert these to m/s/s and rad/s. constexpr ControlState accel_scale = MathUtil::GRAVITY_ACCELERATION; constexpr ControlState gyro_scale = MathUtil::TAU / 360; add_motion_inputs(ABS_X, accel_scale); add_motion_inputs(ABS_RX, gyro_scale); return true; } if (is_pointing_device) { auto add_cursor_input = [&num_axis, dev, this](int code) { if (libevdev_has_event_code(dev, EV_ABS, code)) { AddInput(new CursorInput(num_axis, code, false, dev)); AddInput(new CursorInput(num_axis, code, true, dev)); ++num_axis; } }; add_cursor_input(ABS_X); add_cursor_input(ABS_Y); return true; } // Axes beyond ABS_MISC have strange behavior (for multi-touch) which we do not handle. const int abs_axis_code_count = ABS_MISC; // Absolute axis (thumbsticks) for (int axis = 0; axis != abs_axis_code_count; ++axis) { if (libevdev_has_event_code(dev, EV_ABS, axis)) { AddAnalogInputs(new Axis(num_axis, axis, false, dev), new Axis(num_axis, axis, true, dev)); ++num_axis; } } // Disable autocenter if (libevdev_has_event_code(dev, EV_FF, FF_AUTOCENTER)) { input_event ie = {}; ie.type = EV_FF; ie.code = FF_AUTOCENTER; ie.value = 0; static_cast(!write(fd, &ie, sizeof(ie))); } // Constant FF effect if (libevdev_has_event_code(dev, EV_FF, FF_CONSTANT)) { AddOutput(new ConstantEffect(fd)); } // Periodic FF effects if (libevdev_has_event_code(dev, EV_FF, FF_PERIODIC)) { for (auto wave : {FF_SINE, FF_SQUARE, FF_TRIANGLE, FF_SAW_UP, FF_SAW_DOWN}) { if (libevdev_has_event_code(dev, EV_FF, wave)) AddOutput(new PeriodicEffect(fd, wave)); } } // Rumble (i.e. Left/Right) (i.e. Strong/Weak) effect if (libevdev_has_event_code(dev, EV_FF, FF_RUMBLE)) { AddOutput(new RumbleEffect(fd, RumbleEffect::Motor::Strong)); AddOutput(new RumbleEffect(fd, RumbleEffect::Motor::Weak)); } // TODO: Add leds as output devices // Filter out interesting devices (see description below) return num_axis >= 2 || num_buttons >= 8; // On modern linux systems, there are a lot of event devices that aren't controllers. // For example, the PC Speaker is an event device. Webcams sometimes show up as // event devices. The power button is an event device. // // We don't want these showing up in the list of controllers, so we use this // heuristic to filter out anything that doesn't smell like a controller: // // More than two analog axis: // Most controllers have at least one stick. This rule will catch all such // controllers, while ignoring anything with a single axis (like the mouse // scroll-wheel) // // --- OR --- // // More than 8 buttons: // The user might be using a digital only pad such as a NES controller. // This rule caches such controllers, while eliminating any device with // only a few buttons, like the power button. Sometimes laptops have devices // with 5 or 6 special buttons, which is why the threshold is set to 8 to // match a NES controller. // // This heuristic is quite loose. The user may still see weird devices showing up // as controllers, but it hopefully shouldn't filter out anything they actually // want to use. } const char* evdevDevice::GetUniqueID() const { if (m_nodes.empty()) return nullptr; const auto uniq = libevdev_get_uniq(m_nodes.front().device); // Some devices (e.g. Mayflash adapter) return an empty string which is not very unique. if (uniq && std::strlen(uniq) == 0) return nullptr; return uniq; } const char* evdevDevice::GetPhysicalLocation() const { if (m_nodes.empty()) return nullptr; return libevdev_get_phys(m_nodes.front().device); } evdevDevice::~evdevDevice() { for (auto& node : m_nodes) { s_devnode_objects.erase(node.devnode); libevdev_free(node.device); close(node.fd); } } void evdevDevice::UpdateInput() { // Run through all evdev events // libevdev will keep track of the actual controller state internally which can be queried // later with libevdev_fetch_event_value() for (auto& node : m_nodes) { int rc = LIBEVDEV_READ_STATUS_SUCCESS; while (rc >= 0) { input_event ev; if (LIBEVDEV_READ_STATUS_SYNC == rc) rc = libevdev_next_event(node.device, LIBEVDEV_READ_FLAG_SYNC, &ev); else rc = libevdev_next_event(node.device, LIBEVDEV_READ_FLAG_NORMAL, &ev); } } } bool evdevDevice::IsValid() const { for (auto& node : m_nodes) { const int current_fd = libevdev_get_fd(node.device); if (current_fd == -1) return false; libevdev* device = nullptr; if (libevdev_new_from_fd(current_fd, &device) != 0) { close(current_fd); return false; } libevdev_free(device); } return true; } evdevDevice::Effect::Effect(int fd) : m_fd(fd) { m_effect.id = -1; // Left (for wheels): m_effect.direction = 0x4000; m_effect.replay.length = RUMBLE_LENGTH_MS; // FYI: type is set within UpdateParameters. m_effect.type = DISABLED_EFFECT_TYPE; } std::string evdevDevice::ConstantEffect::GetName() const { return "Constant"; } std::string evdevDevice::PeriodicEffect::GetName() const { switch (m_effect.u.periodic.waveform) { case FF_SQUARE: return "Square"; case FF_TRIANGLE: return "Triangle"; case FF_SINE: return "Sine"; case FF_SAW_UP: return "Sawtooth Up"; case FF_SAW_DOWN: return "Sawtooth Down"; default: return "Unknown"; } } std::string evdevDevice::RumbleEffect::GetName() const { return (Motor::Strong == m_motor) ? "Strong" : "Weak"; } void evdevDevice::Effect::SetState(ControlState state) { if (UpdateParameters(state)) { // Update effect if parameters changed. UpdateEffect(); } } void evdevDevice::Effect::UpdateEffect() { // libevdev doesn't have nice helpers for forcefeedback // we will use the file descriptors directly. // Note: m_effect.type is set within UpdateParameters // to determine if effect should be playing or not. if (m_effect.type != DISABLED_EFFECT_TYPE) { if (-1 == m_effect.id) { // If effect was not uploaded (previously stopped) // we upload it and start playback ioctl(m_fd, EVIOCSFF, &m_effect); input_event play = {}; play.type = EV_FF; play.code = m_effect.id; play.value = 1; static_cast(!write(m_fd, &play, sizeof(play))); } else { // Effect is already playing. Just update parameters. ioctl(m_fd, EVIOCSFF, &m_effect); } } else { // Stop and remove effect. ioctl(m_fd, EVIOCRMFF, m_effect.id); m_effect.id = -1; } } evdevDevice::ConstantEffect::ConstantEffect(int fd) : Effect(fd) { m_effect.u.constant = {}; } evdevDevice::PeriodicEffect::PeriodicEffect(int fd, u16 waveform) : Effect(fd) { m_effect.u.periodic = {}; m_effect.u.periodic.waveform = waveform; m_effect.u.periodic.period = RUMBLE_PERIOD_MS; m_effect.u.periodic.offset = 0; m_effect.u.periodic.phase = 0; } evdevDevice::RumbleEffect::RumbleEffect(int fd, Motor motor) : Effect(fd), m_motor(motor) { m_effect.u.rumble = {}; } bool evdevDevice::ConstantEffect::UpdateParameters(ControlState state) { s16& value = m_effect.u.constant.level; const s16 old_value = value; constexpr s16 MAX_VALUE = 0x7fff; value = s16(state * MAX_VALUE); m_effect.type = value ? FF_CONSTANT : DISABLED_EFFECT_TYPE; return value != old_value; } bool evdevDevice::PeriodicEffect::UpdateParameters(ControlState state) { s16& value = m_effect.u.periodic.magnitude; const s16 old_value = value; constexpr s16 MAX_VALUE = 0x7fff; value = s16(state * MAX_VALUE); m_effect.type = value ? FF_PERIODIC : DISABLED_EFFECT_TYPE; return value != old_value; } bool evdevDevice::RumbleEffect::UpdateParameters(ControlState state) { u16& value = (Motor::Strong == m_motor) ? m_effect.u.rumble.strong_magnitude : m_effect.u.rumble.weak_magnitude; const u16 old_value = value; constexpr u16 MAX_VALUE = 0xffff; value = u16(state * MAX_VALUE); m_effect.type = value ? FF_RUMBLE : DISABLED_EFFECT_TYPE; return value != old_value; } evdevDevice::Effect::~Effect() { m_effect.type = DISABLED_EFFECT_TYPE; UpdateEffect(); } } // namespace ciface::evdev