mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-10 22:40:54 -04:00
channel input: add nova touch charger state support
Change-Id: I3c2c98cee203f4213c9796a349ec0bf45d1357e4 Signed-off-by: dengwei1 <dengwei1@motorola.com> Reviewed-on: https://gerrit.mot.com/1226905 SLTApproved: Slta Waiver SME-Granted: SME Approvals Granted Tested-by: Jira Key Reviewed-by: Xiangpo Zhao <zhaoxp3@motorola.com> Submit-Approved: Jira Key
This commit is contained in:
dengwei1
Wei Deng
parent
939dd20bb0
commit
d8f5ccbb1e
2 changed files with 159 additions and 0 deletions
|
|
@ -51,6 +51,9 @@
|
|||
#if NVT_TOUCH_ESD_PROTECT
|
||||
#include <linux/jiffies.h>
|
||||
#endif /* #if NVT_TOUCH_ESD_PROTECT */
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
#include <linux/power_supply.h>
|
||||
#endif
|
||||
|
||||
#if NVT_TOUCH_ESD_PROTECT
|
||||
static struct delayed_work nvt_esd_check_work;
|
||||
|
|
@ -89,6 +92,13 @@ static int fb_notifier_callback(struct notifier_block *self, unsigned long event
|
|||
static void nvt_ts_early_suspend(struct early_suspend *h);
|
||||
static void nvt_ts_late_resume(struct early_suspend *h);
|
||||
#endif
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
static int charger_notifier_callback(struct notifier_block *nb,
|
||||
unsigned long val, void *v);
|
||||
int32_t nvt_set_charger(uint8_t charger_on_off);
|
||||
static void nvt_charger_notify_work(struct work_struct *work);
|
||||
int usb_detect_flag = 0;
|
||||
#endif
|
||||
|
||||
#if TOUCH_KEY_NUM > 0
|
||||
const uint16_t touch_key_array[TOUCH_KEY_NUM] = {
|
||||
|
|
@ -1426,12 +1436,37 @@ static int32_t nvt_ts_probe(struct i2c_client *client, const struct i2c_device_i
|
|||
#endif
|
||||
|
||||
bTouchIsAwake = 1;
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
ts->usb_connected = 0;
|
||||
ts->nvt_charger_notify_wq = create_singlethread_workqueue("nvt_charger_notify_wq");
|
||||
if (!ts->nvt_charger_notify_wq) {
|
||||
NVT_ERR(" allocate nvt_charger_notify_wq failed\n");
|
||||
goto err_charger_notify_wq_failed;
|
||||
}
|
||||
INIT_WORK(&ts->charger_notify_work, nvt_charger_notify_work);
|
||||
|
||||
ts->charger_notif.notifier_call = charger_notifier_callback;
|
||||
ret = power_supply_reg_notifier(&ts->charger_notif);
|
||||
if (ret) {
|
||||
NVT_ERR("Unable to register charger_notifier: %d\n",ret);
|
||||
goto err_register_charger_notify_failed;
|
||||
}
|
||||
#endif
|
||||
|
||||
NVT_LOG("exit %s normal end\n", __func__);
|
||||
|
||||
enable_irq(client->irq);
|
||||
|
||||
return 0;
|
||||
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
err_register_charger_notify_failed:
|
||||
if (ts->charger_notif.notifier_call)
|
||||
power_supply_unreg_notifier(&ts->charger_notif);
|
||||
destroy_workqueue(ts->nvt_charger_notify_wq);
|
||||
ts->nvt_charger_notify_wq = NULL;
|
||||
err_charger_notify_wq_failed:
|
||||
#endif
|
||||
#if defined(CONFIG_FB)
|
||||
err_register_fb_notif_failed:
|
||||
#elif defined(CONFIG_HAS_EARLYSUSPEND)
|
||||
|
|
@ -1483,6 +1518,12 @@ static int32_t nvt_ts_remove(struct i2c_client *client)
|
|||
#elif defined(CONFIG_HAS_EARLYSUSPEND)
|
||||
unregister_early_suspend(&ts->early_suspend);
|
||||
#endif
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
if (ts->charger_notif.notifier_call)
|
||||
power_supply_unreg_notifier(&ts->charger_notif);
|
||||
|
||||
destroy_workqueue(ts->nvt_charger_notify_wq);
|
||||
#endif
|
||||
|
||||
#if NVT_TOUCH_FW
|
||||
nvt_fw_sysfs_deinit();
|
||||
|
|
@ -1595,6 +1636,7 @@ static int32_t nvt_ts_resume(struct device *dev)
|
|||
return 0;
|
||||
}
|
||||
|
||||
msleep(10);
|
||||
mutex_lock(&ts->lock);
|
||||
|
||||
NVT_LOG("start\n");
|
||||
|
|
@ -1615,6 +1657,9 @@ static int32_t nvt_ts_resume(struct device *dev)
|
|||
queue_delayed_work(nvt_esd_check_wq, &nvt_esd_check_work,
|
||||
msecs_to_jiffies(NVT_TOUCH_ESD_CHECK_PERIOD));
|
||||
#endif /* #if NVT_TOUCH_ESD_PROTECT */
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
queue_work(ts->nvt_charger_notify_wq, &ts->charger_notify_work);
|
||||
#endif
|
||||
|
||||
bTouchIsAwake = 1;
|
||||
#if NVT_TOUCH_FW
|
||||
|
|
@ -1678,6 +1723,106 @@ static void nvt_ts_late_resume(struct early_suspend *h)
|
|||
}
|
||||
#endif
|
||||
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
int32_t nvt_set_charger(uint8_t charger_on_off)
|
||||
{
|
||||
uint8_t buf[8] = {0};
|
||||
int32_t ret = 0;
|
||||
|
||||
NVT_LOG("set charger: %d\n", charger_on_off);
|
||||
|
||||
msleep(20);
|
||||
//---set xdata index to EVENT BUF ADDR---
|
||||
buf[0] = 0xFF;
|
||||
buf[1] = (ts->mmap->EVENT_BUF_ADDR >> 16) & 0xFF;
|
||||
buf[2] = (ts->mmap->EVENT_BUF_ADDR >> 8) & 0xFF;
|
||||
|
||||
ret = CTP_I2C_WRITE(ts->client, I2C_FW_Address, buf, 3);
|
||||
if (ret < 0) {
|
||||
NVT_ERR("Set event buffer index fail!\n");
|
||||
goto nvt_set_charger_out;
|
||||
}
|
||||
|
||||
if (charger_on_off == USB_DETECT_IN) {
|
||||
buf[0] = EVENT_MAP_HOST_CMD;
|
||||
buf[1] = CMD_CHARGER_ON;
|
||||
ret = CTP_I2C_WRITE(ts->client, I2C_FW_Address, buf, 2);
|
||||
if (ret < 0) {
|
||||
NVT_ERR("Write set charger command fail!\n");
|
||||
goto nvt_set_charger_out;
|
||||
}
|
||||
} else if (charger_on_off == USB_DETECT_OUT) {
|
||||
buf[0] = EVENT_MAP_HOST_CMD;
|
||||
buf[1] = CMD_CHARGER_OFF;
|
||||
ret = CTP_I2C_WRITE(ts->client, I2C_FW_Address, buf, 2);
|
||||
if (ret < 0) {
|
||||
NVT_ERR("Write set charger command fail!\n");
|
||||
goto nvt_set_charger_out;
|
||||
}
|
||||
} else {
|
||||
NVT_ERR("Invalid charger parameter!\n");
|
||||
ret = -EINVAL;
|
||||
}
|
||||
|
||||
nvt_set_charger_out:
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void nvt_charger_notify_work(struct work_struct *work)
|
||||
{
|
||||
if (NULL == work) {
|
||||
NVT_ERR("%s: parameter work are null!\n", __func__);
|
||||
return;
|
||||
}
|
||||
NVT_LOG("enter\n");
|
||||
if (USB_DETECT_IN == usb_detect_flag) {
|
||||
nvt_set_charger(USB_DETECT_IN);
|
||||
} else if (USB_DETECT_OUT == usb_detect_flag) {
|
||||
nvt_set_charger(USB_DETECT_OUT);
|
||||
}else{
|
||||
NVT_LOG("Charger flag:%d not currently required!\n",usb_detect_flag);
|
||||
}
|
||||
}
|
||||
|
||||
static int charger_notifier_callback(struct notifier_block *nb,
|
||||
unsigned long val, void *v)
|
||||
{
|
||||
int ret = 0;
|
||||
struct power_supply *psy = NULL;
|
||||
struct nvt_ts_data *ts = container_of(nb, struct nvt_ts_data, charger_notif);
|
||||
union power_supply_propval prop;
|
||||
|
||||
psy= power_supply_get_by_name("usb");
|
||||
if (!psy){
|
||||
return -EINVAL;
|
||||
NVT_ERR("Couldn't get usbpsy\n");
|
||||
}
|
||||
if (!strcmp(psy->desc->name, "usb")){
|
||||
if (psy && ts && val == POWER_SUPPLY_PROP_STATUS) {
|
||||
ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_PRESENT,&prop);
|
||||
if (ret < 0) {
|
||||
NVT_ERR("Couldn't get POWER_SUPPLY_PROP_ONLINE rc=%d\n", ret);
|
||||
return ret;
|
||||
}else{
|
||||
usb_detect_flag = prop.intval;
|
||||
if(usb_detect_flag != ts->usb_connected) {
|
||||
if (USB_DETECT_IN == usb_detect_flag) {
|
||||
ts->usb_connected = USB_DETECT_IN;
|
||||
}else{
|
||||
ts->usb_connected = USB_DETECT_OUT;
|
||||
}
|
||||
if (bTouchIsAwake){
|
||||
queue_work(ts->nvt_charger_notify_wq, &ts->charger_notify_work);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
#if 0
|
||||
static const struct dev_pm_ops nvt_ts_dev_pm_ops = {
|
||||
.suspend = nvt_ts_suspend,
|
||||
|
|
|
|||
|
|
@ -88,6 +88,14 @@ extern const uint16_t gesture_key_array[];
|
|||
#define NVT_TOUCH_ESD_PROTECT 1
|
||||
#define NVT_TOUCH_ESD_CHECK_PERIOD 2000 /* ms */
|
||||
|
||||
#define CONFIG_CHARGER_NOTIFY
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
#define USB_DETECT_IN 1
|
||||
#define USB_DETECT_OUT 0
|
||||
#define CMD_CHARGER_ON (0x53)
|
||||
#define CMD_CHARGER_OFF (0x51)
|
||||
#endif
|
||||
|
||||
struct nvt_ts_data {
|
||||
struct i2c_client *client;
|
||||
struct input_dev *input_dev;
|
||||
|
|
@ -122,6 +130,12 @@ struct nvt_ts_data {
|
|||
uint8_t force_reflash;
|
||||
uint8_t loading_fw;
|
||||
#endif
|
||||
#if defined(CONFIG_CHARGER_NOTIFY)
|
||||
struct notifier_block charger_notif;
|
||||
uint8_t usb_connected;
|
||||
struct workqueue_struct *nvt_charger_notify_wq;
|
||||
struct work_struct charger_notify_work;
|
||||
#endif
|
||||
};
|
||||
|
||||
#if NVT_TOUCH_FW
|
||||
|
|
|
|||
Loading…
Reference in a new issue