Initial attempt to implement rumble for evdev

src/input/evdev.c

@@ -63,6 +63,7 @@ struct input_device {
  char modifiers;
  __s32 mouseDeltaX, mouseDeltaY, mouseScroll;
  short controllerId;
+ int haptic_effect_id;
  int buttonFlags;
  char leftTrigger, rightTrigger;
  short leftStickX, leftStickY;
@@ -547,6 +548,7 @@ void evdev_create(const char* device, struct mapping* mappings, bool verbose) {
  }
 
  devices[dev].controllerId = -1;
+ devices[dev].haptic_effect_id = -1;
 
  if (devices[dev].map != NULL) {
  bool valid = evdev_init_parms(&devices[dev], &(devices[dev].xParms), devices[dev].map->abs_leftx);
@@ -704,3 +706,40 @@ void evdev_stop() {
 void evdev_init() {
  handler = evdev_handle_event;
 }
+
+static struct input_device* evdev_get_input_device(unsigned short controller_id) {
+ for (int i=0; i<numDevices; i++)
+ if (devices[i].controllerId == controller_id)
+ return &devices[i];
+
+ return NULL;
+}
+
+void evdev_rumble(unsigned short controller_id, unsigned short low_freq_motor, unsigned short high_freq_motor) {
+ struct input_device* device = evdev_get_input_device(controller_id);
+ if (!device)
+ return;
+
+ if (device->haptic_effect_id >= 0) {
+ ioctl(device->fd, EVIOCRMFF, device->haptic_effect_id);
+ device->haptic_effect_id = -1;
+ }
+
+ if (low_freq_motor == 0 && high_freq_motor == 0)
+ return;
+
+ struct ff_effect effect = {0};
+ effect.type = FF_RUMBLE;
+ effect.id = -1;
+ effect.replay.length = USHRT_MAX;
+ effect.u.rumble.strong_magnitude = low_freq_motor;
+ effect.u.rumble.weak_magnitude = high_freq_motor;
+ if (ioctl(device->fd, EVIOCSFF, &effect) == -1)
+ return;
+
+ struct input_event event = {0};
+ event.type = EV_FF;
+ event.code = effect.id;
+ write(device->fd, (const void*) &event, sizeof(event));
+ device->haptic_effect_id = effect.id;
+}

src/input/evdev.h

@@ -28,3 +28,4 @@ void evdev_init();
 void evdev_start();
 void evdev_stop();
 void evdev_map(char* device);
+void evdev_rumble(unsigned short controller_id, unsigned short low_freq_motor, unsigned short high_freq_motor);

src/main.c

@@ -311,6 +311,7 @@ int main(int argc, char* argv[]) {
 
  udev_init(!inputAdded, mappings, config.debug_level > 0);
  evdev_init();
+ rumble_handler = evdev_rumble;
  #ifdef HAVE_LIBCEC
  cec_init();
  #endif /* HAVE_LIBCEC */