From patchwork Thu May 10 05:08:34 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: "\(Exiting\) Baolin Wang" X-Patchwork-Id: 135389 Delivered-To: patch@linaro.org Received: by 10.46.151.6 with SMTP id r6csp568355lji; Wed, 9 May 2018 22:09:21 -0700 (PDT) X-Google-Smtp-Source: AB8JxZrAWdULHXecr1CdgiUefEIPzotAaVteqhlq+VwigRIP0i2Rxgk1OYI+LFWrXK/Gh9T+mBO6 X-Received: by 10.98.205.69 with SMTP id o66mr46632723pfg.250.1525928961044; Wed, 09 May 2018 22:09:21 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1525928961; cv=none; d=google.com; s=arc-20160816; b=Es/NqOt+tNwxMw9hAVJLEix/dk2+8TkvQ4AUgo8/8k305D0lZPwlPHF+Bg4NF0y7Nk C/NL9Tv2pz4SGUWM1qpesdWi5bckNNryzFykCnqNb5dPnuVn+E9NMsu3VC1kCvafBtqi 2doy2PKMrscDoVEXbFNsrWzSsAUIEhVxmr2Df4xEUAPfkfgmJ0UDE6WSOa1doNfgy1yG a1Spljk/h7qlAXkSh33RSoV/FT+WveY7tUCXt27RvuoSrKkEqPuqZUWnVVq7zClrQxzU rJk0sChpytx+5P5kZ68IKBPmKc6J7OHty36znEPmuZHNpv+1gKOyzIMvrMfGVGJs8wJi 5ouw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:references:in-reply-to:references :in-reply-to:message-id:date:subject:cc:to:from:dkim-signature :arc-authentication-results; bh=DwJFoonQ0yzmOG6uheqsQ5pjDFKkJVq9N8JkznF7UlA=; b=GitgCrLaYdvcs153/0RR5hjY41Jv9Kb99Zqdc6g+a/uFUVPUl71mrZucqPP042Hxyt xlEHqqOwpw+HcLfpnXRSmPD+IXWK5/ZDkECe2JiPAGMmTZhMRhfbmJcFWT+TXkKedI9M l5sL+VBNMecxPOOS6/cicHI4gJQDtvGkAsr4IIGMkko2fkuhVNZqaRzTRqBbBOb0h5GJ ARwkE/1yCfq374ecPmBN8UugkulPzy/MOhj9DFNwBl1bGCyyfD2U2+EfSL5Em00iimpi qMYtgxsccGDGocTS/RXL6tBamdWA37SoW555YijHegzUtqZTF5JkRgFM1/PYjYNQz9jb /fgw== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=FHnD7fx9; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id v29si27984115pfk.116.2018.05.09.22.09.20; Wed, 09 May 2018 22:09:21 -0700 (PDT) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=FHnD7fx9; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1756612AbeEJFJR (ORCPT + 29 others); Thu, 10 May 2018 01:09:17 -0400 Received: from mail-pl0-f66.google.com ([209.85.160.66]:33597 "EHLO mail-pl0-f66.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1756545AbeEJFJB (ORCPT ); Thu, 10 May 2018 01:09:01 -0400 Received: by mail-pl0-f66.google.com with SMTP id n10-v6so600355plp.0 for ; Wed, 09 May 2018 22:09:01 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references :in-reply-to:references; bh=DwJFoonQ0yzmOG6uheqsQ5pjDFKkJVq9N8JkznF7UlA=; b=FHnD7fx9I0fE7tpENMru6ZLx4MW3mgz/h8ITVAJ8r/EnNnkqEGMir4hu50fBi2GbDM ZRPAjiBVYcqChngXsXnOhtrSMChSG+FEvgNABVDqXEQcffN7YbOKD4X9Rq1RH4WB2tit yI7kqJP9KwznMxxIYenApwPhtrYywtJn6gbPo= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:in-reply-to:references; bh=DwJFoonQ0yzmOG6uheqsQ5pjDFKkJVq9N8JkznF7UlA=; b=F2Cqc+ViynafPmA0Ft0rl29njObQgCabxbidBCXE76Alj7GJEQ10PGzBqm2kQBo6Eh NcUyCsgFTREsopQEbmwTgtJPI8djeEztSTsUsIhNhCBN9ay049RLcmD0dPWau4AJq+un 1xgNCsCQgJNO8TcVsCya++WMqg3M22vKIXL4G2mAneBHKWdbispOJXQ1Oj6wz5Ms5oFa e7JV4Wif6spH4mqxuAaGaDibPOHAzzUmR6W38JmYqjOP8dEOosp1zefhxg4SUif+8wSN zXCgwJrbQWsRrOr4vPT9VDV45uSBAdpCN3Yw9LJBlBr18pNBBK/qBHgmw/jXjmzbbjpG LP/w== X-Gm-Message-State: ALQs6tC1BNOqm0bfsvW68br87moWTvA/52yHqMOsDc1mFqfbFcYdHEg5 2MsaCIt8gw0hz9ZSAJBO1rPLnw== X-Received: by 2002:a17:902:5502:: with SMTP id f2-v6mr47928438pli.108.1525928941181; Wed, 09 May 2018 22:09:01 -0700 (PDT) Received: from baolinwangubtpc.spreadtrum.com ([117.18.48.102]) by smtp.gmail.com with ESMTPSA id o10-v6sm40853367pgp.30.2018.05.09.22.08.58 (version=TLS1 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Wed, 09 May 2018 22:09:00 -0700 (PDT) From: Baolin Wang To: dmitry.torokhov@gmail.com, robh+dt@kernel.org, mark.rutland@arm.com, orsonzhai@gmail.com, zhang.lyra@gmail.com Cc: linux-input@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, baolin.wang@linaro.org, xiaotong.lu@spreadtrum.com Subject: [PATCH v4 2/2] input: misc: Add Spreadtrum vibrator driver Date: Thu, 10 May 2018 13:08:34 +0800 Message-Id: <68ed1ed8c7c2759f47341dc3f4f6c18acad9cb90.1525928437.git.baolin.wang@linaro.org> X-Mailer: git-send-email 1.7.9.5 In-Reply-To: <44b17778d8f0bf897a316a39516ba2cafecf43c9.1525928437.git.baolin.wang@linaro.org> References: <44b17778d8f0bf897a316a39516ba2cafecf43c9.1525928437.git.baolin.wang@linaro.org> In-Reply-To: <44b17778d8f0bf897a316a39516ba2cafecf43c9.1525928437.git.baolin.wang@linaro.org> References: <44b17778d8f0bf897a316a39516ba2cafecf43c9.1525928437.git.baolin.wang@linaro.org> Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org From: Xiaotong Lu This patch adds the Spreadtrum vibrator driver, which embedded in the Spreadtrum SC27xx series PMICs. Signed-off-by: Xiaotong Lu Signed-off-by: Baolin Wang --- Changes since v3: - No updates. Changes since v2: - Fix the condition when disabling the vibrator. - Change of_property_read_u32() to device_property_read_u32(). - Correct the device parent relationship. - Call sc27xx_vibra_hw_init() before calling input_register_device(). - Remove platform_set_drvdata(). Changes since v1: - Remove input_ff_destroy() and input_unregister_device() --- drivers/input/misc/Kconfig | 10 +++ drivers/input/misc/Makefile | 1 + drivers/input/misc/sc27xx-vibra.c | 154 +++++++++++++++++++++++++++++++++++++ 3 files changed, 165 insertions(+) create mode 100644 drivers/input/misc/sc27xx-vibra.c -- 1.7.9.5 diff --git a/drivers/input/misc/Kconfig b/drivers/input/misc/Kconfig index 572b15f..c761c0c 100644 --- a/drivers/input/misc/Kconfig +++ b/drivers/input/misc/Kconfig @@ -841,4 +841,14 @@ config INPUT_RAVE_SP_PWRBUTTON To compile this driver as a module, choose M here: the module will be called rave-sp-pwrbutton. +config INPUT_SC27XX_VIBRA + tristate "Spreadtrum sc27xx vibrator support" + depends on MFD_SC27XX_PMIC || COMPILE_TEST + select INPUT_FF_MEMLESS + help + This option enables support for Spreadtrum sc27xx vibrator driver. + + To compile this driver as a module, choose M here. The module will + be called sc27xx_vibra. + endif diff --git a/drivers/input/misc/Makefile b/drivers/input/misc/Makefile index 72cde28..9d0f9d1 100644 --- a/drivers/input/misc/Makefile +++ b/drivers/input/misc/Makefile @@ -66,6 +66,7 @@ obj-$(CONFIG_INPUT_RETU_PWRBUTTON) += retu-pwrbutton.o obj-$(CONFIG_INPUT_AXP20X_PEK) += axp20x-pek.o obj-$(CONFIG_INPUT_GPIO_ROTARY_ENCODER) += rotary_encoder.o obj-$(CONFIG_INPUT_RK805_PWRKEY) += rk805-pwrkey.o +obj-$(CONFIG_INPUT_SC27XX_VIBRA) += sc27xx-vibra.o obj-$(CONFIG_INPUT_SGI_BTNS) += sgi_btns.o obj-$(CONFIG_INPUT_SIRFSOC_ONKEY) += sirfsoc-onkey.o obj-$(CONFIG_INPUT_SOC_BUTTON_ARRAY) += soc_button_array.o diff --git a/drivers/input/misc/sc27xx-vibra.c b/drivers/input/misc/sc27xx-vibra.c new file mode 100644 index 0000000..295251a --- /dev/null +++ b/drivers/input/misc/sc27xx-vibra.c @@ -0,0 +1,154 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (C) 2018 Spreadtrum Communications Inc. + */ + +#include +#include +#include +#include +#include +#include + +#define CUR_DRV_CAL_SEL GENMASK(13, 12) +#define SLP_LDOVIBR_PD_EN BIT(9) +#define LDO_VIBR_PD BIT(8) + +struct vibra_info { + struct input_dev *input_dev; + struct work_struct play_work; + struct regmap *regmap; + u32 base; + u32 strength; + bool enabled; +}; + +static void sc27xx_vibra_set(struct vibra_info *info, bool on) +{ + if (on) { + regmap_update_bits(info->regmap, info->base, LDO_VIBR_PD, 0); + regmap_update_bits(info->regmap, info->base, + SLP_LDOVIBR_PD_EN, 0); + info->enabled = true; + } else { + regmap_update_bits(info->regmap, info->base, LDO_VIBR_PD, + LDO_VIBR_PD); + regmap_update_bits(info->regmap, info->base, + SLP_LDOVIBR_PD_EN, SLP_LDOVIBR_PD_EN); + info->enabled = false; + } +} + +static int sc27xx_vibra_hw_init(struct vibra_info *info) +{ + return regmap_update_bits(info->regmap, info->base, CUR_DRV_CAL_SEL, 0); +} + +static void sc27xx_vibra_play_work(struct work_struct *work) +{ + struct vibra_info *info = container_of(work, struct vibra_info, + play_work); + + if (info->strength && !info->enabled) + sc27xx_vibra_set(info, true); + else if (info->strength == 0 && info->enabled) + sc27xx_vibra_set(info, false); +} + +static int sc27xx_vibra_play(struct input_dev *input, void *data, + struct ff_effect *effect) +{ + struct vibra_info *info = input_get_drvdata(input); + + info->strength = effect->u.rumble.weak_magnitude; + schedule_work(&info->play_work); + + return 0; +} + +static void sc27xx_vibra_close(struct input_dev *input) +{ + struct vibra_info *info = input_get_drvdata(input); + + cancel_work_sync(&info->play_work); + if (info->enabled) + sc27xx_vibra_set(info, false); +} + +static int sc27xx_vibra_probe(struct platform_device *pdev) +{ + struct vibra_info *info; + int error; + + info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL); + if (!info) + return -ENOMEM; + + info->regmap = dev_get_regmap(pdev->dev.parent, NULL); + if (!info->regmap) { + dev_err(&pdev->dev, "failed to get vibrator regmap.\n"); + return -ENODEV; + } + + error = device_property_read_u32(&pdev->dev, "reg", &info->base); + if (error) { + dev_err(&pdev->dev, "failed to get vibrator base address.\n"); + return error; + } + + info->input_dev = devm_input_allocate_device(&pdev->dev); + if (!info->input_dev) { + dev_err(&pdev->dev, "failed to allocate input device.\n"); + return -ENOMEM; + } + + info->input_dev->name = "sc27xx:vibrator"; + info->input_dev->id.version = 0; + info->input_dev->close = sc27xx_vibra_close; + + input_set_drvdata(info->input_dev, info); + input_set_capability(info->input_dev, EV_FF, FF_RUMBLE); + INIT_WORK(&info->play_work, sc27xx_vibra_play_work); + info->enabled = false; + + error = sc27xx_vibra_hw_init(info); + if (error) { + dev_err(&pdev->dev, "failed to initialize the vibrator.\n"); + return error; + } + + error = input_ff_create_memless(info->input_dev, NULL, + sc27xx_vibra_play); + if (error) { + dev_err(&pdev->dev, "failed to register vibrator to FF.\n"); + return error; + } + + error = input_register_device(info->input_dev); + if (error) { + dev_err(&pdev->dev, "failed to register input device.\n"); + return error; + } + + return 0; +} + +static const struct of_device_id sc27xx_vibra_of_match[] = { + { .compatible = "sprd,sc2731-vibrator", }, + {} +}; +MODULE_DEVICE_TABLE(of, sc27xx_vibra_of_match); + +static struct platform_driver sc27xx_vibra_driver = { + .driver = { + .name = "sc27xx-vibrator", + .of_match_table = sc27xx_vibra_of_match, + }, + .probe = sc27xx_vibra_probe, +}; + +module_platform_driver(sc27xx_vibra_driver); + +MODULE_DESCRIPTION("Spreadtrum SC27xx Vibrator Driver"); +MODULE_LICENSE("GPL v2"); +MODULE_AUTHOR("Xiaotong Lu ");