A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-08 04:42:04 -04:00
Code Issues Projects Releases Packages Wiki Activity

fpc1020: Add reset function if defined in dts.

Browse source 
If dts defined reset pin, kernel driver reset FPC IC.
If dts not defined this pin, reset function will do nothing.

Change-Id: I59c413c519bd030efa5d3f1ba4a223681db06cdc
Signed-off-by: haojl2 <haojl2@motorola.com>
Reviewed-on: https://gerrit.mot.com/1379449
SLTApproved: Slta Waiver
SME-Granted: SME Approvals Granted
Tested-by: Jira Key
Reviewed-by: Weilong Wu <wuwl10@motorola.com>
Reviewed-by: Lei Chen <chenl18@motorola.com>
Reviewed-by: Jianqi Yang <yangj@motorola.com>
Submit-Approved: Jira Key
This commit is contained in:
haojl2 2019-07-02 12:05:51 +08:00 • committed by Jialei Hao
commit 84df22401f
1 changed files with 72 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

72
drivers/input/misc/fpc_fps_mmi/fpc1020_tee.c
View file

@ -21,6 +21,13 @@
#include <linux/platform_device.h>
#include <linux/notifier.h>
#define RESET_LOW_SLEEP_MIN_US 5000
#define RESET_LOW_SLEEP_MAX_US (RESET_LOW_SLEEP_MIN_US + 100)
#define RESET_HIGH_SLEEP1_MIN_US 100
#define RESET_HIGH_SLEEP1_MAX_US (RESET_HIGH_SLEEP1_MIN_US + 100)
#define RESET_HIGH_SLEEP2_MIN_US 5000
#define RESET_HIGH_SLEEP2_MAX_US (RESET_HIGH_SLEEP2_MIN_US + 100)
struct FPS_data {
unsigned int enabled;
unsigned int state;
@ -119,8 +126,54 @@ struct fpc1020_data {
int irq_gpio;
int irq_num;
unsigned int irq_cnt;
int rst_gpio;
};
static int hw_reset(struct fpc1020_data *fpc1020)
{
int irq_gpio;
struct device *dev = fpc1020->dev;
int rc = 0;
if (!gpio_is_valid(fpc1020->rst_gpio)) {
dev_warn(dev, "reset pin is invalid\n");
goto exit;
}
rc = gpio_direction_output(fpc1020->rst_gpio, 1);
if (rc)
goto exit;
usleep_range(RESET_HIGH_SLEEP1_MIN_US, RESET_HIGH_SLEEP1_MAX_US);
rc = gpio_direction_output(fpc1020->rst_gpio, 0);
if (rc)
goto exit;
usleep_range(RESET_LOW_SLEEP_MIN_US, RESET_LOW_SLEEP_MAX_US);
rc = gpio_direction_output(fpc1020->rst_gpio, 1);
if (rc)
goto exit;
usleep_range(RESET_HIGH_SLEEP2_MIN_US, RESET_HIGH_SLEEP2_MAX_US);
irq_gpio = gpio_get_value(fpc1020->irq_gpio);
dev_info(dev, "IRQ after reset %d\n", irq_gpio);
exit:
return rc;
}
static ssize_t hw_reset_set(struct device *dev,
struct device_attribute *attr, const char *buf, size_t count)
{
int rc;
struct fpc1020_data *fpc1020 = dev_get_drvdata(dev);
rc = hw_reset(fpc1020);
return rc ? rc : count;
}
static DEVICE_ATTR(hw_reset, S_IWUSR, NULL, hw_reset_set);
static ssize_t dev_enable_set(struct device *dev,
struct device_attribute *attr, const char *buf, size_t count)
{
@ -176,6 +229,7 @@ static struct attribute *attributes[] = {
&dev_attr_dev_enable.attr,
&dev_attr_irq.attr,
&dev_attr_irq_cnt.attr,
&dev_attr_hw_reset.attr,
#ifdef CONFIG_INPUT_MISC_FPC1020_SAVE_TO_CLASS_DEVICE
&dev_attr_vendor.attr,
&dev_attr_modalias.attr,
@ -219,6 +273,10 @@ static int fpc1020_request_named_gpio(struct fpc1020_data *fpc1020,
int rc;
*gpio = of_get_named_gpio(np, label, 0);
if (!gpio_is_valid(*gpio)) {
dev_err(dev, "gpio %s is invalid\n", label);
return -EINVAL;
}
rc = devm_gpio_request(dev, *gpio, label);
if (rc) {
dev_err(dev, "failed to request gpio %d\n", *gpio);
@ -306,6 +364,20 @@ static int fpc1020_probe(struct platform_device *pdev)
if (rc)
goto exit;
rc = fpc1020_request_named_gpio(fpc1020, "rst",
&fpc1020->rst_gpio);
if (rc)
fpc1020->rst_gpio = -EINVAL;
if (gpio_is_valid(fpc1020->rst_gpio)) {
usleep_range(RESET_LOW_SLEEP_MIN_US, RESET_LOW_SLEEP_MAX_US);
rc = gpio_direction_output(fpc1020->rst_gpio, 1);
if (rc) {
dev_err(dev, "cannot set reset pin direction\n");
goto exit;
}
}
rc = device_init_wakeup(fpc1020->dev, true);
if (rc)
goto exit;