aboutsummaryrefslogtreecommitdiff
path: root/platform/x11/joystick_linux.cpp
diff options
context:
space:
mode:
authorhondres2015-12-18 19:15:32 +0100
committerhondres2015-12-18 19:15:32 +0100
commit87dab29f4b71c47cc13e9974dc9462e6109aef96 (patch)
tree2823af35452177fbedae2d1b93c0300d1f6dd481 /platform/x11/joystick_linux.cpp
parentaf633c794179d29a4bf0c01983c8b08d14553596 (diff)
downloadgodot-87dab29f4b71c47cc13e9974dc9462e6109aef96.tar.gz
godot-87dab29f4b71c47cc13e9974dc9462e6109aef96.tar.zst
godot-87dab29f4b71c47cc13e9974dc9462e6109aef96.zip
Diffstat (limited to 'platform/x11/joystick_linux.cpp')
-rw-r--r--platform/x11/joystick_linux.cpp490
1 files changed, 245 insertions, 245 deletions
diff --git a/platform/x11/joystick_linux.cpp b/platform/x11/joystick_linux.cpp
index 3a3f7a57b..cfc4f7cd2 100644
--- a/platform/x11/joystick_linux.cpp
+++ b/platform/x11/joystick_linux.cpp
@@ -43,360 +43,360 @@
static const char* ignore_str = "/dev/input/js";
joystick_linux::Joystick::Joystick() {
- fd = -1;
- dpad = 0;
+ fd = -1;
+ dpad = 0;
}
void joystick_linux::Joystick::reset() {
- num_buttons = 0;
- num_axes = 0;
- dpad = 0;
- fd = -1;
- for (int i=0; i < MAX_ABS; i++) {
- abs_map[i] = -1;
- }
+ num_buttons = 0;
+ num_axes = 0;
+ dpad = 0;
+ fd = -1;
+ for (int i=0; i < MAX_ABS; i++) {
+ abs_map[i] = -1;
+ }
}
joystick_linux::joystick_linux(InputDefault *in)
{
- exit_udev = false;
- input = in;
- joy_mutex = Mutex::create();
- joy_thread = Thread::create(joy_thread_func, this);
+ exit_udev = false;
+ input = in;
+ joy_mutex = Mutex::create();
+ joy_thread = Thread::create(joy_thread_func, this);
}
joystick_linux::~joystick_linux() {
- exit_udev = true;
- Thread::wait_to_finish(joy_thread);
- close_joystick();
+ exit_udev = true;
+ Thread::wait_to_finish(joy_thread);
+ close_joystick();
}
void joystick_linux::joy_thread_func(void *p_user) {
- if (p_user) {
- joystick_linux* joy = (joystick_linux*) p_user;
- joy->run_joystick_thread();
- }
- return;
+ if (p_user) {
+ joystick_linux* joy = (joystick_linux*) p_user;
+ joy->run_joystick_thread();
+ }
+ return;
}
void joystick_linux::run_joystick_thread() {
- udev *_udev = udev_new();
- ERR_FAIL_COND(!_udev);
- enumerate_joysticks(_udev);
- monitor_joysticks(_udev);
- udev_unref(_udev);
+ udev *_udev = udev_new();
+ ERR_FAIL_COND(!_udev);
+ enumerate_joysticks(_udev);
+ monitor_joysticks(_udev);
+ udev_unref(_udev);
}
void joystick_linux::enumerate_joysticks(udev *p_udev) {
- udev_enumerate *enumerate;
- udev_list_entry *devices, *dev_list_entry;
- udev_device *dev;
+ 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_add_match_property(enumerate, "ID_INPUT_JOYSTICK", "1");
+ enumerate = udev_enumerate_new(p_udev);
+ udev_enumerate_add_match_subsystem(enumerate,"input");
+ udev_enumerate_add_match_property(enumerate, "ID_INPUT_JOYSTICK", "1");
- udev_enumerate_scan_devices(enumerate);
- devices = udev_enumerate_get_list_entry(enumerate);
- udev_list_entry_foreach(dev_list_entry, devices) {
+ 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);
+ 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 != NULL && strstr(devnode, ignore_str) == NULL) {
- joy_mutex->lock();
- open_joystick(devnode);
- joy_mutex->unlock();
- }
- udev_device_unref(dev);
- }
- udev_enumerate_unref(enumerate);
+ if (devnode != NULL && strstr(devnode, ignore_str) == NULL) {
+ joy_mutex->lock();
+ open_joystick(devnode);
+ joy_mutex->unlock();
+ }
+ udev_device_unref(dev);
+ }
+ udev_enumerate_unref(enumerate);
}
void joystick_linux::monitor_joysticks(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);
+ 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) {
+ while (!exit_udev) {
- fd_set fds;
- struct timeval tv;
- int ret;
+ fd_set fds;
+ struct timeval tv;
+ int ret;
- FD_ZERO(&fds);
- FD_SET(fd, &fds);
- tv.tv_sec = 0;
- tv.tv_usec = 0;
+ FD_ZERO(&fds);
+ FD_SET(fd, &fds);
+ tv.tv_sec = 0;
+ tv.tv_usec = 0;
- ret = select(fd+1, &fds, NULL, NULL, &tv);
+ 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);
+ /* 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) {
+ if (dev && udev_device_get_devnode(dev) != 0) {
- joy_mutex->lock();
- const char* action = udev_device_get_action(dev);
- const char* devnode = udev_device_get_devnode(dev);
+ joy_mutex->lock();
+ const char* action = udev_device_get_action(dev);
+ const char* devnode = udev_device_get_devnode(dev);
- if (strstr(devnode, ignore_str) == NULL) {
+ if (strstr(devnode, ignore_str) == NULL) {
- if (strcmp(action, "add") == 0)
- open_joystick(devnode);
+ if (strcmp(action, "add") == 0)
+ open_joystick(devnode);
- else if (strcmp(action, "remove") == 0)
- close_joystick(get_joy_from_path(devnode));
- }
+ else if (strcmp(action, "remove") == 0)
+ close_joystick(get_joy_from_path(devnode));
+ }
- udev_device_unref(dev);
- joy_mutex->unlock();
- }
- }
- usleep(50000);
- }
- //printf("exit udev\n");
- udev_monitor_unref(mon);
+ udev_device_unref(dev);
+ joy_mutex->unlock();
+ }
+ }
+ usleep(50000);
+ }
+ //printf("exit udev\n");
+ udev_monitor_unref(mon);
}
int joystick_linux::get_free_joy_slot() const {
- for (int i = 0; i < JOYSTICKS_MAX; i++) {
+ for (int i = 0; i < JOYSTICKS_MAX; i++) {
- if (joysticks[i].fd == -1) return i;
- }
- return -1;
+ if (joysticks[i].fd == -1) return i;
+ }
+ return -1;
}
int joystick_linux::get_joy_from_path(String p_path) const {
- for (int i = 0; i < JOYSTICKS_MAX; i++) {
+ for (int i = 0; i < JOYSTICKS_MAX; i++) {
- if (joysticks[i].devpath == p_path) {
- return i;
- }
- }
- return -2;
+ if (joysticks[i].devpath == p_path) {
+ return i;
+ }
+ }
+ return -2;
}
void joystick_linux::close_joystick(int p_id) {
- if (p_id == -1) {
- for (int i=0; i<JOYSTICKS_MAX; i++) {
+ if (p_id == -1) {
+ for (int i=0; i<JOYSTICKS_MAX; i++) {
- close_joystick(i);
- };
- return;
- }
- else if (p_id < 0) return;
+ close_joystick(i);
+ };
+ return;
+ }
+ else if (p_id < 0) return;
- Joystick &joy = joysticks[p_id];
+ Joystick &joy = joysticks[p_id];
- if (joy.fd != -1) {
+ if (joy.fd != -1) {
- libevdev_free(joy.dev);
- close(joy.fd);
- joy.fd = -1;
- input->joy_connection_changed(p_id, false, "");
- };
+ libevdev_free(joy.dev);
+ close(joy.fd);
+ joy.fd = -1;
+ 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;
+ static const char* dict = "0123456789abcdef";
+ char ret[3];
+ ret[2] = 0;
- ret[0] = dict[p_byte>>4];
- ret[1] = dict[p_byte & 0xF];
+ ret[0] = dict[p_byte>>4];
+ ret[1] = dict[p_byte & 0xF];
- return ret;
+ return ret;
};
void joystick_linux::setup_joystick_properties(int p_id) {
- Joystick* joy = &joysticks[p_id];
+ Joystick* joy = &joysticks[p_id];
- libevdev* dev = joy->dev;
- for (int i = BTN_JOYSTICK; i < KEY_MAX; ++i) {
+ libevdev* dev = joy->dev;
+ for (int i = BTN_JOYSTICK; i < KEY_MAX; ++i) {
- if (libevdev_has_event_code(dev, EV_KEY, i)) {
+ if (libevdev_has_event_code(dev, EV_KEY, i)) {
- joy->key_map[i] = joy->num_buttons++;
- }
- }
- for (int i = BTN_MISC; i < BTN_JOYSTICK; ++i) {
+ joy->key_map[i] = joy->num_buttons++;
+ }
+ }
+ for (int i = BTN_MISC; i < BTN_JOYSTICK; ++i) {
- if (libevdev_has_event_code(dev, EV_KEY, i)) {
+ if (libevdev_has_event_code(dev, EV_KEY, i)) {
- joy->key_map[i] = joy->num_buttons++;
- }
- }
- for (int i = 0; i < ABS_MISC; ++i) {
- /* Skip hats */
- if (i == ABS_HAT0X) {
- i = ABS_HAT3Y;
- continue;
- }
- if (libevdev_has_event_code(dev, EV_ABS, i)) {
+ joy->key_map[i] = joy->num_buttons++;
+ }
+ }
+ for (int i = 0; i < ABS_MISC; ++i) {
+ /* Skip hats */
+ if (i == ABS_HAT0X) {
+ i = ABS_HAT3Y;
+ continue;
+ }
+ if (libevdev_has_event_code(dev, EV_ABS, i)) {
- joy->abs_map[i] = joy->num_axes++;
- }
- }
+ joy->abs_map[i] = joy->num_axes++;
+ }
+ }
}
void joystick_linux::open_joystick(const char *p_path) {
- int joy_num = get_free_joy_slot();
- int fd = open(p_path, O_RDONLY | O_NONBLOCK);
- if (fd != -1 && joy_num != -1) {
+ int joy_num = get_free_joy_slot();
+ int fd = open(p_path, O_RDONLY | O_NONBLOCK);
+ if (fd != -1 && joy_num != -1) {
- int rc = libevdev_new_from_fd(fd, &joysticks[joy_num].dev);
- if (rc < 0) {
+ int rc = libevdev_new_from_fd(fd, &joysticks[joy_num].dev);
+ if (rc < 0) {
- fprintf(stderr, "Failed to init libevdev (%s)\n", strerror(-rc));
- return;
- }
+ fprintf(stderr, "Failed to init libevdev (%s)\n", strerror(-rc));
+ return;
+ }
- libevdev *dev = joysticks[joy_num].dev;
+ libevdev *dev = joysticks[joy_num].dev;
- //check if the device supports basic gamepad events, prevents certain keyboards from
- //being detected as joysticks
- if (libevdev_has_event_type(dev, EV_ABS) && libevdev_has_event_type(dev, EV_KEY) &&
- (libevdev_has_event_code(dev, EV_KEY, BTN_A) || libevdev_has_event_code(dev, EV_KEY, BTN_THUMBL) || libevdev_has_event_code(dev, EV_KEY, BTN_TOP))) {
+ //check if the device supports basic gamepad events, prevents certain keyboards from
+ //being detected as joysticks
+ if (libevdev_has_event_type(dev, EV_ABS) && libevdev_has_event_type(dev, EV_KEY) &&
+ (libevdev_has_event_code(dev, EV_KEY, BTN_A) || libevdev_has_event_code(dev, EV_KEY, BTN_THUMBL) || libevdev_has_event_code(dev, EV_KEY, BTN_TOP))) {
- char uid[128];
- String name = libevdev_get_name(dev);
- uint16_t bus = __bswap_16(libevdev_get_id_bustype(dev));
- uint16_t vendor = __bswap_16(libevdev_get_id_vendor(dev));
- uint16_t product = __bswap_16(libevdev_get_id_product(dev));
- uint16_t version = __bswap_16(libevdev_get_id_version(dev));
+ char uid[128];
+ String name = libevdev_get_name(dev);
+ uint16_t bus = __bswap_16(libevdev_get_id_bustype(dev));
+ uint16_t vendor = __bswap_16(libevdev_get_id_vendor(dev));
+ uint16_t product = __bswap_16(libevdev_get_id_product(dev));
+ uint16_t version = __bswap_16(libevdev_get_id_version(dev));
- joysticks[joy_num].reset();
+ joysticks[joy_num].reset();
- Joystick &joy = joysticks[joy_num];
- joy.fd = fd;
- joy.devpath = String(p_path);
- setup_joystick_properties(joy_num);
- sprintf(uid, "%04x%04x", bus, 0);
- if (vendor && product && version) {
+ Joystick &joy = joysticks[joy_num];
+ joy.fd = fd;
+ joy.devpath = String(p_path);
+ setup_joystick_properties(joy_num);
+ sprintf(uid, "%04x%04x", bus, 0);
+ if (vendor && product && 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++) {
+ 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);
+ uidname = uidname + _hex_str(name[i]);
+ }
+ uidname += "00";
+ input->joy_connection_changed(joy_num, true, name, uidname);
- }
- }
- else {
- //device is not a gamepad, clean up
- libevdev_free(dev);
- close(fd);
- }
- }
+ }
+ }
+ else {
+ //device is not a gamepad, clean up
+ libevdev_free(dev);
+ close(fd);
+ }
+ }
}
InputDefault::JoyAxis joystick_linux::axis_correct(const input_absinfo *p_abs, int p_value) const {
- int min = p_abs->minimum;
- int max = p_abs->maximum;
- InputDefault::JoyAxis jx;
+ int min = p_abs->minimum;
+ int max = p_abs->maximum;
+ InputDefault::JoyAxis jx;
- if (min < 0) {
- jx.min = -1;
- if (p_value < 0) {
- jx.value = (float) -p_value / min;
- }
- jx.value = (float) p_value / max;
- }
- if (min == 0) {
- jx.min = 0;
- jx.value = 0.0f + (float) p_value / max;
- }
- return jx;
+ if (min < 0) {
+ jx.min = -1;
+ if (p_value < 0) {
+ jx.value = (float) -p_value / min;
+ }
+ jx.value = (float) p_value / max;
+ }
+ if (min == 0) {
+ jx.min = 0;
+ jx.value = 0.0f + (float) p_value / max;
+ }
+ return jx;
}
uint32_t joystick_linux::process_joysticks(uint32_t p_event_id) {
- if (joy_mutex->try_lock() != OK) {
- return p_event_id;
- }
- for (int i=0; i<JOYSTICKS_MAX; i++) {
+ if (joy_mutex->try_lock() != OK) {
+ return p_event_id;
+ }
+ for (int i=0; i<JOYSTICKS_MAX; i++) {
- if (joysticks[i].fd == -1) continue;
+ if (joysticks[i].fd == -1) continue;
- input_event ev;
- Joystick* joy = &joysticks[i];
- libevdev* dev = joy->dev;
- int rc = 1;
+ input_event ev;
+ Joystick* joy = &joysticks[i];
+ libevdev* dev = joy->dev;
+ int rc = 1;
- rc = libevdev_next_event(dev, LIBEVDEV_READ_FLAG_NORMAL, &ev);
+ rc = libevdev_next_event(dev, LIBEVDEV_READ_FLAG_NORMAL, &ev);
- if (rc < 0 && rc != -EAGAIN) {
- continue;
- }
+ if (rc < 0 && rc != -EAGAIN) {
+ continue;
+ }
- while (rc == LIBEVDEV_READ_STATUS_SYNC || rc == LIBEVDEV_READ_STATUS_SUCCESS) {
+ while (rc == LIBEVDEV_READ_STATUS_SYNC || rc == LIBEVDEV_READ_STATUS_SUCCESS) {
- switch (ev.type) {
- case EV_KEY:
- p_event_id = input->joy_button(p_event_id, i, joy->key_map[ev.code], ev.value);
- break;
+ switch (ev.type) {
+ case EV_KEY:
+ p_event_id = input->joy_button(p_event_id, i, joy->key_map[ev.code], ev.value);
+ break;
- case EV_ABS:
+ case EV_ABS:
- switch (ev.code) {
- case ABS_HAT0X:
- if (ev.value != 0) {
- if (ev.value < 0) joy->dpad |= InputDefault::HAT_MASK_LEFT;
- else joy->dpad |= InputDefault::HAT_MASK_RIGHT;
+ switch (ev.code) {
+ case ABS_HAT0X:
+ if (ev.value != 0) {
+ if (ev.value < 0) joy->dpad |= InputDefault::HAT_MASK_LEFT;
+ else joy->dpad |= InputDefault::HAT_MASK_RIGHT;
- }
- else joy->dpad &= ~(InputDefault::HAT_MASK_LEFT | InputDefault::HAT_MASK_RIGHT);
+ }
+ else joy->dpad &= ~(InputDefault::HAT_MASK_LEFT | InputDefault::HAT_MASK_RIGHT);
- p_event_id = input->joy_hat(p_event_id, i, joy->dpad);
- break;
+ p_event_id = input->joy_hat(p_event_id, i, joy->dpad);
+ break;
- case ABS_HAT0Y:
- if (ev.value != 0) {
- if (ev.value < 0) joy->dpad |= InputDefault::HAT_MASK_UP;
- else joy->dpad |= InputDefault::HAT_MASK_DOWN;
- }
- else joy->dpad &= ~(InputDefault::HAT_MASK_UP | InputDefault::HAT_MASK_DOWN);
+ case ABS_HAT0Y:
+ if (ev.value != 0) {
+ if (ev.value < 0) joy->dpad |= InputDefault::HAT_MASK_UP;
+ else joy->dpad |= InputDefault::HAT_MASK_DOWN;
+ }
+ else joy->dpad &= ~(InputDefault::HAT_MASK_UP | InputDefault::HAT_MASK_DOWN);
- p_event_id = input->joy_hat(p_event_id, i, joy->dpad);
- break;
+ p_event_id = input->joy_hat(p_event_id, i, joy->dpad);
+ break;
- default:
- if (joy->abs_map[ev.code] != -1) {
- InputDefault::JoyAxis value = axis_correct(libevdev_get_abs_info(dev, ev.code), ev.value);
- p_event_id = input->joy_axis(p_event_id, i, joy->abs_map[ev.code], value);
- }
- break;
- }
- break;
- }
- rc = libevdev_next_event(dev, LIBEVDEV_READ_FLAG_NORMAL, &ev);
- }
- }
- joy_mutex->unlock();
- return p_event_id;
+ default:
+ if (joy->abs_map[ev.code] != -1) {
+ InputDefault::JoyAxis value = axis_correct(libevdev_get_abs_info(dev, ev.code), ev.value);
+ p_event_id = input->joy_axis(p_event_id, i, joy->abs_map[ev.code], value);
+ }
+ break;
+ }
+ break;
+ }
+ rc = libevdev_next_event(dev, LIBEVDEV_READ_FLAG_NORMAL, &ev);
+ }
+ }
+ joy_mutex->unlock();
+ return p_event_id;
}
#endif