mirror of
https://github.com/godotengine/godot.git
synced 2025-10-23 09:53:25 +00:00
Effective DisplayServer separation, rename X11 -> LinuxBSD
This commit is contained in:
Juan Linietsky
Juan Linietsky
parent
4396e98834
commit
f8a79a97c7
83 changed files with 1304 additions and 5378 deletions
554
platform/linuxbsd/joypad_linux.cpp
Normal file
554
platform/linuxbsd/joypad_linux.cpp
Normal file
|
|
@ -0,0 +1,554 @@
|
|||
/*************************************************************************/
|
||||
/* joypad_linux.cpp */
|
||||
/*************************************************************************/
|
||||
/* This file is part of: */
|
||||
/* GODOT ENGINE */
|
||||
/* https://godotengine.org */
|
||||
/*************************************************************************/
|
||||
/* Copyright (c) 2007-2020 Juan Linietsky, Ariel Manzur. */
|
||||
/* Copyright (c) 2014-2020 Godot Engine contributors (cf. AUTHORS.md). */
|
||||
/* */
|
||||
/* Permission is hereby granted, free of charge, to any person obtaining */
|
||||
/* a copy of this software and associated documentation files (the */
|
||||
/* "Software"), to deal in the Software without restriction, including */
|
||||
/* without limitation the rights to use, copy, modify, merge, publish, */
|
||||
/* distribute, sublicense, and/or sell copies of the Software, and to */
|
||||
/* permit persons to whom the Software is furnished to do so, subject to */
|
||||
/* the following conditions: */
|
||||
/* */
|
||||
/* The above copyright notice and this permission notice shall be */
|
||||
/* included in all copies or substantial portions of the Software. */
|
||||
/* */
|
||||
/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
|
||||
/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
|
||||
/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
|
||||
/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
|
||||
/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
|
||||
/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
|
||||
/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
|
||||
/*************************************************************************/
|
||||
|
||||
#ifdef JOYDEV_ENABLED
|
||||
|
||||
#include "joypad_linux.h"
|
||||
|
||||
#include <errno.h>
|
||||
#include <fcntl.h>
|
||||
#include <linux/input.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#ifdef UDEV_ENABLED
|
||||
#include <libudev.h>
|
||||
#endif
|
||||
|
||||
#define LONG_BITS (sizeof(long) * 8)
|
||||
#define test_bit(nr, addr) (((1UL << ((nr) % LONG_BITS)) & ((addr)[(nr) / LONG_BITS])) != 0)
|
||||
#define NBITS(x) ((((x)-1) / LONG_BITS) + 1)
|
||||
|
||||
#ifdef UDEV_ENABLED
|
||||
static const char *ignore_str = "/dev/input/js";
|
||||
#endif
|
||||
|
||||
JoypadLinux::Joypad::Joypad() {
|
||||
fd = -1;
|
||||
dpad = 0;
|
||||
devpath = "";
|
||||
for (int i = 0; i < MAX_ABS; i++) {
|
||||
abs_info[i] = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
JoypadLinux::Joypad::~Joypad() {
|
||||
|
||||
for (int i = 0; i < MAX_ABS; i++) {
|
||||
if (abs_info[i]) {
|
||||
memdelete(abs_info[i]);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void JoypadLinux::Joypad::reset() {
|
||||
dpad = 0;
|
||||
fd = -1;
|
||||
|
||||
Input::JoyAxis jx;
|
||||
jx.min = -1;
|
||||
jx.value = 0.0f;
|
||||
for (int i = 0; i < MAX_ABS; i++) {
|
||||
abs_map[i] = -1;
|
||||
curr_axis[i] = jx;
|
||||
}
|
||||
}
|
||||
|
||||
JoypadLinux::JoypadLinux(Input *in) {
|
||||
exit_udev = false;
|
||||
input = in;
|
||||
joy_thread = Thread::create(joy_thread_func, this);
|
||||
}
|
||||
|
||||
JoypadLinux::~JoypadLinux() {
|
||||
exit_udev = true;
|
||||
Thread::wait_to_finish(joy_thread);
|
||||
memdelete(joy_thread);
|
||||
close_joypad();
|
||||
}
|
||||
|
||||
void JoypadLinux::joy_thread_func(void *p_user) {
|
||||
|
||||
if (p_user) {
|
||||
JoypadLinux *joy = (JoypadLinux *)p_user;
|
||||
joy->run_joypad_thread();
|
||||
}
|
||||
}
|
||||
|
||||
void JoypadLinux::run_joypad_thread() {
|
||||
#ifdef UDEV_ENABLED
|
||||
udev *_udev = udev_new();
|
||||
ERR_FAIL_COND(!_udev);
|
||||
enumerate_joypads(_udev);
|
||||
monitor_joypads(_udev);
|
||||
udev_unref(_udev);
|
||||
#else
|
||||
monitor_joypads();
|
||||
#endif
|
||||
}
|
||||
|
||||
#ifdef UDEV_ENABLED
|
||||
void JoypadLinux::enumerate_joypads(udev *p_udev) {
|
||||
|
||||
udev_enumerate *enumerate;
|
||||
udev_list_entry *devices, *dev_list_entry;
|
||||
udev_device *dev;
|
||||
|
||||
enumerate = udev_enumerate_new(p_udev);
|
||||
udev_enumerate_add_match_subsystem(enumerate, "input");
|
||||
|
||||
udev_enumerate_scan_devices(enumerate);
|
||||
devices = udev_enumerate_get_list_entry(enumerate);
|
||||
udev_list_entry_foreach(dev_list_entry, devices) {
|
||||
|
||||
const char *path = udev_list_entry_get_name(dev_list_entry);
|
||||
dev = udev_device_new_from_syspath(p_udev, path);
|
||||
const char *devnode = udev_device_get_devnode(dev);
|
||||
|
||||
if (devnode) {
|
||||
|
||||
String devnode_str = devnode;
|
||||
if (devnode_str.find(ignore_str) == -1) {
|
||||
MutexLock lock(joy_mutex);
|
||||
open_joypad(devnode);
|
||||
}
|
||||
}
|
||||
udev_device_unref(dev);
|
||||
}
|
||||
udev_enumerate_unref(enumerate);
|
||||
}
|
||||
|
||||
void JoypadLinux::monitor_joypads(udev *p_udev) {
|
||||
|
||||
udev_device *dev = NULL;
|
||||
udev_monitor *mon = udev_monitor_new_from_netlink(p_udev, "udev");
|
||||
udev_monitor_filter_add_match_subsystem_devtype(mon, "input", NULL);
|
||||
udev_monitor_enable_receiving(mon);
|
||||
int fd = udev_monitor_get_fd(mon);
|
||||
|
||||
while (!exit_udev) {
|
||||
|
||||
fd_set fds;
|
||||
struct timeval tv;
|
||||
int ret;
|
||||
|
||||
FD_ZERO(&fds);
|
||||
FD_SET(fd, &fds);
|
||||
tv.tv_sec = 0;
|
||||
tv.tv_usec = 0;
|
||||
|
||||
ret = select(fd + 1, &fds, NULL, NULL, &tv);
|
||||
|
||||
/* Check if our file descriptor has received data. */
|
||||
if (ret > 0 && FD_ISSET(fd, &fds)) {
|
||||
/* Make the call to receive the device.
|
||||
select() ensured that this will not block. */
|
||||
dev = udev_monitor_receive_device(mon);
|
||||
|
||||
if (dev && udev_device_get_devnode(dev) != 0) {
|
||||
|
||||
MutexLock lock(joy_mutex);
|
||||
String action = udev_device_get_action(dev);
|
||||
const char *devnode = udev_device_get_devnode(dev);
|
||||
if (devnode) {
|
||||
|
||||
String devnode_str = devnode;
|
||||
if (devnode_str.find(ignore_str) == -1) {
|
||||
|
||||
if (action == "add")
|
||||
open_joypad(devnode);
|
||||
else if (String(action) == "remove")
|
||||
close_joypad(get_joy_from_path(devnode));
|
||||
}
|
||||
}
|
||||
|
||||
udev_device_unref(dev);
|
||||
}
|
||||
}
|
||||
usleep(50000);
|
||||
}
|
||||
udev_monitor_unref(mon);
|
||||
}
|
||||
#endif
|
||||
|
||||
void JoypadLinux::monitor_joypads() {
|
||||
|
||||
while (!exit_udev) {
|
||||
{
|
||||
MutexLock lock(joy_mutex);
|
||||
|
||||
for (int i = 0; i < 32; i++) {
|
||||
char fname[64];
|
||||
sprintf(fname, "/dev/input/event%d", i);
|
||||
if (attached_devices.find(fname) == -1) {
|
||||
open_joypad(fname);
|
||||
}
|
||||
}
|
||||
}
|
||||
usleep(1000000); // 1s
|
||||
}
|
||||
}
|
||||
|
||||
int JoypadLinux::get_joy_from_path(String p_path) const {
|
||||
|
||||
for (int i = 0; i < JOYPADS_MAX; i++) {
|
||||
|
||||
if (joypads[i].devpath == p_path) {
|
||||
return i;
|
||||
}
|
||||
}
|
||||
return -2;
|
||||
}
|
||||
|
||||
void JoypadLinux::close_joypad(int p_id) {
|
||||
if (p_id == -1) {
|
||||
for (int i = 0; i < JOYPADS_MAX; i++) {
|
||||
|
||||
close_joypad(i);
|
||||
};
|
||||
return;
|
||||
} else if (p_id < 0)
|
||||
return;
|
||||
|
||||
Joypad &joy = joypads[p_id];
|
||||
|
||||
if (joy.fd != -1) {
|
||||
|
||||
close(joy.fd);
|
||||
joy.fd = -1;
|
||||
attached_devices.remove(attached_devices.find(joy.devpath));
|
||||
input->joy_connection_changed(p_id, false, "");
|
||||
};
|
||||
}
|
||||
|
||||
static String _hex_str(uint8_t p_byte) {
|
||||
|
||||
static const char *dict = "0123456789abcdef";
|
||||
char ret[3];
|
||||
ret[2] = 0;
|
||||
|
||||
ret[0] = dict[p_byte >> 4];
|
||||
ret[1] = dict[p_byte & 0xF];
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
void JoypadLinux::setup_joypad_properties(int p_id) {
|
||||
|
||||
Joypad *joy = &joypads[p_id];
|
||||
|
||||
unsigned long keybit[NBITS(KEY_MAX)] = { 0 };
|
||||
unsigned long absbit[NBITS(ABS_MAX)] = { 0 };
|
||||
|
||||
int num_buttons = 0;
|
||||
int num_axes = 0;
|
||||
|
||||
if ((ioctl(joy->fd, EVIOCGBIT(EV_KEY, sizeof(keybit)), keybit) < 0) ||
|
||||
(ioctl(joy->fd, EVIOCGBIT(EV_ABS, sizeof(absbit)), absbit) < 0)) {
|
||||
return;
|
||||
}
|
||||
for (int i = BTN_JOYSTICK; i < KEY_MAX; ++i) {
|
||||
|
||||
if (test_bit(i, keybit)) {
|
||||
|
||||
joy->key_map[i] = num_buttons++;
|
||||
}
|
||||
}
|
||||
for (int i = BTN_MISC; i < BTN_JOYSTICK; ++i) {
|
||||
|
||||
if (test_bit(i, keybit)) {
|
||||
|
||||
joy->key_map[i] = num_buttons++;
|
||||
}
|
||||
}
|
||||
for (int i = 0; i < ABS_MISC; ++i) {
|
||||
/* Skip hats */
|
||||
if (i == ABS_HAT0X) {
|
||||
i = ABS_HAT3Y;
|
||||
continue;
|
||||
}
|
||||
if (test_bit(i, absbit)) {
|
||||
|
||||
joy->abs_map[i] = num_axes++;
|
||||
joy->abs_info[i] = memnew(input_absinfo);
|
||||
if (ioctl(joy->fd, EVIOCGABS(i), joy->abs_info[i]) < 0) {
|
||||
memdelete(joy->abs_info[i]);
|
||||
joy->abs_info[i] = NULL;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
joy->force_feedback = false;
|
||||
joy->ff_effect_timestamp = 0;
|
||||
unsigned long ffbit[NBITS(FF_CNT)];
|
||||
if (ioctl(joy->fd, EVIOCGBIT(EV_FF, sizeof(ffbit)), ffbit) != -1) {
|
||||
if (test_bit(FF_RUMBLE, ffbit)) {
|
||||
joy->force_feedback = true;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void JoypadLinux::open_joypad(const char *p_path) {
|
||||
|
||||
int joy_num = input->get_unused_joy_id();
|
||||
int fd = open(p_path, O_RDWR | O_NONBLOCK);
|
||||
if (fd != -1 && joy_num != -1) {
|
||||
|
||||
unsigned long evbit[NBITS(EV_MAX)] = { 0 };
|
||||
unsigned long keybit[NBITS(KEY_MAX)] = { 0 };
|
||||
unsigned long absbit[NBITS(ABS_MAX)] = { 0 };
|
||||
|
||||
// add to attached devices so we don't try to open it again
|
||||
attached_devices.push_back(String(p_path));
|
||||
|
||||
if ((ioctl(fd, EVIOCGBIT(0, sizeof(evbit)), evbit) < 0) ||
|
||||
(ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(keybit)), keybit) < 0) ||
|
||||
(ioctl(fd, EVIOCGBIT(EV_ABS, sizeof(absbit)), absbit) < 0)) {
|
||||
close(fd);
|
||||
return;
|
||||
}
|
||||
|
||||
//check if the device supports basic gamepad events, prevents certain keyboards from
|
||||
//being detected as joypads
|
||||
if (!(test_bit(EV_KEY, evbit) && test_bit(EV_ABS, evbit) &&
|
||||
(test_bit(ABS_X, absbit) || test_bit(ABS_Y, absbit) || test_bit(ABS_HAT0X, absbit) ||
|
||||
test_bit(ABS_GAS, absbit) || test_bit(ABS_RUDDER, absbit)) &&
|
||||
(test_bit(BTN_A, keybit) || test_bit(BTN_THUMBL, keybit) ||
|
||||
test_bit(BTN_TRIGGER, keybit) || test_bit(BTN_1, keybit))) &&
|
||||
!(test_bit(EV_ABS, evbit) &&
|
||||
test_bit(ABS_X, absbit) && test_bit(ABS_Y, absbit) &&
|
||||
test_bit(ABS_RX, absbit) && test_bit(ABS_RY, absbit))) {
|
||||
close(fd);
|
||||
return;
|
||||
}
|
||||
|
||||
char uid[128];
|
||||
char namebuf[128];
|
||||
String name = "";
|
||||
input_id inpid;
|
||||
if (ioctl(fd, EVIOCGNAME(sizeof(namebuf)), namebuf) >= 0) {
|
||||
name = namebuf;
|
||||
}
|
||||
|
||||
if (ioctl(fd, EVIOCGID, &inpid) < 0) {
|
||||
close(fd);
|
||||
return;
|
||||
}
|
||||
|
||||
joypads[joy_num].reset();
|
||||
|
||||
Joypad &joy = joypads[joy_num];
|
||||
joy.fd = fd;
|
||||
joy.devpath = String(p_path);
|
||||
setup_joypad_properties(joy_num);
|
||||
sprintf(uid, "%04x%04x", BSWAP16(inpid.bustype), 0);
|
||||
if (inpid.vendor && inpid.product && inpid.version) {
|
||||
|
||||
uint16_t vendor = BSWAP16(inpid.vendor);
|
||||
uint16_t product = BSWAP16(inpid.product);
|
||||
uint16_t version = BSWAP16(inpid.version);
|
||||
|
||||
sprintf(uid + String(uid).length(), "%04x%04x%04x%04x%04x%04x", vendor, 0, product, 0, version, 0);
|
||||
input->joy_connection_changed(joy_num, true, name, uid);
|
||||
} else {
|
||||
String uidname = uid;
|
||||
int uidlen = MIN(name.length(), 11);
|
||||
for (int i = 0; i < uidlen; i++) {
|
||||
|
||||
uidname = uidname + _hex_str(name[i]);
|
||||
}
|
||||
uidname += "00";
|
||||
input->joy_connection_changed(joy_num, true, name, uidname);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void JoypadLinux::joypad_vibration_start(int p_id, float p_weak_magnitude, float p_strong_magnitude, float p_duration, uint64_t p_timestamp) {
|
||||
Joypad &joy = joypads[p_id];
|
||||
if (!joy.force_feedback || joy.fd == -1 || p_weak_magnitude < 0.f || p_weak_magnitude > 1.f || p_strong_magnitude < 0.f || p_strong_magnitude > 1.f) {
|
||||
return;
|
||||
}
|
||||
if (joy.ff_effect_id != -1) {
|
||||
joypad_vibration_stop(p_id, p_timestamp);
|
||||
}
|
||||
|
||||
struct ff_effect effect;
|
||||
effect.type = FF_RUMBLE;
|
||||
effect.id = -1;
|
||||
effect.u.rumble.weak_magnitude = floor(p_weak_magnitude * (float)0xffff);
|
||||
effect.u.rumble.strong_magnitude = floor(p_strong_magnitude * (float)0xffff);
|
||||
effect.replay.length = floor(p_duration * 1000);
|
||||
effect.replay.delay = 0;
|
||||
|
||||
if (ioctl(joy.fd, EVIOCSFF, &effect) < 0) {
|
||||
return;
|
||||
}
|
||||
|
||||
struct input_event play;
|
||||
play.type = EV_FF;
|
||||
play.code = effect.id;
|
||||
play.value = 1;
|
||||
if (write(joy.fd, (const void *)&play, sizeof(play)) == -1) {
|
||||
print_verbose("Couldn't write to Joypad device.");
|
||||
}
|
||||
|
||||
joy.ff_effect_id = effect.id;
|
||||
joy.ff_effect_timestamp = p_timestamp;
|
||||
}
|
||||
|
||||
void JoypadLinux::joypad_vibration_stop(int p_id, uint64_t p_timestamp) {
|
||||
Joypad &joy = joypads[p_id];
|
||||
if (!joy.force_feedback || joy.fd == -1 || joy.ff_effect_id == -1) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (ioctl(joy.fd, EVIOCRMFF, joy.ff_effect_id) < 0) {
|
||||
return;
|
||||
}
|
||||
|
||||
joy.ff_effect_id = -1;
|
||||
joy.ff_effect_timestamp = p_timestamp;
|
||||
}
|
||||
|
||||
Input::JoyAxis JoypadLinux::axis_correct(const input_absinfo *p_abs, int p_value) const {
|
||||
|
||||
int min = p_abs->minimum;
|
||||
int max = p_abs->maximum;
|
||||
Input::JoyAxis jx;
|
||||
|
||||
if (min < 0) {
|
||||
jx.min = -1;
|
||||
if (p_value < 0) {
|
||||
jx.value = (float)-p_value / min;
|
||||
} else {
|
||||
jx.value = (float)p_value / max;
|
||||
}
|
||||
} else if (min == 0) {
|
||||
jx.min = 0;
|
||||
jx.value = 0.0f + (float)p_value / max;
|
||||
}
|
||||
return jx;
|
||||
}
|
||||
|
||||
void JoypadLinux::process_joypads() {
|
||||
|
||||
if (joy_mutex.try_lock() != OK) {
|
||||
return;
|
||||
}
|
||||
for (int i = 0; i < JOYPADS_MAX; i++) {
|
||||
|
||||
if (joypads[i].fd == -1) continue;
|
||||
|
||||
input_event events[32];
|
||||
Joypad *joy = &joypads[i];
|
||||
|
||||
int len;
|
||||
|
||||
while ((len = read(joy->fd, events, (sizeof events))) > 0) {
|
||||
len /= sizeof(events[0]);
|
||||
for (int j = 0; j < len; j++) {
|
||||
|
||||
input_event &ev = events[j];
|
||||
|
||||
// ev may be tainted and out of MAX_KEY range, which will cause
|
||||
// joy->key_map[ev.code] to crash
|
||||
if (ev.code >= MAX_KEY)
|
||||
return;
|
||||
|
||||
switch (ev.type) {
|
||||
case EV_KEY:
|
||||
input->joy_button(i, joy->key_map[ev.code], ev.value);
|
||||
break;
|
||||
|
||||
case EV_ABS:
|
||||
|
||||
switch (ev.code) {
|
||||
case ABS_HAT0X:
|
||||
if (ev.value != 0) {
|
||||
if (ev.value < 0)
|
||||
joy->dpad |= Input::HAT_MASK_LEFT;
|
||||
else
|
||||
joy->dpad |= Input::HAT_MASK_RIGHT;
|
||||
} else
|
||||
joy->dpad &= ~(Input::HAT_MASK_LEFT | Input::HAT_MASK_RIGHT);
|
||||
|
||||
input->joy_hat(i, joy->dpad);
|
||||
break;
|
||||
|
||||
case ABS_HAT0Y:
|
||||
if (ev.value != 0) {
|
||||
if (ev.value < 0)
|
||||
joy->dpad |= Input::HAT_MASK_UP;
|
||||
else
|
||||
joy->dpad |= Input::HAT_MASK_DOWN;
|
||||
} else
|
||||
joy->dpad &= ~(Input::HAT_MASK_UP | Input::HAT_MASK_DOWN);
|
||||
|
||||
input->joy_hat(i, joy->dpad);
|
||||
break;
|
||||
|
||||
default:
|
||||
if (ev.code >= MAX_ABS)
|
||||
return;
|
||||
if (joy->abs_map[ev.code] != -1 && joy->abs_info[ev.code]) {
|
||||
Input::JoyAxis value = axis_correct(joy->abs_info[ev.code], ev.value);
|
||||
joy->curr_axis[joy->abs_map[ev.code]] = value;
|
||||
}
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
for (int j = 0; j < MAX_ABS; j++) {
|
||||
int index = joy->abs_map[j];
|
||||
if (index != -1) {
|
||||
input->joy_axis(i, index, joy->curr_axis[index]);
|
||||
}
|
||||
}
|
||||
if (len == 0 || (len < 0 && errno != EAGAIN)) {
|
||||
close_joypad(i);
|
||||
};
|
||||
|
||||
if (joy->force_feedback) {
|
||||
uint64_t timestamp = input->get_joy_vibration_timestamp(i);
|
||||
if (timestamp > joy->ff_effect_timestamp) {
|
||||
Vector2 strength = input->get_joy_vibration_strength(i);
|
||||
float duration = input->get_joy_vibration_duration(i);
|
||||
if (strength.x == 0 && strength.y == 0) {
|
||||
joypad_vibration_stop(i, timestamp);
|
||||
} else {
|
||||
joypad_vibration_start(i, strength.x, strength.y, duration, timestamp);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
joy_mutex.unlock();
|
||||
}
|
||||
#endif
|
||||
Loading…
Add table
Add a link
Reference in a new issue