Signed-off-by: Michal Malý <madcatxster@xxxxxxxxxxxxxxxxxx> --- drivers/input/misc/Kconfig | 2 +- drivers/input/misc/pm8xxx-vibrator.c | 28 +++++++++++++++++++--------- 2 files changed, 20 insertions(+), 10 deletions(-) diff --git a/drivers/input/misc/Kconfig b/drivers/input/misc/Kconfig index 6ba327f..300b5a8 100644 --- a/drivers/input/misc/Kconfig +++ b/drivers/input/misc/Kconfig @@ -108,7 +108,7 @@ config INPUT_PCSPKR config INPUT_PM8XXX_VIBRATOR tristate "Qualcomm PM8XXX vibrator support" depends on MFD_PM8XXX - select INPUT_FF_MEMLESS + select INPUT_FF_MEMLESS_NEXT help This option enables device driver support for the vibrator on Qualcomm PM8xxx chip. This driver supports ff-memless interface diff --git a/drivers/input/misc/pm8xxx-vibrator.c b/drivers/input/misc/pm8xxx-vibrator.c index b88b7cb..6b0e9eb 100644 --- a/drivers/input/misc/pm8xxx-vibrator.c +++ b/drivers/input/misc/pm8xxx-vibrator.c @@ -17,6 +17,7 @@ #include <linux/input.h> #include <linux/slab.h> #include <linux/regmap.h> +#include <linux/input/ff-memless-next.h> #define VIB_DRV 0x4A @@ -29,7 +30,7 @@ #define VIB_MAX_LEVELS (VIB_MAX_LEVEL_mV - VIB_MIN_LEVEL_mV) #define MAX_FF_SPEED 0xff - +#define FF_UPDATE_RATE 50 /** * struct pm8xxx_vib - structure to hold vibrator data * @vib_input_dev: input device supporting force feedback @@ -128,14 +129,23 @@ static void pm8xxx_vib_close(struct input_dev *dev) * Currently this driver supports only rumble effects. */ static int pm8xxx_vib_play_effect(struct input_dev *dev, void *data, - struct ff_effect *effect) + const struct mlnx_command *command) { struct pm8xxx_vib *vib = input_get_drvdata(dev); - - vib->speed = effect->u.rumble.strong_magnitude >> 8; - if (!vib->speed) - vib->speed = effect->u.rumble.weak_magnitude >> 9; - + const struct mlnx_rumble_force *rumble_force = &command->u.rumble_force; + + switch (command->cmd) { + case MLNX_START_RUMBLE: + vib->speed = rumble_force->strong >> 8; + if (!vib->speed) + vib->speed = rumble_force->weak >> 9; + break; + case MLNX_STOP_RUMBLE: + vib->speed = 0; + break; + default: + return -EINVAL; + } schedule_work(&vib->work); return 0; @@ -182,8 +192,8 @@ static int pm8xxx_vib_probe(struct platform_device *pdev) input_set_drvdata(input_dev, vib); input_set_capability(vib->vib_input_dev, EV_FF, FF_RUMBLE); - error = input_ff_create_memless(input_dev, NULL, - pm8xxx_vib_play_effect); + error = input_ff_create_mlnx(input_dev, NULL, + pm8xxx_vib_play_effect, FF_UPDATE_RATE); if (error) { dev_err(&pdev->dev, "couldn't register vibrator as FF device\n"); -- 1.9.2 -- To unsubscribe from this list: send the line "unsubscribe linux-input" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html