Signed-off-by: Michal Malý <madcatxs...@devoid-pointer.net>
---
 drivers/hid/Kconfig     |  2 +-
 drivers/hid/hid-emsff.c | 38 ++++++++++++++++++++++++++------------
 2 files changed, 27 insertions(+), 13 deletions(-)

diff --git a/drivers/hid/Kconfig b/drivers/hid/Kconfig
index 68c19a0..6e233d2 100644
--- a/drivers/hid/Kconfig
+++ b/drivers/hid/Kconfig
@@ -204,7 +204,7 @@ config DRAGONRISE_FF
 config HID_EMS_FF
        tristate "EMS Production Inc. force feedback support"
        depends on HID
-       select INPUT_FF_MEMLESS
+       select INPUT_FF_MEMLESS_NEXT
        ---help---
        Say Y here if you want to enable force feedback support for devices by
        EMS Production Ltd.
diff --git a/drivers/hid/hid-emsff.c b/drivers/hid/hid-emsff.c
index d82d75b..c0cbe50 100644
--- a/drivers/hid/hid-emsff.c
+++ b/drivers/hid/hid-emsff.c
@@ -24,30 +24,44 @@
 #include <linux/hid.h>
 #include <linux/input.h>
 #include <linux/module.h>
+#include <linux/input/ff-memless-next.h>
 
 #include "hid-ids.h"
 
+#define FF_UPDATE_RATE 50
+
 struct emsff_device {
        struct hid_report *report;
 };
 
 static int emsff_play(struct input_dev *dev, void *data,
-                        struct ff_effect *effect)
+                        const struct mlnx_effect_command *command)
 {
        struct hid_device *hid = input_get_drvdata(dev);
        struct emsff_device *emsff = data;
+       const struct mlnx_rumble_force *rumble_force = &command->u.rumble_force;
        int weak, strong;
 
-       weak = effect->u.rumble.weak_magnitude;
-       strong = effect->u.rumble.strong_magnitude;
-
-       dbg_hid("called with 0x%04x 0x%04x\n", strong, weak);
-
-       weak = weak * 0xff / 0xffff;
-       strong = strong * 0xff / 0xffff;
-
-       emsff->report->field[0]->value[1] = weak;
-       emsff->report->field[0]->value[2] = strong;
+       switch (command->cmd) {
+       case MLNX_START_RUMBLE:
+               weak = rumble_force->weak;
+               strong = rumble_force->strong;
+
+               dbg_hid("called with 0x%04x 0x%04x\n", strong, weak);
+
+               weak = weak * 0xff / 0xffff;
+               strong = strong * 0xff / 0xffff;
+
+               emsff->report->field[0]->value[1] = weak;
+               emsff->report->field[0]->value[2] = strong;
+               break;
+       case MLNX_STOP_RUMBLE:
+               weak = 0;
+               strong = 0;
+               break;
+       default:
+               return -EINVAL;
+       }
 
        dbg_hid("running with 0x%02x 0x%02x\n", strong, weak);
        hid_hw_request(hid, emsff->report, HID_REQ_SET_REPORT);
@@ -88,7 +102,7 @@ static int emsff_init(struct hid_device *hid)
 
        set_bit(FF_RUMBLE, dev->ffbit);
 
-       error = input_ff_create_memless(dev, emsff, emsff_play);
+       error = input_ff_create_mlnx(dev, emsff, emsff_play, FF_UPDATE_RATE);
        if (error) {
                kfree(emsff);
                return error;
-- 
1.9.2

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to