Commit 3993a1a9 authored by Nemo Han's avatar Nemo Han Committed by Dmitry Torokhov
Browse files

Input: sc27xx - add support for sc2730 and sc2721 



Add new compatible strings and match data to support sc2730 and sc2721
which are two varieties of SC27XX family.

Signed-off-by: default avatarNemo Han <nemo.han@unisoc.com>
Signed-off-by: default avatarChunyan Zhang <chunyan.zhang@unisoc.com>
Link: https://lore.kernel.org/r/20201117034949.47877-2-zhang.lyra@gmail.com


Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent 0010d7bb

drivers/input/misc/sc27xx-vibra.c

+59 −12
Original line number Diff line number Diff line
@@ -3,45 +3,82 @@ 
 * Copyright (C) 2018 Spreadtrum Communications Inc.

 */



#include <linux/device.h>

#include <linux/input.h>

#include <linux/mod_devicetable.h>

#include <linux/module.h>

#include <linux/of_address.h>

#include <linux/platform_device.h>

#include <linux/property.h>

#include <linux/regmap.h>

#include <linux/input.h>

#include <linux/workqueue.h>



#define CUR_DRV_CAL_SEL			GENMASK(13, 12)

#define SLP_LDOVIBR_PD_EN		BIT(9)

#define LDO_VIBR_PD			BIT(8)

#define SC2730_CUR_DRV_CAL_SEL		0

#define SC2730_SLP_LDOVIBR_PD_EN	BIT(14)

#define SC2730_LDO_VIBR_PD		BIT(13)



struct sc27xx_vibra_data {

	u32 cur_drv_cal_sel;

	u32 slp_pd_en;

	u32 ldo_pd;

};



struct vibra_info {

	struct input_dev	*input_dev;

	struct work_struct	play_work;

	struct regmap		*regmap;

	const struct sc27xx_vibra_data *data;

	u32			base;

	u32			strength;

	bool			enabled;

};



static const struct sc27xx_vibra_data sc2731_data = {

	.cur_drv_cal_sel = CUR_DRV_CAL_SEL,

	.slp_pd_en = SLP_LDOVIBR_PD_EN,

	.ldo_pd = LDO_VIBR_PD,

};



static const struct sc27xx_vibra_data sc2730_data = {

	.cur_drv_cal_sel = SC2730_CUR_DRV_CAL_SEL,

	.slp_pd_en = SC2730_SLP_LDOVIBR_PD_EN,

	.ldo_pd = SC2730_LDO_VIBR_PD,

};



static const struct sc27xx_vibra_data sc2721_data = {

	.cur_drv_cal_sel = CUR_DRV_CAL_SEL,

	.slp_pd_en = SLP_LDOVIBR_PD_EN,

	.ldo_pd = LDO_VIBR_PD,

};



static void sc27xx_vibra_set(struct vibra_info *info, bool on)

{

	const struct sc27xx_vibra_data *data = info->data;

	if (on) {

		regmap_update_bits(info->regmap, info->base, LDO_VIBR_PD, 0);

		regmap_update_bits(info->regmap, info->base, data->ldo_pd, 0);

		regmap_update_bits(info->regmap, info->base,

				   SLP_LDOVIBR_PD_EN, 0);

				   data->slp_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, data->ldo_pd,

				   data->ldo_pd);

		regmap_update_bits(info->regmap, info->base,

				   SLP_LDOVIBR_PD_EN, SLP_LDOVIBR_PD_EN);

				   data->slp_pd_en, data->slp_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);

	const struct sc27xx_vibra_data *data = info->data;



	if (!data->cur_drv_cal_sel)

		return 0;



	return regmap_update_bits(info->regmap, info->base,

				  data->cur_drv_cal_sel, 0);

}



static void sc27xx_vibra_play_work(struct work_struct *work)
@@ -78,8 +115,15 @@ static void sc27xx_vibra_close(struct input_dev *input) 
static int sc27xx_vibra_probe(struct platform_device *pdev)

{

	struct vibra_info *info;

	const struct sc27xx_vibra_data *data;

	int error;



	data = device_get_match_data(&pdev->dev);

	if (!data) {

		dev_err(&pdev->dev, "no matching driver data found\n");

		return -EINVAL;

	}



	info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);

	if (!info)

		return -ENOMEM;
@@ -105,6 +149,7 @@ static int sc27xx_vibra_probe(struct platform_device *pdev) 
	info->input_dev->name = "sc27xx:vibrator";

	info->input_dev->id.version = 0;

	info->input_dev->close = sc27xx_vibra_close;

	info->data = data;



	input_set_drvdata(info->input_dev, info);

	input_set_capability(info->input_dev, EV_FF, FF_RUMBLE);
@@ -134,7 +179,9 @@ static int sc27xx_vibra_probe(struct platform_device *pdev) 
}



static const struct of_device_id sc27xx_vibra_of_match[] = {

	{ .compatible = "sprd,sc2731-vibrator", },

	{ .compatible = "sprd,sc2721-vibrator", .data = &sc2721_data },

	{ .compatible = "sprd,sc2730-vibrator", .data = &sc2730_data },

	{ .compatible = "sprd,sc2731-vibrator", .data = &sc2731_data },

	{}

};

MODULE_DEVICE_TABLE(of, sc27xx_vibra_of_match);