/* SPDX-License-Identifier: GPL-2.0 */ /* * Copyright (C) 2016 MediaTek Inc. */ #include "focaltech_core.h" /***************************************************************************** * 2.Private constant and macro definitions using #define *****************************************************************************/ /***************************************************************************** * 3.Private enumerations, structures and unions using typedef *****************************************************************************/ enum _ex_mode { MODE_GLOVE = 0, MODE_COVER, MODE_CHARGER, }; /***************************************************************************** * 4.Static variables *****************************************************************************/ /***************************************************************************** * 5.Global variable or extern global variabls/functions *****************************************************************************/ /***************************************************************************** * 6.Static function prototypes *************************************************************************/ static int fts_ex_mode_switch(enum _ex_mode mode, u8 value) { int ret = 0; u8 m_val = 0; if (value) m_val = 0x01; else m_val = 0x00; switch (mode) { case MODE_GLOVE: ret = fts_write_reg(FTS_REG_GLOVE_MODE_EN, m_val); if (ret < 0) FTS_ERROR("MODE_GLOVE switch to %d fail", m_val); break; case MODE_COVER: ret = fts_write_reg(FTS_REG_COVER_MODE_EN, m_val); if (ret < 0) FTS_ERROR("MODE_COVER switch to %d fail", m_val); break; case MODE_CHARGER: ret = fts_write_reg(FTS_REG_CHARGER_MODE_EN, m_val); if (ret < 0) FTS_ERROR("MODE_CHARGER switch to %d fail", m_val); break; default: FTS_ERROR("mode(%d) unsupport", mode); ret = -EINVAL; break; } return ret; } static ssize_t fts_glove_mode_show(struct device *dev, struct device_attribute *attr, char *buf) { int count = 0; u8 val = 0; struct fts_ts_data *ts_data = fts_data; struct input_dev *input_dev = ts_data->input_dev; mutex_lock(&input_dev->mutex); fts_read_reg(FTS_REG_GLOVE_MODE_EN, &val); count = snprintf(buf + count, PAGE_SIZE, "Glove Mode:%s\n", ts_data->glove_mode ? "On" : "Off"); count += snprintf(buf + count, PAGE_SIZE, "Glove Reg(0xC0):%d\n", val); mutex_unlock(&input_dev->mutex); return count; } static ssize_t fts_glove_mode_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { int ret = 0; struct fts_ts_data *ts_data = fts_data; if (FTS_SYSFS_ECHO_ON(buf)) { if (!ts_data->glove_mode) { FTS_DEBUG("enter glove mode"); ret = fts_ex_mode_switch(MODE_GLOVE, ENABLE); if (ret >= 0) ts_data->glove_mode = ENABLE; } } else if (FTS_SYSFS_ECHO_OFF(buf)) { if (ts_data->glove_mode) { FTS_DEBUG("exit glove mode"); ret = fts_ex_mode_switch(MODE_GLOVE, DISABLE); if (ret >= 0) ts_data->glove_mode = DISABLE; } } FTS_DEBUG("glove mode:%d", ts_data->glove_mode); return count; } static ssize_t fts_cover_mode_show(struct device *dev, struct device_attribute *attr, char *buf) { int count = 0; u8 val = 0; struct fts_ts_data *ts_data = fts_data; struct input_dev *input_dev = ts_data->input_dev; mutex_lock(&input_dev->mutex); fts_read_reg(FTS_REG_COVER_MODE_EN, &val); count = snprintf(buf + count, PAGE_SIZE, "Cover Mode:%s\n", ts_data->cover_mode ? "On" : "Off"); count += snprintf(buf + count, PAGE_SIZE, "Cover Reg(0xC1):%d\n", val); mutex_unlock(&input_dev->mutex); return count; } static ssize_t fts_cover_mode_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { int ret = 0; struct fts_ts_data *ts_data = fts_data; if (FTS_SYSFS_ECHO_ON(buf)) { if (!ts_data->cover_mode) { FTS_DEBUG("enter cover mode"); ret = fts_ex_mode_switch(MODE_COVER, ENABLE); if (ret >= 0) ts_data->cover_mode = ENABLE; } } else if (FTS_SYSFS_ECHO_OFF(buf)) { if (ts_data->cover_mode) { FTS_DEBUG("exit cover mode"); ret = fts_ex_mode_switch(MODE_COVER, DISABLE); if (ret >= 0) ts_data->cover_mode = DISABLE; } } FTS_DEBUG("cover mode:%d", ts_data->cover_mode); return count; } static ssize_t fts_charger_mode_show(struct device *dev, struct device_attribute *attr, char *buf) { int count = 0; u8 val = 0; struct fts_ts_data *ts_data = fts_data; struct input_dev *input_dev = ts_data->input_dev; mutex_lock(&input_dev->mutex); fts_read_reg(FTS_REG_CHARGER_MODE_EN, &val); count = snprintf(buf + count, PAGE_SIZE, "Charger Mode:%s\n", ts_data->charger_mode ? "On" : "Off"); count += snprintf(buf + count, PAGE_SIZE, "Charger Reg(0x8B):%d\n", val); mutex_unlock(&input_dev->mutex); return count; } static ssize_t fts_charger_mode_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { int ret = 0; struct fts_ts_data *ts_data = fts_data; if (FTS_SYSFS_ECHO_ON(buf)) { if (!ts_data->charger_mode) { FTS_DEBUG("enter charger mode"); ret = fts_ex_mode_switch(MODE_CHARGER, ENABLE); if (ret >= 0) ts_data->charger_mode = ENABLE; } } else if (FTS_SYSFS_ECHO_OFF(buf)) { if (ts_data->charger_mode) { FTS_DEBUG("exit charger mode"); ret = fts_ex_mode_switch(MODE_CHARGER, DISABLE); if (ret >= 0) ts_data->charger_mode = DISABLE; } } FTS_DEBUG("charger mode:%d", ts_data->glove_mode); return count; } /* read and write charger mode * read example: cat fts_glove_mode ---read glove mode * write example:echo 1 > fts_glove_mode ---write glove mode to 01 */ static DEVICE_ATTR_RW(fts_glove_mode); static DEVICE_ATTR_RW(fts_cover_mode); static DEVICE_ATTR_RW(fts_charger_mode); static struct attribute *fts_touch_mode_attrs[] = { &dev_attr_fts_glove_mode.attr, &dev_attr_fts_cover_mode.attr, &dev_attr_fts_charger_mode.attr, NULL, }; static struct attribute_group fts_touch_mode_group = { .attrs = fts_touch_mode_attrs, }; int fts_ex_mode_recovery(struct fts_ts_data *ts_data) { if (ts_data->glove_mode) fts_ex_mode_switch(MODE_GLOVE, ENABLE); if (ts_data->cover_mode) fts_ex_mode_switch(MODE_COVER, ENABLE); if (ts_data->charger_mode) fts_ex_mode_switch(MODE_CHARGER, ENABLE); return 0; } int fts_ex_mode_init(struct fts_ts_data *ts_data) { int ret = 0; ts_data->glove_mode = DISABLE; ts_data->cover_mode = DISABLE; ts_data->charger_mode = DISABLE; ret = sysfs_create_group(&ts_data->dev->kobj, &fts_touch_mode_group); if (ret < 0) { FTS_ERROR("create sysfs(ex_mode) fail"); sysfs_remove_group(&ts_data->dev->kobj, &fts_touch_mode_group); return ret; } FTS_DEBUG("create sysfs(ex_mode) succeedfully"); return 0; } int fts_ex_mode_exit(struct fts_ts_data *ts_data) { sysfs_remove_group(&ts_data->dev->kobj, &fts_touch_mode_group); return 0; }