From mboxrd@z Thu Jan 1 00:00:00 1970 From: =?UTF-8?q?Michal=20Mal=C3=BD?= Subject: [PATCH v4 04/24] input: Port twl6040-vibra to ff-memless-next Date: Sat, 26 Apr 2014 13:57:41 +0200 Message-ID: <1398513696-12626-5-git-send-email-madcatxster@devoid-pointer.net> References: <1398513696-12626-1-git-send-email-madcatxster@devoid-pointer.net> Mime-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: QUOTED-PRINTABLE Return-path: In-Reply-To: <1398513696-12626-1-git-send-email-madcatxster@devoid-pointer.net> Sender: linux-kernel-owner@vger.kernel.org To: linux-input@vger.kernel.org, linux-kernel@vger.kernel.org Cc: dmitry.torokhov@gmail.com, jkosina@suse.cz, elias.vds@gmail.com, anssi.hannula@iki.fi, simon@mungewell.org, =?UTF-8?q?Michal=20Mal=C3=BD?= List-Id: linux-input@vger.kernel.org Port twl6040-vibra to ff-memless-next Signed-off-by: Michal Mal=C3=BD --- drivers/input/misc/Kconfig | 2 +- drivers/input/misc/twl6040-vibra.c | 27 ++++++++++++++++++++++----- 2 files changed, 23 insertions(+), 6 deletions(-) diff --git a/drivers/input/misc/Kconfig b/drivers/input/misc/Kconfig index 817156f..b9cbb91 100644 --- a/drivers/input/misc/Kconfig +++ b/drivers/input/misc/Kconfig @@ -417,7 +417,7 @@ config INPUT_TWL4030_VIBRA config INPUT_TWL6040_VIBRA tristate "Support for TWL6040 Vibrator" depends on TWL6040_CORE - select INPUT_FF_MEMLESS + select INPUT_FF_MEMLESS_NEXT help This option enables support for TWL6040 Vibrator Driver. =20 diff --git a/drivers/input/misc/twl6040-vibra.c b/drivers/input/misc/tw= l6040-vibra.c index 77dc23b..7440a74 100644 --- a/drivers/input/misc/twl6040-vibra.c +++ b/drivers/input/misc/twl6040-vibra.c @@ -30,12 +30,14 @@ #include #include #include +#include #include #include #include #include =20 #define EFFECT_DIR_180_DEG 0x8000 +#define FF_UPDATE_RATE 50 =20 /* Recommended modulation index 85% */ #define TWL6040_VIBRA_MOD 85 @@ -197,9 +199,10 @@ static void vibra_play_work(struct work_struct *wo= rk) } =20 static int vibra_play(struct input_dev *input, void *data, - struct ff_effect *effect) + const struct mlnx_effect_command *command) { struct vibra_info *info =3D input_get_drvdata(input); + const struct mlnx_rumble_force *rumble_force =3D &command->u.rumble_f= orce; int ret; =20 /* Do not allow effect, while the routing is set to use audio */ @@ -209,9 +212,23 @@ static int vibra_play(struct input_dev *input, voi= d *data, return -EBUSY; } =20 - info->weak_speed =3D effect->u.rumble.weak_magnitude; - info->strong_speed =3D effect->u.rumble.strong_magnitude; - info->direction =3D effect->direction < EFFECT_DIR_180_DEG ? 1 : -1; + switch (command->cmd) { + case MLNX_START_RUMBLE: + info->weak_speed =3D rumble_force->weak; + info->strong_speed =3D rumble_force->strong; + if (info->strong_speed >=3D info->weak_speed) + info->direction =3D rumble_force->strong_dir < EFFECT_DIR_180_DEG ?= 1 : -1; + else + info->direction =3D rumble_force->weak_dir < EFFECT_DIR_180_DEG ? 1= : -1; + break; + case MLNX_STOP_RUMBLE: + info->weak_speed =3D 0; + info->strong_speed =3D 0; + info->direction =3D 1; + break; + default: + return -EINVAL; + } =20 ret =3D queue_work(info->workqueue, &info->play_work); if (!ret) { @@ -367,7 +384,7 @@ static int twl6040_vibra_probe(struct platform_devi= ce *pdev) info->input_dev->close =3D twl6040_vibra_close; __set_bit(FF_RUMBLE, info->input_dev->ffbit); =20 - ret =3D input_ff_create_memless(info->input_dev, NULL, vibra_play); + ret =3D input_ff_create_mlnx(info->input_dev, NULL, vibra_play, FF_UP= DATE_RATE); if (ret < 0) { dev_err(info->dev, "couldn't register vibrator to FF\n"); goto err_ialloc; --=20 1.9.2