* Author: Dima Zavin <dima@android.com>
* Simon Wilson <simonwilson@google.com>
*
- * ISP reflashing code based on original code from Melfas.
* ISC reflashing code based on original code from Melfas.
*
* This program is free software; you can redistribute it and/or modify it
*/
#define ISC_DL_MODE 1
-#define TOUCH_BOOSTER 0
-#define SEC_TSP_FACTORY_TEST 0
#define TSP_TA_CALLBACK 1
-#define SHOW_TSP_DEBUG_MSG 1
-/* #define ESD_DEBUG */
#include <linux/delay.h>
-#ifdef CONFIG_HAS_EARLYSUSPEND
-#include <linux/earlysuspend.h>
-#endif
#include <linux/firmware.h>
#include <linux/gpio.h>
#include <linux/i2c.h>
#include <linux/suspend.h>
#include <linux/pm_qos.h>
-#if TOUCH_BOOSTER
-#include <mach/cpufreq.h>
-#include <mach/dev.h>
-#endif
-
#include "mms_ts_w_firmware_rev00.h"
#include "mms_ts_w_config_fw_rev00.h"
#include "mms_ts_w_firmware_rev01.h"
/* Registers */
#define MMS_INPUT_EVENT_PKT_SZ 0x0F
#define MMS_INPUT_EVENT0 0x10
-
#define MMS_TSP_REVISION 0xF0
#define MMS_HW_REVISION 0xF1
#define MMS_COMPAT_GROUP 0xF2
TOUCH_BOOSTER_QUICK_OFF,
};
-#if TOUCH_BOOSTER
-#define TOUCH_BOOSTER_CPU_CLK 800000
-#define TOUCH_BOOSTER_BUS_CLK_266 267160
-#define TOUCH_BOOSTER_BUS_CLK_400 400200
-#define TOUCH_BOOSTER_OFF_TIME 100
-#define TOUCH_BOOSTER_CHG_TIME 200
-#endif
-
#if ISC_DL_MODE /* ISC_DL_MODE start */
/*
* ISC_XFER_LEN - ISC unit transfer length.
};
enum {
- GET_RX_NUM = 1,
- GET_TX_NUM,
- GET_EVENT_DATA,
-};
-
-enum {
- LOG_TYPE_U08 = 2,
- LOG_TYPE_S08,
- LOG_TYPE_U16,
- LOG_TYPE_S16,
- LOG_TYPE_U32 = 8,
- LOG_TYPE_S32,
-};
-
-enum {
ISC_ADDR = 0xD5,
ISC_CMD_READ_STATUS = 0xD9,
};
enum {
- CONFIGID_COMMONCONF = 0,
- CONFIGID_NORMALCONF = 1,
- CONFIGID_TXCH = 2,
- CONFIGID_RXCH,
- CONFIGID_KEYTXIDX,
- CONFIGID_KEYRXIDX,
- CONFIGID_DELAYOFFSET,
- CONFIGID_NOISECONF,
- CONFIGID_NORMALIZETABLE,
- CONFIGID_KEYNORMALIZETABLE,
-};
-
-enum {
MMS_RUN_TYPE_SINGLE = 1,
MMS_RUN_TYPE_ARRAY,
MMS_RUN_TYPE_END,
#endif /* ISC_DL_MODE end */
-enum {
- ISP_MODE_FLASH_ERASE = 0x59F3,
- ISP_MODE_FLASH_WRITE = 0x62CD,
- ISP_MODE_FLASH_READ = 0x6AC9,
-};
-
-/* each address addresses 4-byte words */
-#define ISP_MAX_FW_SIZE (0x1F00 * 4)
-#define ISP_IC_INFO_ADDR 0x1F00
-
-#if SEC_TSP_FACTORY_TEST
-#define TSP_BUF_SIZE 1024
-
-/* self diagnostic */
-#define ADDR_CH_NUM 0x0B
-#define ADDR_UNIV_CMD 0xA0
-#define CMD_ENTER_TEST 0x40
-#define CMD_EXIT_TEST 0x4F
-#define CMD_CM_DELTA 0x41
-#define CMD_GET_DELTA 0x42
-#define CMD_CM_ABS 0X43
-#define CMD_GET_ABS 0X44
-#define CMD_CM_JITTER 0X45
-#define CMD_GET_JITTER 0X46
-#define CMD_GET_INTEN 0x70
-#define CMD_GET_INTEN_KEY 0x71
-#define CMD_RESULT_SZ 0XAE
-#define CMD_RESULT 0XAF
-
-/* VSC(Vender Specific Command) */
-#define MMS_VSC_CMD 0xB0 /* vendor specific command */
-#define MMS_VSC_MODE 0x1A /* mode of vendor */
-
-#define MMS_VSC_CMD_ENTER 0X01
-#define MMS_VSC_CMD_CM_DELTA 0X02
-#define MMS_VSC_CMD_CM_ABS 0X03
-#define MMS_VSC_CMD_EXIT 0X05
-#define MMS_VSC_CMD_INTENSITY 0X04
-#define MMS_VSC_CMD_RAW 0X06
-#define MMS_VSC_CMD_REFER 0X07
-
-#define TSP_CMD_STR_LEN 32
-#define TSP_CMD_RESULT_STR_LEN 512
-#define TSP_CMD_PARAM_NUM 8
-
-enum {
- FAIL_PWR_CONTROL = -1,
- SUCCESS_PWR_CONTROL = 0,
-};
-
-enum { /* this is using by cmd_state valiable. */
- WAITING = 0,
- RUNNING,
- OK,
- FAIL,
- NOT_APPLICABLE,
-};
-#endif /* SEC_TSP_FACTORY_TEST */
-
struct tsp_callbacks {
void (*inform_charger)(struct tsp_callbacks *tsp_cb, bool mode);
};
u16 mcount[MAX_FINGERS];
struct melfas_tsi_platform_data *pdata;
-#ifdef CONFIG_HAS_EARLYSUSPEND
- struct early_suspend early_suspend;
-#endif
struct mutex lock;
void (*register_cb)(void *);
struct pm_qos_request busfreq_pm_qos_req;
struct pm_qos_request cpufreq_pm_qos_req;
-
-#if TOUCH_BOOSTER
- struct delayed_work work_dvfs_off;
- struct delayed_work work_dvfs_chg;
- bool dvfs_lock_status;
- int cpufreq_level;
- struct mutex dvfs_lock;
- struct device *bus_dev;
- struct device *sec_touchscreen;
-#endif /* TOUCH_BOOSTER */
-
-#if SEC_TSP_FACTORY_TEST
- struct list_head cmd_list_head;
- u8 cmd_state;
- char cmd[TSP_CMD_STR_LEN];
- int cmd_param[TSP_CMD_PARAM_NUM];
- char cmd_result[TSP_CMD_RESULT_STR_LEN];
- struct mutex cmd_lock;
- bool cmd_is_running;
- bool ft_flag;
- unsigned int *reference;
- unsigned int *cm_abs;
- unsigned int *cm_delta;
- unsigned int *intensity;
-#endif /* SEC_TSP_FACTORY_TEST */
-};
-
-#ifdef CONFIG_HAS_EARLYSUSPEND
-static void mms_ts_early_suspend(struct early_suspend *h);
-static void mms_ts_late_resume(struct early_suspend *h);
-#endif
-
-#if SEC_TSP_FACTORY_TEST
-#define TSP_CMD(name, func) .cmd_name = name, .cmd_func = func
-
-struct tsp_cmd {
- struct list_head list;
- const char *cmd_name;
- void (*cmd_func)(void *device_data);
-};
-
-static void fw_update(void *device_data);
-static void get_fw_ver_bin(void *device_data);
-static void get_fw_ver_ic(void *device_data);
-static void get_config_ver(void *device_data);
-static void get_threshold(void *device_data);
-static void module_off_master(void *device_data);
-static void module_on_master(void *device_data);
-static void module_off_slave(void *device_data);
-static void module_on_slave(void *device_data);
-static void get_chip_vendor(void *device_data);
-static void get_chip_name(void *device_data);
-static void get_reference(void *device_data);
-static void get_cm_abs(void *device_data);
-static void get_cm_delta(void *device_data);
-static void get_intensity(void *device_data);
-static void get_x_num(void *device_data);
-static void get_y_num(void *device_data);
-static void run_reference_read(void *device_data);
-static void run_cm_abs_read(void *device_data);
-static void run_cm_delta_read(void *device_data);
-static void run_intensity_read(void *device_data);
-static void not_support_cmd(void *device_data);
-
-struct tsp_cmd tsp_cmds[] = {
- {TSP_CMD("fw_update", fw_update),},
- {TSP_CMD("get_fw_ver_bin", get_fw_ver_bin),},
- {TSP_CMD("get_fw_ver_ic", get_fw_ver_ic),},
- {TSP_CMD("get_config_ver", get_config_ver),},
- {TSP_CMD("get_threshold", get_threshold),},
- {TSP_CMD("module_off_master", module_off_master),},
- {TSP_CMD("module_on_master", module_on_master),},
- {TSP_CMD("module_off_slave", not_support_cmd),},
- {TSP_CMD("module_on_slave", not_support_cmd),},
- {TSP_CMD("get_chip_vendor", get_chip_vendor),},
- {TSP_CMD("get_chip_name", get_chip_name),},
- {TSP_CMD("get_x_num", get_x_num),},
- {TSP_CMD("get_y_num", get_y_num),},
- {TSP_CMD("get_reference", get_reference),},
- {TSP_CMD("get_cm_abs", get_cm_abs),},
- {TSP_CMD("get_cm_delta", get_cm_delta),},
- {TSP_CMD("get_intensity", get_intensity),},
- {TSP_CMD("run_reference_read", run_reference_read),},
- {TSP_CMD("run_cm_abs_read", run_cm_abs_read),},
- {TSP_CMD("run_cm_delta_read", run_cm_delta_read),},
- {TSP_CMD("run_intensity_read", run_intensity_read),},
- {TSP_CMD("not_support_cmd", not_support_cmd),},
};
-#endif
static int enabled = 0;
u8 flash_array[50];
u8 cmp_data[30];
+ if (!info->enabled){
+ dev_info(&info->client->dev, "%s: power off\n", __func__);
+ return;
+ }
+
if(info->config_fw== NULL) {
dev_err(&client->dev, "failed to get config fw\n");
return;
}
-#if TOUCH_BOOSTER
-static void change_dvfs_lock(struct work_struct *work)
-{
- struct mms_ts_info *info = container_of(work,
- struct mms_ts_info, work_dvfs_chg.work);
- int ret;
-
- mutex_lock(&info->dvfs_lock);
- ret = dev_lock(info->bus_dev, info->sec_touchscreen,
- TOUCH_BOOSTER_BUS_CLK_266);
-
- if (ret < 0)
- dev_err(&info->client->dev,
- "%s dev change bud lock failed(%d)\n",\
- __func__, __LINE__);
- else
- dev_notice(&info->client->dev, "Change dvfs lock");
- mutex_unlock(&info->dvfs_lock);
-}
-static void set_dvfs_off(struct work_struct *work)
-{
-
- struct mms_ts_info *info = container_of(work,
- struct mms_ts_info, work_dvfs_off.work);
- int ret;
-
- mutex_lock(&info->dvfs_lock);
-
- ret = dev_unlock(info->bus_dev, info->sec_touchscreen);
- if (ret < 0)
- dev_err(&info->client->dev, " %s: dev unlock failed(%d)\n",
- __func__, __LINE__);
-
- exynos_cpufreq_lock_free(DVFS_LOCK_ID_TSP);
- info->dvfs_lock_status = false;
- dev_notice(&info->client->dev, "dvfs off!");
- mutex_unlock(&info->dvfs_lock);
-}
-
-static void set_dvfs_lock(struct mms_ts_info *info, uint32_t mode)
-{
- int ret;
-
- mutex_lock(&info->dvfs_lock);
- if (info->cpufreq_level <= 0) {
- ret = exynos_cpufreq_get_level(TOUCH_BOOSTER_CPU_CLK,
- &info->cpufreq_level);
- if (ret < 0)
- dev_err(&info->client->dev,
- "exynos_cpufreq_get_level error");
- goto out;
- }
-
- if (mode == TOUCH_BOOSTER_DELAY_OFF) {
- if (info->dvfs_lock_status) {
- cancel_delayed_work(&info->work_dvfs_chg);
- schedule_delayed_work(&info->work_dvfs_off,
- msecs_to_jiffies(TOUCH_BOOSTER_OFF_TIME));
- }
-
- } else if (mode == TOUCH_BOOSTER_ON) {
- cancel_delayed_work(&info->work_dvfs_off);
- if (!info->dvfs_lock_status) {
- ret = dev_lock(info->bus_dev, info->sec_touchscreen,
- TOUCH_BOOSTER_BUS_CLK_400);
- if (ret < 0) {
- dev_err(&info->client->dev,
- "%s: dev lock failed(%d)",
- __func__, __LINE__);
- }
-
- ret = exynos_cpufreq_lock(DVFS_LOCK_ID_TSP,
- info->cpufreq_level);
- if (ret < 0)
- dev_err(&info->client->dev,
- "%s: cpu lock failed(%d)",
- __func__, __LINE__);
-
- schedule_delayed_work(&info->work_dvfs_chg,
- msecs_to_jiffies(TOUCH_BOOSTER_CHG_TIME));
-
- info->dvfs_lock_status = true;
- dev_notice(&info->client->dev, "dvfs on[%d]",
- info->cpufreq_level);
- }
- } else if (mode == TOUCH_BOOSTER_QUICK_OFF) {
- cancel_delayed_work(&info->work_dvfs_off);
- cancel_delayed_work(&info->work_dvfs_chg);
- schedule_work(&info->work_dvfs_off.work);
- }
-out:
- mutex_unlock(&info->dvfs_lock);
-}
-#endif
static void mms_ts_pm_qos_request(struct mms_ts_info *info,
unsigned int cpu_freq, unsigned int bus_freq)
}
input_sync(info->input_dev);
-#if TOUCH_BOOSTER
- set_dvfs_lock(info, TOUCH_BOOSTER_QUICK_OFF);
- dev_notice(&info->client->dev, "dvfs lock free.\n");
-#endif
-
mms_ts_pm_qos_request(info, PM_QOS_CPU_FREQUENCY_MIN_VALUE,
PM_QOS_BUS_FREQUENCY_MIN_VALUE);
}
}
}
-#if TOUCH_BOOSTER
- set_dvfs_lock(info, press_flag);
-#endif
-
if (press_flag == TOUCH_BOOSTER_ON) {
/* cpu frequency : 400MHz, bus frequency : 100MHz */
mms_ts_pm_qos_request(info, 400000, 100000);
return IRQ_HANDLED;
}
-static void hw_reboot(struct mms_ts_info *info, bool bootloader)
-{
- mms_ts_power(info, 0);
- gpio_direction_output(info->pdata->gpio_sda, bootloader ? 0 : 1);
- gpio_direction_output(info->pdata->gpio_scl, bootloader ? 0 : 1);
- gpio_direction_output(info->pdata->gpio_int, 0);
- msleep(30);
- mms_ts_power(info, 1);
- msleep(30);
-
- if (bootloader) {
- gpio_set_value(info->pdata->gpio_scl, 0);
- gpio_set_value(info->pdata->gpio_sda, 1);
- } else {
- gpio_set_value(info->pdata->gpio_int, 1);
- gpio_direction_input(info->pdata->gpio_int);
- gpio_direction_input(info->pdata->gpio_scl);
- gpio_direction_input(info->pdata->gpio_sda);
- }
- msleep(40);
-}
-
-static inline void hw_reboot_bootloader(struct mms_ts_info *info)
-{
- hw_reboot(info, true);
-}
-
-static inline void hw_reboot_normal(struct mms_ts_info *info)
-{
- hw_reboot(info, false);
-}
-
static int mms_ts_fw_load(struct mms_ts_info *info)
{
struct i2c_client *client = info->client;
return ret;
}
-#if SEC_TSP_FACTORY_TEST
-static void set_cmd_result(struct mms_ts_info *info, char *buff, int len)
+#ifdef CONFIG_TIZEN_WIP
+static int mms_ts_suspend(struct device *dev);
+static int mms_ts_resume(struct device *dev);
+
+static ssize_t show_enabled(struct device *dev, struct device_attribute *attr,
+ char *buf)
{
- strncat(info->cmd_result, buff, len);
+ struct mms_ts_info *info = dev_get_drvdata(dev);
+ return sprintf(buf, "%d\n", info->enabled);
}
-static int get_data(struct mms_ts_info *info, u8 addr, u8 size, u8 *array)
+static ssize_t store_enabled(struct device *dev, struct device_attribute *attr,
+ const char *buf, size_t size)
{
- struct i2c_client *client = info->client;
- struct i2c_adapter *adapter = client->adapter;
- struct i2c_msg msg;
- u8 reg = addr;
- unsigned char buf[size];
+ struct mms_ts_info *info = dev_get_drvdata(dev);
+ int enabled;
int ret;
- msg.addr = client->addr;
- msg.flags = 0x00;
- msg.len = 1;
- msg.buf = ®
-
- ret = i2c_transfer(adapter, &msg, 1);
+ ret = sscanf(buf, "%d", &enabled);
+ if (ret == 0)
+ return -EINVAL;
- if (ret >= 0) {
- msg.addr = client->addr;
- msg.flags = I2C_M_RD;
- msg.len = size;
- msg.buf = buf;
+ if (enabled == info->enabled)
+ return 0;
- ret = i2c_transfer(adapter, &msg, 1);
- }
- if (ret < 0) {
- pr_err("[TSP] : read error : [%d]", ret);
- return ret;
+ if (enabled) {
+ info->enabled_user = false;
+ mms_ts_resume(&info->client->dev);
+ } else {
+ mms_ts_suspend(&info->client->dev);
+ info->enabled_user = true;
}
- memcpy(array, &buf, size);
+ info->enabled = enabled;
+
return size;
}
+static DEVICE_ATTR(enabled, S_IRUGO | S_IWUSR, show_enabled, store_enabled);
-static void get_intensity_data(struct mms_ts_info *info)
-{
- u8 w_buf[4];
- u8 r_buf;
- u8 read_buffer[60] = {0};
- int i, j;
- int ret;
- u16 max_value = 0, min_value = 0;
- u16 raw_data;
- char buff[TSP_CMD_STR_LEN] = {0};
- int tx_num = info->pdata->tsp_tx;
- int rx_num = info->pdata->tsp_rx;
-
- disable_irq(info->irq);
-
- w_buf[0] = ADDR_UNIV_CMD;
- w_buf[1] = CMD_GET_INTEN;
- w_buf[2] = 0xFF;
- for (i = 0; i < rx_num; i++) {
- w_buf[3] = i;
-
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 3, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
- usleep_range(1, 5);
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- CMD_RESULT_SZ, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- ret = get_data(info, CMD_RESULT, r_buf, read_buffer);
- if (ret < 0)
- goto err_i2c;
-
- for (j = 0; j < r_buf/2; j++) {
- raw_data = read_buffer[2*j] | (read_buffer[2*j+1] << 8);
- if (raw_data > 32767)
- raw_data = 0;
- if (i == 0 && j == 0) {
- max_value = min_value = raw_data;
- } else {
- max_value = max(max_value, raw_data);
- min_value = min(min_value, raw_data);
- }
- info->intensity[i * tx_num + j] = raw_data;
- dev_dbg(&info->client->dev,
- "[TSP] intensity[%d][%d] = %d\n", j, i,
- info->intensity[i * tx_num + j]);
- }
- }
+static struct attribute *mms_ts_attributes[] = {
+ &dev_attr_enabled.attr,
+ NULL,
+};
-#if SHOW_TSP_DEBUG_MSG
- printk("\n");
- for (i=0 ; i < rx_num; i++) {
- printk("melfas-ts data :");
- for (j = 0; j < tx_num; j++) {
- printk("[%d]", info->intensity[i * tx_num + j]);
- }
- printk("\n");
- }
+static struct attribute_group mms_ts_attr_group = {
+ .attrs = mms_ts_attributes,
+};
#endif
- snprintf(buff, sizeof(buff), "%d,%d", min_value, max_value);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
-
- enable_irq(info->irq);
-
- return;
+#ifdef CONFIG_OF
+static struct melfas_tsi_platform_data *mms_ts_parse_dt(struct device *dev)
+{
+ struct melfas_tsi_platform_data *pdata;
+ struct device_node *np = dev->of_node;
-err_i2c:
- dev_err(&info->client->dev, "%s: fail to i2c (cmd=%d)\n",
- __func__, MMS_VSC_CMD_INTENSITY);
-}
+ if (!np)
+ return NULL;
-static int tsp_connector_check(struct mms_ts_info *info)
-{
- u8 w_buf[4];
- u8 r_buf = 0;
- u8 read_buffer[60] = {0};
- int ret;
- int i, j;
- int max_value = 0, min_value = 0;
- int raw_data;
- int retry;
- int gpio = info->pdata->gpio_int;
- int tx_num = info->pdata->tsp_tx;
- int rx_num = info->pdata->tsp_rx;
- bool tsp_connect_state;
-
- dev_info(&info->client->dev, "Check raw data for tsp pannel connect state!\n");
-
- ret = i2c_smbus_write_byte_data(info->client,
- ADDR_UNIV_CMD, CMD_ENTER_TEST);
- if (ret < 0)
- goto err_i2c;
-
- /* event type check */
- retry = 1;
- while (retry) {
- while (gpio_get_value(gpio))
- udelay(100);
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- 0x0F, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- 0x10, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- dev_info(&info->client->dev, "event type = 0x%x\n", r_buf);
- if (r_buf == 0x0C)
- retry = 0;
+ pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
+ if (!pdata) {
+ dev_err(dev, "failed to allocate platform data\n");
+ return NULL;
}
- w_buf[0] = ADDR_UNIV_CMD;
- w_buf[1] = CMD_CM_DELTA;
-
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 1, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
- while (gpio_get_value(gpio))
- udelay(100);
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- CMD_RESULT_SZ, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
- ret = i2c_smbus_read_i2c_block_data(info->client,
- CMD_RESULT, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- if (r_buf == 1)
- dev_info(&info->client->dev, "PASS\n");
- else
- dev_info(&info->client->dev, "FAIL\n");
+ if (of_property_read_u32(np, "max_x", &pdata->max_x)) {
+ dev_err(dev, "failed to get max_x property\n");
+ return NULL;
+ };
- w_buf[1] = CMD_GET_DELTA;
- w_buf[2] = 0xFF;
+ if (of_property_read_u32(np, "max_y", &pdata->max_y)) {
+ dev_err(dev, "failed to get max_y property\n");
+ return NULL;
+ };
- for (i = 0; i < rx_num; i++) {
- w_buf[3] = i;
+ if (of_property_read_u32(np, "invert_x", &pdata->invert_x)) {
+ dev_err(dev, "failed to get invert_x property\n");
+ return NULL;
+ };
+ pdata->invert_x = !!pdata->invert_x;
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 3, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
+ if (of_property_read_u32(np, "invert_y", &pdata->invert_y)) {
+ dev_err(dev, "failed to get invert_y property\n");
+ return NULL;
+ };
+ pdata->invert_y = !!pdata->invert_y;
- while (gpio_get_value(gpio))
- udelay(100);
+ if (of_property_read_string(np, "config_fw_version",
+ &pdata->config_fw_version))
+ dev_warn(dev, "cannot get touchscreen firmware version\n");
- ret = i2c_smbus_read_i2c_block_data(info->client,
- CMD_RESULT_SZ, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
+ pdata->register_cb = NULL;
- ret = get_data(info, CMD_RESULT, r_buf, read_buffer);
- if (ret < 0)
- goto err_i2c;
+ return pdata;
+}
+#else
+static inline struct melfas_tsi_platform_data *mms_ts_parse_dt(struct device *dev)
+{
+ return NULL;
+}
+#endif
- for (j = 0; j < tx_num; j++) {
- raw_data = read_buffer[2*j] | (read_buffer[2*j+1] << 8);
- if (i == 0 && j == 0) {
- max_value = min_value = raw_data;
- } else {
- max_value = max(max_value, raw_data);
- min_value = min(min_value, raw_data);
- }
+static int mms128_pm_notifier_callback(struct notifier_block *this,
+ unsigned long event, void *ptr)
+{
+ struct mms_ts_info *info = container_of(this, struct mms_ts_info,
+ pm_notifier);
- }
+ switch (event) {
+ case PM_SUSPEND_PREPARE:
+ info->suspended = true;
+ break;
+ case PM_POST_RESTORE:
+ case PM_POST_SUSPEND:
+ info->suspended = false;
+ break;
}
- ret = i2c_smbus_write_byte_data(info->client,
- ADDR_UNIV_CMD, CMD_EXIT_TEST);
+ return NOTIFY_DONE;
+}
- if (max_value < 20) {
- tsp_connect_state = 0;
- dev_err(&info->client->dev, "tsp_pannel_connect off checked!\n");
- } else {
- tsp_connect_state = 1;
+static int mms_request_firmware(struct mms_ts_info *info)
+{
+ struct i2c_client *client = info->client;
+ const struct firmware *fw, *fw_config;
+ char fw_path[MAX_FW_PATH + 1];
+ int ret = 0;
- mms_ts_power(info, 0);
- msleep(5);
- mms_ts_power(info, 1);
- msleep(50);
- mms_config_set(info);
- dev_err(&info->client->dev, "tsp_pannel_connect on checked!\n");
+ /* firmware */
+ snprintf(fw_path, MAX_FW_PATH, "%s%s", TSP_FW_DIRECTORY, TSP_FW_NAME);
+ ret = request_firmware(&fw, fw_path, &client->dev);
+ if (ret) {
+ dev_err(&client->dev,
+ "Failed to request firmware (%s)\n", fw_path);
+ return -EINVAL;
+ }
+
+ info->fw_data = kzalloc(fw->size, GFP_KERNEL);
+ if (!info->fw_data) {
+ dev_err(&client->dev,
+ "Faild to allocate firmware memory (%s)\n", fw_path);
+ goto err_fw;
+ }
+ memcpy(info->fw_data, fw->data, fw->size);
+
+ /* configuration firmware */
+ snprintf(fw_path, MAX_FW_PATH, "%s%s", TSP_FW_DIRECTORY, TSP_FW_CONFIG_NAME);
+ ret = request_firmware(&fw_config, fw_path, &client->dev);
+ if (ret) {
+ dev_err(&client->dev,
+ "Failed to request firmware (%s)\n", fw_path);
+ goto err_fw_alloc;
}
- return tsp_connect_state;
+ info->config_fw = kzalloc(fw_config->size, GFP_KERNEL);
+ if (!info->config_fw) {
+ dev_err(&client->dev,
+ "Faild to allocate firmware memory (%s)\n", fw_path);
+ goto err_fw_config;
+ }
+ memcpy(info->config_fw, fw_config->data, fw_config->size);
-err_i2c:
- dev_err(&info->client->dev, "%s : err_i2c!\n", __func__);
- reset_mms_ts(info);
+ release_firmware(fw_config);
+ release_firmware(fw);
- return -1;
+ return 0;
+err_fw_config:
+ release_firmware(fw_config);
+err_fw_alloc:
+ kfree(info->fw_data);
+err_fw:
+ release_firmware(fw);
+ return ret;
}
-
-static void get_raw_data(struct mms_ts_info *info, u8 cmd)
+static int mms_ts_input_open(struct input_dev *dev)
{
- u8 w_buf[4];
- u8 r_buf = 0;
- u8 read_buffer[60] = {0};
- int ret;
- int i, j;
- int max_value = 0, min_value = 0;
- int raw_data;
- int retry;
- char buff[TSP_CMD_STR_LEN] = {0};
- int gpio = info->pdata->gpio_int;
- int tx_num = info->pdata->tsp_tx;
- int rx_num = info->pdata->tsp_rx;
+ struct mms_ts_info *info = input_get_drvdata(dev);
- disable_irq(info->irq);
-
- ret = i2c_smbus_write_byte_data(info->client,
- ADDR_UNIV_CMD, CMD_ENTER_TEST);
- if (ret < 0)
- goto err_i2c;
-
- /* event type check */
- retry = 1;
- while (retry) {
- while (gpio_get_value(gpio))
- udelay(100);
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- 0x0F, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- 0x10, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- dev_info(&info->client->dev, "event type = 0x%x\n", r_buf);
- if (r_buf == 0x0C)
- retry = 0;
- }
-
- w_buf[0] = ADDR_UNIV_CMD;
- if (cmd == MMS_VSC_CMD_CM_DELTA)
- w_buf[1] = CMD_CM_DELTA;
- else
- w_buf[1] = CMD_CM_ABS;
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 1, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
- while (gpio_get_value(gpio))
- udelay(100);
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- CMD_RESULT_SZ, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
- ret = i2c_smbus_read_i2c_block_data(info->client,
- CMD_RESULT, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- if (r_buf == 1)
- dev_info(&info->client->dev, "PASS\n");
- else
- dev_info(&info->client->dev, "FAIL\n");
-
- if (cmd == MMS_VSC_CMD_CM_DELTA)
- w_buf[1] = CMD_GET_DELTA;
- else
- w_buf[1] = CMD_GET_ABS;
- w_buf[2] = 0xFF;
-
- for (i = 0; i < rx_num; i++) {
- w_buf[3] = i;
-
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 3, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
-
- while (gpio_get_value(gpio))
- udelay(100);
-
- ret = i2c_smbus_read_i2c_block_data(info->client,
- CMD_RESULT_SZ, 1, &r_buf);
- if (ret < 0)
- goto err_i2c;
-
- ret = get_data(info, CMD_RESULT, r_buf, read_buffer);
- if (ret < 0)
- goto err_i2c;
-
- for (j = 0; j < tx_num; j++) {
- raw_data = read_buffer[2*j] | (read_buffer[2*j+1] << 8);
- if (i == 0 && j == 0) {
- max_value = min_value = raw_data;
- } else {
- max_value = max(max_value, raw_data);
- min_value = min(min_value, raw_data);
- }
-
- if (cmd == MMS_VSC_CMD_CM_DELTA) {
- info->cm_delta[i * tx_num + j] =
- raw_data;
- dev_dbg(&info->client->dev,
- "[TSP] delta[%d][%d] = %d\n", j, i,
- info->cm_delta[i * tx_num + j]);
- } else if (cmd == MMS_VSC_CMD_CM_ABS) {
- info->cm_abs[i * tx_num + j] =
- raw_data;
- dev_dbg(&info->client->dev,
- "[TSP] raw[%d][%d] = %d\n", j, i,
- info->cm_abs[i * tx_num + j]);
- } else if (cmd == MMS_VSC_CMD_REFER) {
- info->reference[i * tx_num + j] =
- raw_data;
- dev_dbg(&info->client->dev,
- "[TSP] reference[%d][%d] = %d\n", j, i,
- info->reference[i * tx_num + j]);
- }
- }
- }
-
- ret = i2c_smbus_write_byte_data(info->client,
- ADDR_UNIV_CMD, CMD_EXIT_TEST);
-
-#if SHOW_TSP_DEBUG_MSG
- printk("\n");
- for (i=0 ; i < rx_num; i++) {
- printk("melfas-ts data :");
- for (j = 0; j < tx_num; j++) {
- if (cmd == MMS_VSC_CMD_CM_DELTA) {
- printk("[%d]", info->cm_delta[i * tx_num + j]);
- } else if (cmd == MMS_VSC_CMD_CM_ABS) {
- printk("[%d]", info->cm_abs[i * tx_num + j]);
- } else if (cmd == MMS_VSC_CMD_REFER) {
- printk("[%d]", info->reference[i * tx_num + j]);
- }
- }
- printk("\n");
- }
-#endif
- snprintf(buff, sizeof(buff), "%d,%d", min_value, max_value);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
-
- enable_irq(info->irq);
-
- return;
-
-err_i2c:
- dev_err(&info->client->dev, "%s: fail to i2c (cmd=%d)\n",
- __func__, cmd);
-}
-
-
-static void get_raw_data_all(struct mms_ts_info *info, u8 cmd)
-{
- u8 w_buf[6];
- u8 read_buffer[2]; /* 52 */
- int gpio = info->pdata->gpio_int;
- int ret;
- int i, j;
- u32 max_value = 0, min_value = 0;
- u32 raw_data;
- char buff[TSP_CMD_STR_LEN] = {0};
- int tx_num = info->pdata->tsp_tx;
- int rx_num = info->pdata->tsp_rx;
-
- disable_irq(info->irq);
-
- w_buf[0] = MMS_VSC_CMD; /* vendor specific command id */
- w_buf[1] = MMS_VSC_MODE; /* mode of vendor */
- w_buf[2] = 0; /* tx line */
- w_buf[3] = 0; /* rx line */
- w_buf[4] = 0; /* reserved */
- w_buf[5] = 0; /* sub command */
-
- if (cmd == MMS_VSC_CMD_EXIT) {
- w_buf[5] = MMS_VSC_CMD_EXIT; /* exit test mode */
-
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 5, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
- enable_irq(info->irq);
- msleep(200);
- return;
- }
-
- /* MMS_VSC_CMD_CM_DELTA or MMS_VSC_CMD_CM_ABS
- * this two mode need to enter the test mode
- * exit command must be followed by testing.
- */
- if (cmd == MMS_VSC_CMD_CM_DELTA || cmd == MMS_VSC_CMD_CM_ABS) {
- /* enter the debug mode */
- w_buf[2] = 0x0; /* tx */
- w_buf[3] = 0x0; /* rx */
- w_buf[5] = MMS_VSC_CMD_ENTER;
-
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 5, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
-
- /* wating for the interrupt */
- while (gpio_get_value(gpio))
- udelay(100);
- }
-
- for (i = 0; i < rx_num; i++) {
- for (j = 0; j < tx_num; j++) {
-
- w_buf[2] = j; /* tx */
- w_buf[3] = i; /* rx */
- w_buf[5] = cmd;
-
- ret = i2c_smbus_write_i2c_block_data(info->client,
- w_buf[0], 5, &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
-
- usleep_range(1, 5);
-
- ret = i2c_smbus_read_i2c_block_data(info->client, 0xBF,
- 2, read_buffer);
- if (ret < 0)
- goto err_i2c;
-
- raw_data = ((u16) read_buffer[1] << 8) | read_buffer[0];
- if (i == 0 && j == 0) {
- max_value = min_value = raw_data;
- } else {
- max_value = max(max_value, raw_data);
- min_value = min(min_value, raw_data);
- }
-
- if (cmd == MMS_VSC_CMD_INTENSITY) {
- info->intensity[j * rx_num + i] = raw_data;
- dev_info(&info->client->dev, "[TSP] intensity[%d][%d] = %d\n",
- i, j, info->intensity[j * rx_num + i]);
- } else if (cmd == MMS_VSC_CMD_CM_DELTA) {
- info->cm_delta[j * rx_num + i] = raw_data;
- dev_info(&info->client->dev, "[TSP] delta[%d][%d] = %d\n",
- i, j, info->cm_delta[j * rx_num + i]);
- } else if (cmd == MMS_VSC_CMD_CM_ABS) {
- info->cm_abs[j * rx_num + i] = raw_data;
- dev_info(&info->client->dev, "[TSP] raw[%d][%d] = %d\n",
- i, j, info->cm_abs[j * rx_num + i]);
- } else if (cmd == MMS_VSC_CMD_REFER) {
- info->reference[j * rx_num + i] =
- raw_data >> 3;
- dev_info(&info->client->dev, "[TSP] reference[%d][%d] = %d\n",
- i, j, info->reference[j * rx_num + i]);
- }
- }
-
- }
-
- snprintf(buff, sizeof(buff), "%d,%d", min_value, max_value);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
-
- enable_irq(info->irq);
- return;
-
-err_i2c:
- dev_err(&info->client->dev, "%s: fail to i2c (cmd=%d)\n",
- __func__, cmd);
-}
-
-static u32 get_raw_data_one(struct mms_ts_info *info, u16 rx_idx, u16 tx_idx,
- u8 cmd)
-{
- u8 w_buf[6];
- u8 read_buffer[2];
- int ret;
- u32 raw_data;
-
- w_buf[0] = MMS_VSC_CMD; /* vendor specific command id */
- w_buf[1] = MMS_VSC_MODE; /* mode of vendor */
- w_buf[2] = 0; /* tx line */
- w_buf[3] = 0; /* rx line */
- w_buf[4] = 0; /* reserved */
- w_buf[5] = 0; /* sub command */
-
- if (cmd != MMS_VSC_CMD_INTENSITY && cmd != MMS_VSC_CMD_RAW &&
- cmd != MMS_VSC_CMD_REFER) {
- dev_err(&info->client->dev, "%s: not profer command(cmd=%d)\n",
- __func__, cmd);
- return -1;
- }
-
- w_buf[2] = tx_idx; /* tx */
- w_buf[3] = rx_idx; /* rx */
- w_buf[5] = cmd; /* sub command */
-
- ret = i2c_smbus_write_i2c_block_data(info->client, w_buf[0], 5,
- &w_buf[1]);
- if (ret < 0)
- goto err_i2c;
-
- ret = i2c_smbus_read_i2c_block_data(info->client, 0xBF, 2, read_buffer);
- if (ret < 0)
- goto err_i2c;
-
- raw_data = ((u16) read_buffer[1] << 8) | read_buffer[0];
- if (cmd == MMS_VSC_CMD_REFER)
- raw_data = raw_data >> 4;
-
- return raw_data;
-
-err_i2c:
- dev_err(&info->client->dev, "%s: fail to i2c (cmd=%d)\n",
- __func__, cmd);
- return -1;
-}
-
-static ssize_t show_close_tsp_test(struct device *dev,
- struct device_attribute *attr, char *buf)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
-
- get_raw_data_all(info, MMS_VSC_CMD_EXIT);
- info->ft_flag = 0;
-
- return snprintf(buf, TSP_BUF_SIZE, "%u\n", 0);
-}
-
-static void set_default_result(struct mms_ts_info *info)
-{
- char delim = ':';
-
- memset(info->cmd_result, 0x00, ARRAY_SIZE(info->cmd_result));
- memcpy(info->cmd_result, info->cmd, strlen(info->cmd));
- strncat(info->cmd_result, &delim, 1);
-}
-
-static int check_rx_tx_num(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[TSP_CMD_STR_LEN] = {0};
- int node;
-
- if (info->cmd_param[0] < 0 ||
- info->cmd_param[0] >= info->pdata->tsp_tx ||
- info->cmd_param[1] < 0 ||
- info->cmd_param[1] >= info->pdata->tsp_rx) {
- snprintf(buff, sizeof(buff) , "%s", "NG");
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = 3;
-
- dev_info(&info->client->dev, "%s: parameter error: %u,%u\n",
- __func__, info->cmd_param[0],
- info->cmd_param[1]);
- node = -1;
- return node;
- }
- /* Model dependency */
- node = info->cmd_param[0] * info->pdata->tsp_rx + info->cmd_param[1];
- dev_info(&info->client->dev, "%s: node = %d\n", __func__,
- node);
- return node;
-
-}
-
-static void not_support_cmd(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
- char buff[16] = {0};
-
- set_default_result(info);
- sprintf(buff, "%s", "NA");
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = 4;
- dev_info(&info->client->dev, "%s: \"%s(%d)\"\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
- return;
-}
-
-static void fw_update(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
- struct i2c_client *client = info->client;
- char fw_path[MAX_FW_PATH+1];
- u8 *fw_data = NULL;
- u8 ver[MAX_SECTION_NUM];
- int retries = 3;
- int ret = 0, i = 0;
- bool fw_read_flag = false;
-
- const struct firmware *fw;
-
- mm_segment_t old_fs = {0};
- struct file *fp = NULL;
- long fsize = 0, nread = 0;
-
- char result[16] = {0};
- set_default_result(info);
-
- dev_info(&client->dev,
- "fw_ic_ver = 0x%02x, fw_bin_ver = 0x%02x\n",
- info->fw_ic_ver[SEC_CONF], info->pdata->fw_bin_ver[SEC_CONF]);
-
- switch (info->cmd_param[0]) {
- case BUILT_IN:
- info->cmd_param[0] = REQ_FW;
- dev_info(&client->dev, "BUILT_IN=>REQ_FW update mode!\n");
- break;
-
- case UMS:
- dev_info(&client->dev, "UMS update mode!\n");
- break;
-
- case REQ_FW:
- dev_info(&client->dev, "REQ_FW update mode!\n");
- break;
-
- default:
- dev_err(&client->dev, "invalid cmd_param[%d]\n",
- info->cmd_param[0]);
- goto not_support;
- }
-
- disable_irq(info->irq);
-
- if(info->cmd_param[0] == REQ_FW){
- snprintf(fw_path, MAX_FW_PATH, "%s%s", TSP_FW_DIRECTORY, TSP_FW_NAME);
- ret = request_firmware(&fw, fw_path, &client->dev);
- if (ret) {
- dev_err(&client->dev, "fail request_firmware[%s]\n", fw_path);
- } else {
- fw_data = kzalloc((size_t)fw->size, GFP_KERNEL);
- memcpy((void *)fw_data, fw->data, fw->size);
- release_firmware(fw);
- fw_read_flag = true;
- }
-
- } else if (info->cmd_param[0] == UMS){
- old_fs = get_fs();
- set_fs(get_ds());
-
- snprintf(fw_path, MAX_FW_PATH, "/sdcard/%s", TSP_FW_NAME);
- fp = filp_open(fw_path, O_RDONLY, 0);
- if (IS_ERR(fp)) {
- dev_err(&client->dev, "file %s open error:%d\n",
- fw_path, (s32)fp);
- } else {
- fsize = fp->f_path.dentry->d_inode->i_size;
- fw_data = kzalloc((size_t)fsize, GFP_KERNEL);
- nread = vfs_read(fp, (char __user *)fw_data, fsize, &fp->f_pos);
- if (nread != fsize) {
- dev_err(&client->dev, "nread != fsize error\n");
- }
- filp_close(fp, current->files);
- fw_read_flag = true;
- }
- set_fs(old_fs);
- }
-
- for(i=0 ; fw_read_flag == true && i < retries ; i++) {
- ret = mms_flash_fw(fw_data, info, FORCED_UPDATE);
- if (!ret) {
- break;
- }
- }
- kfree(fw_data);
-
- if (!fw_read_flag || i == retries) {
- dev_err(&client->dev, "fail fw update\n");
- }
-
- ret = mms_config_get(info, info->cmd_param[0]);
- if (ret) {
- dev_err(&client->dev, "fail mms_config_get\n");
- mms_config_get(info, REQ_FW);
- }
- mms_config_set(info);
-
- get_fw_version_ic(client, ver);
- for (i=0 ; i < MAX_SECTION_NUM ; i++)
- info->fw_ic_ver[i] = ver[i];
-
- dev_info(&client->dev, "After FW update : [0x%02x]\n", ver[SEC_CONF]);
-
- enable_irq(info->irq);
-
- if (fw_read_flag && !ret) {
- snprintf(result, sizeof(result) , "%s", "OK");
- set_cmd_result(info, result, strnlen(result, sizeof(result)));
- info->cmd_state = OK;
- } else {
- snprintf(result, sizeof(result) , "%s", "NG");
- set_cmd_result(info, result, strnlen(result, sizeof(result)));
- info->cmd_state = FAIL;
- }
-
- return;
-
-not_support:
- snprintf(result, sizeof(result) , "%s", "NG");
- set_cmd_result(info, result, strnlen(result, sizeof(result)));
- info->cmd_state = FAIL;
- return;
-}
-
-static void get_fw_ver_bin(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
-
- set_default_result(info);
- snprintf(buff, sizeof(buff), "ME00%02x%02x",
- info->pdata->fw_bin_ver[SEC_CORE],
- info->pdata->fw_bin_ver[SEC_CONF]);
-
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
-}
-
-static void get_fw_ver_ic(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
-
- set_default_result(info);
-
- snprintf(buff, sizeof(buff), "ME00%02x%02x",
- info->fw_ic_ver[SEC_CORE], info->fw_ic_ver[SEC_CONF]);
-
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
-}
-
-static void get_config_ver(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[20] = {0};
- u8 config_flash_set[4];
- u8 config_ver;
- int ret;
-
- config_flash_set[0] = MMS_RUN_CONF_POINTER;
- config_flash_set[1] = 0; // COMMONCONF
- config_flash_set[2] = 8; // offset
- config_flash_set[3] = 1; // length
-
- ret = mms_config_flash(info, config_flash_set,4,"config-set-conf-ver");
- if (!ret)
- dev_err(&info->client->dev, "mms_config_flash fail!\n");
-
- config_flash_set[0] = MMS_GET_RUN_CONF;
- mms_read_config(info->client, config_flash_set, &config_ver, 1);
- dev_info(&info->client->dev, "Runtime config_ver [%02x]\n", config_ver);
-
- set_default_result(info);
-
- snprintf(buff, sizeof(buff), "%s", info->config_fw_version);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = 2;
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
-}
-
-static void get_threshold(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
- int threshold;
-
- set_default_result(info);
-
- threshold = i2c_smbus_read_byte_data(info->client, 0x05);
- if (threshold < 0) {
- snprintf(buff, sizeof(buff), "%s", "NG");
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = FAIL;
- return;
-}
- snprintf(buff, sizeof(buff), "%d", threshold);
-
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
-}
-
-static void module_off_master(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[3] = {0};
-
- mutex_lock(&info->lock);
- if (info->enabled) {
- disable_irq(info->irq);
- info->enabled = false;
- }
- mutex_unlock(&info->lock);
-
- if (mms_ts_power(info, 0) == SUCCESS_PWR_CONTROL)
- snprintf(buff, sizeof(buff), "%s", "OK");
- else
- snprintf(buff, sizeof(buff), "%s", "NG");
-
- set_default_result(info);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
-
- if (strncmp(buff, "OK", 2) == 0)
- info->cmd_state = OK;
- else
- info->cmd_state = FAIL;
-
- dev_info(&info->client->dev, "%s: %s\n", __func__, buff);
-}
-
-static void module_on_master(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[3] = {0};
-
- if (mms_ts_power(info, 1) == SUCCESS_PWR_CONTROL) {
- snprintf(buff, sizeof(buff), "%s", "OK");
-
- /* Set runtime config for B model */
- msleep(25);
- mms_config_set(info);
-
- mutex_lock(&info->lock);
- if (!info->enabled) {
- enable_irq(info->irq);
- info->enabled = true;
- }
- mutex_unlock(&info->lock);
- } else
- snprintf(buff, sizeof(buff), "%s", "NG");
-
- set_default_result(info);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
-
- if (strncmp(buff, "OK", 2) == 0)
- info->cmd_state = OK;
- else
- info->cmd_state = FAIL;
-
- dev_info(&info->client->dev, "%s: %s\n", __func__, buff);
-
-}
-
-static void module_off_slave(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- not_support_cmd(info);
-}
-
-static void module_on_slave(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- not_support_cmd(info);
-}
-
-static void get_chip_vendor(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
-
- set_default_result(info);
-
- snprintf(buff, sizeof(buff), "%s", info->pdata->tsp_vendor);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
-}
-
-static void get_chip_name(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
-
- set_default_result(info);
-
- snprintf(buff, sizeof(buff), "%s", info->pdata->tsp_ic);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
-}
-
-static void get_reference(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
- unsigned int val;
- int node;
-
- set_default_result(info);
- node = check_rx_tx_num(info);
-
- if (node < 0)
- return;
-
- val = info->reference[node];
- snprintf(buff, sizeof(buff), "%u", val);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
-
- info->cmd_state = OK;
-
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__,
- buff, strnlen(buff, sizeof(buff)));
-
-}
-
-static void get_cm_abs(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
- unsigned int val;
- int node;
-
- set_default_result(info);
- node = check_rx_tx_num(info);
-
- if (node < 0)
- return;
-
- val = info->cm_abs[node];
- snprintf(buff, sizeof(buff), "%u", val);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
-
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__, buff,
- strnlen(buff, sizeof(buff)));
-}
-
-static void get_cm_delta(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
- unsigned int val;
- int node;
-
- set_default_result(info);
- node = check_rx_tx_num(info);
-
- if (node < 0)
- return;
-
- val = info->cm_delta[node];
- snprintf(buff, sizeof(buff), "%u", val);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
-
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__, buff,
- strnlen(buff, sizeof(buff)));
-}
-
-static void get_intensity(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
- unsigned int val;
- int node;
-
- set_default_result(info);
- node = check_rx_tx_num(info);
-
- if (node < 0)
- return;
-#if 0
- for (i = 0 ; i < info->pdata->tsp_tx ; i++) {
- for (j = 0 ; j < info->pdata->tsp_rx ; j++) {
- printk(KERN_INFO "[%2d]",
- info->intensity[i*info->pdata->tsp_rx + j]);
- }
- printk("\n");
- }
-#endif
- val = info->intensity[node];
-
- snprintf(buff, sizeof(buff), "%u", val);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
-
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__, buff,
- strnlen(buff, sizeof(buff)));
-}
-
-static void get_x_num(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- char buff[16] = {0};
-
-#if 1
- if (info->enabled)
- dev_info(&info->client->dev, "%s = [%d] from ic\n", __func__,
- i2c_smbus_read_byte_data(info->client, 0xEF));
-#endif
- set_default_result(info);
-
- snprintf(buff, sizeof(buff), "%d", info->pdata->tsp_tx);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
-
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__, buff,
- strnlen(buff, sizeof(buff)));
-}
-
-static void get_y_num(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
- char buff[16] = {0};
-
-#if 1
- if (info->enabled)
- dev_info(&info->client->dev, "%s = [%d] from ic\n", __func__,
- i2c_smbus_read_byte_data(info->client, 0xEE));
-#endif
-
- set_default_result(info);
-
- snprintf(buff, sizeof(buff), "%d", info->pdata->tsp_rx);
- set_cmd_result(info, buff, strnlen(buff, sizeof(buff)));
- info->cmd_state = OK;
-
- dev_info(&info->client->dev, "%s: %s(%d)\n", __func__, buff,
- strnlen(buff, sizeof(buff)));
-}
-
-static void run_reference_read(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- set_default_result(info);
- get_raw_data(info, MMS_VSC_CMD_REFER);
- info->cmd_state = OK;
-
-/* dev_info(&info->client->dev, "%s: %s(%d)\n", __func__); */
-}
-
-static void run_cm_abs_read(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- set_default_result(info);
- get_raw_data(info, MMS_VSC_CMD_CM_ABS);
- info->cmd_state = OK;
-
-/* dev_info(&info->client->dev, "%s: %s(%d)\n", __func__); */
-}
-
-static void run_cm_delta_read(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- set_default_result(info);
- get_raw_data(info, MMS_VSC_CMD_CM_DELTA);
- info->cmd_state = OK;
-
-/* dev_info(&info->client->dev, "%s: %s(%d)\n", __func__); */
-}
-
-static void run_intensity_read(void *device_data)
-{
- struct mms_ts_info *info = (struct mms_ts_info *)device_data;
-
- set_default_result(info);
- get_intensity_data(info);
- info->cmd_state = OK;
-
-/* dev_info(&info->client->dev, "%s: %s(%d)\n", __func__); */
-}
-
-static ssize_t store_cmd(struct device *dev, struct device_attribute
- *devattr, const char *buf, size_t count)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
- struct i2c_client *client = info->client;
-
- char *cur, *start, *end;
- char buff[TSP_CMD_STR_LEN] = {0};
- int len, i;
- struct tsp_cmd *tsp_cmd_ptr = NULL;
- char delim = ',';
- bool cmd_found = false;
- int param_cnt = 0;
- int ret;
-
- if (info->cmd_is_running == true) {
- dev_err(&info->client->dev, "tsp_cmd: other cmd is running.\n");
- goto err_out;
- }
-
-
- /* check lock */
- mutex_lock(&info->cmd_lock);
- info->cmd_is_running = true;
- mutex_unlock(&info->cmd_lock);
-
- info->cmd_state = RUNNING;
-
- for (i = 0; i < ARRAY_SIZE(info->cmd_param); i++)
- info->cmd_param[i] = 0;
-
- len = (int)count;
- if (*(buf + len - 1) == '\n')
- len--;
- memset(info->cmd, 0x00, ARRAY_SIZE(info->cmd));
- memcpy(info->cmd, buf, len);
-
- cur = strchr(buf, (int)delim);
- if (cur)
- memcpy(buff, buf, cur - buf);
- else
- memcpy(buff, buf, len);
-
- /* find command */
- list_for_each_entry(tsp_cmd_ptr, &info->cmd_list_head, list) {
- if (!strcmp(buff, tsp_cmd_ptr->cmd_name)) {
- cmd_found = true;
- break;
- }
- }
-
- /* set not_support_cmd */
- if (!cmd_found) {
- list_for_each_entry(tsp_cmd_ptr, &info->cmd_list_head, list) {
- if (!strcmp("not_support_cmd", tsp_cmd_ptr->cmd_name))
- break;
- }
- }
-
- /* parsing parameters */
- if (cur && cmd_found) {
- cur++;
- start = cur;
- memset(buff, 0x00, ARRAY_SIZE(buff));
- do {
- if (*cur == delim || cur - buf == len) {
- end = cur;
- memcpy(buff, start, end - start);
- *(buff + strlen(buff)) = '\0';
- ret = kstrtoint(buff, 10,\
- info->cmd_param + param_cnt);
- start = cur + 1;
- memset(buff, 0x00, ARRAY_SIZE(buff));
- param_cnt++;
- }
- cur++;
- } while (cur - buf <= len);
- }
-
- dev_info(&client->dev, "cmd = %s\n", tsp_cmd_ptr->cmd_name);
- for (i = 0; i < param_cnt; i++)
- dev_info(&client->dev, "cmd param %d= %d\n", i,
- info->cmd_param[i]);
-
- tsp_cmd_ptr->cmd_func(info);
-
-
-err_out:
- return count;
-}
-
-static ssize_t show_cmd_status(struct device *dev,
- struct device_attribute *devattr, char *buf)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
- char buff[16] = {0};
-
- dev_info(&info->client->dev, "tsp cmd: status:%d\n",
- info->cmd_state);
-
- if (info->cmd_state == WAITING)
- snprintf(buff, sizeof(buff), "WAITING");
-
- else if (info->cmd_state == RUNNING)
- snprintf(buff, sizeof(buff), "RUNNING");
-
- else if (info->cmd_state == OK)
- snprintf(buff, sizeof(buff), "OK");
-
- else if (info->cmd_state == FAIL)
- snprintf(buff, sizeof(buff), "FAIL");
-
- else if (info->cmd_state == NOT_APPLICABLE)
- snprintf(buff, sizeof(buff), "NOT_APPLICABLE");
-
- return snprintf(buf, TSP_BUF_SIZE, "%s\n", buff);
-}
-
-static ssize_t show_cmd_result(struct device *dev, struct device_attribute
- *devattr, char *buf)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
-
- dev_info(&info->client->dev, "tsp cmd: result: %s\n", info->cmd_result);
-
- mutex_lock(&info->cmd_lock);
- info->cmd_is_running = false;
- mutex_unlock(&info->cmd_lock);
-
- info->cmd_state = WAITING;
-
- return snprintf(buf, TSP_BUF_SIZE, "%s\n", info->cmd_result);
-}
-
-#ifdef ESD_DEBUG
-
-static bool intensity_log_flag;
-
-static ssize_t show_intensity_logging_on(struct device *dev,
- struct device_attribute *devattr, char *buf)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
- struct i2c_client *client = info->client;
- struct file *fp;
- char log_data[160] = { 0, };
- char buff[16] = { 0, };
- mm_segment_t old_fs;
- long nwrite;
- u32 val;
- int i, y, c;
-
- old_fs = get_fs();
- set_fs(KERNEL_DS);
-
-#define MELFAS_DEBUG_LOG_PATH "/sdcard/melfas_log"
-
- dev_info(&client->dev, "%s: start.\n", __func__);
- fp = filp_open(MELFAS_DEBUG_LOG_PATH, O_RDWR | O_CREAT,
- S_IRWXU | S_IRWXG | S_IRWXO);
- if (IS_ERR(fp)) {
- dev_err(&client->dev, "%s: fail to open log file\n", __func__);
- set_fs(old_fs);
- return -1;
- }
-
- intensity_log_flag = 1;
- do {
- for (y = 0; y < 3; y++) {
- /* for tx chanel 0~2 */
- memset(log_data, 0x00, 160);
-
- snprintf(buff, 16, "%1u: ", y);
- strncat(log_data, buff, strnlen(buff, 16));
-
- for (i = 0; i < info->pdata->tsp_rx ; i++) {
- val = get_raw_data_one(info, i, y,
- MMS_VSC_CMD_INTENSITY);
- snprintf(buff, 16, "%5u, ", val);
- strncat(log_data, buff, strnlen(buff, 16));
- }
- memset(buff, '\n', 2);
- c = (y == 2) ? 2 : 1;
- strncat(log_data, buff, c);
- nwrite = vfs_write(fp, (const char __user *)log_data,
- strnlen(log_data, 160), &fp->f_pos);
- }
- usleep_range(5000);
- } while (intensity_log_flag);
+ dev_info(&info->client->dev, "%s\n", __func__);
- filp_close(fp, current->files);
- set_fs(old_fs);
-
- return 0;
-}
-
-static ssize_t show_intensity_logging_off(struct device *dev,
- struct device_attribute *devattr, char *buf)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
- intensity_log_flag = 0;
- usleep_range(10000);
- get_raw_data_all(info, MMS_VSC_CMD_EXIT);
- return 0;
-}
-
-#endif
-
-static DEVICE_ATTR(close_tsp_test, S_IRUGO, show_close_tsp_test, NULL);
-static DEVICE_ATTR(cmd, S_IWUSR | S_IWGRP, NULL, store_cmd);
-static DEVICE_ATTR(cmd_status, S_IRUGO, show_cmd_status, NULL);
-static DEVICE_ATTR(cmd_result, S_IRUGO, show_cmd_result, NULL);
-#ifdef ESD_DEBUG
-static DEVICE_ATTR(intensity_logging_on, S_IRUGO, show_intensity_logging_on,
- NULL);
-static DEVICE_ATTR(intensity_logging_off, S_IRUGO, show_intensity_logging_off,
- NULL);
-#endif
-
-static struct attribute *sec_touch_facotry_attributes[] = {
- &dev_attr_close_tsp_test.attr,
- &dev_attr_cmd.attr,
- &dev_attr_cmd_status.attr,
- &dev_attr_cmd_result.attr,
-#ifdef ESD_DEBUG
- &dev_attr_intensity_logging_on.attr,
- &dev_attr_intensity_logging_off.attr,
-#endif
- NULL,
-};
-
-static struct attribute_group sec_touch_factory_attr_group = {
- .attrs = sec_touch_facotry_attributes,
-};
-#endif /* SEC_TSP_FACTORY_TEST */
-
-#ifdef CONFIG_TIZEN_WIP
-static int mms_ts_suspend(struct device *dev);
-static int mms_ts_resume(struct device *dev);
-
-static ssize_t show_enabled(struct device *dev, struct device_attribute *attr,
- char *buf)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
- return sprintf(buf, "%d\n", info->enabled);
-}
-
-static ssize_t store_enabled(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t size)
-{
- struct mms_ts_info *info = dev_get_drvdata(dev);
- int enabled;
- int ret;
-
- ret = sscanf(buf, "%d", &enabled);
- if (ret == 0)
- return -EINVAL;
-
- if (enabled == info->enabled)
+ if (info->enabled) {
+ dev_info(&info->client->dev,
+ "%s already power on\n", __func__);
return 0;
-
- if (enabled) {
- info->enabled_user = false;
- mms_ts_resume(&info->client->dev);
- } else {
- mms_ts_suspend(&info->client->dev);
- info->enabled_user = true;
- }
-
- info->enabled = enabled;
-
- return size;
-}
-static DEVICE_ATTR(enabled, S_IRUGO | S_IWUSR, show_enabled, store_enabled);
-
-static struct attribute *mms_ts_attributes[] = {
- &dev_attr_enabled.attr,
- NULL,
-};
-
-static struct attribute_group mms_ts_attr_group = {
- .attrs = mms_ts_attributes,
-};
-#endif
-
-#ifdef CONFIG_OF
-static struct melfas_tsi_platform_data *mms_ts_parse_dt(struct device *dev)
-{
- struct melfas_tsi_platform_data *pdata;
- struct device_node *np = dev->of_node;
-
- if (!np)
- return NULL;
-
- pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
- if (!pdata) {
- dev_err(dev, "failed to allocate platform data\n");
- return NULL;
- }
-
- if (of_property_read_u32(np, "max_x", &pdata->max_x)) {
- dev_err(dev, "failed to get max_x property\n");
- return NULL;
- };
-
- if (of_property_read_u32(np, "max_y", &pdata->max_y)) {
- dev_err(dev, "failed to get max_y property\n");
- return NULL;
- };
-
- if (of_property_read_u32(np, "invert_x", &pdata->invert_x)) {
- dev_err(dev, "failed to get invert_x property\n");
- return NULL;
- };
- pdata->invert_x = !!pdata->invert_x;
-
- if (of_property_read_u32(np, "invert_y", &pdata->invert_y)) {
- dev_err(dev, "failed to get invert_y property\n");
- return NULL;
- };
- pdata->invert_y = !!pdata->invert_y;
-
- pdata->gpio_int = of_get_named_gpio(np, "gpios", 0);
- if (!gpio_is_valid(pdata->gpio_int)) {
- dev_err(dev, "invalied gpio_int\n");
- return NULL;
- }
-
- pdata->gpio_scl = of_get_named_gpio(np, "gpios", 1);
- if (!gpio_is_valid(pdata->gpio_scl)) {
- dev_err(dev, "invalied gpio_scl\n");
- return NULL;
- }
-
- pdata->gpio_sda = of_get_named_gpio(np, "gpios", 2);
- if (!gpio_is_valid(pdata->gpio_sda)) {
- dev_err(dev, "invalied gpio_sda\n");
- return NULL;
}
- if (of_property_read_string(np, "tsp_vendor", &pdata->tsp_vendor))
- dev_warn(dev, "cannot get touchscreen vendor name\n");
-
- if (of_property_read_string(np, "tsp_ic", &pdata->tsp_ic))
- dev_warn(dev, "cannot get touchscreen IC data\n");
-
- if (of_property_read_u32(np, "tsp_tx", &pdata->tsp_tx)) {
- dev_err(dev, "failed to get invert_y property\n");
- return NULL;
- };
- if (of_property_read_u32(np, "tsp_rx", &pdata->tsp_rx)) {
- dev_err(dev, "failed to get invert_y property\n");
- return NULL;
- };
-
- if (of_property_read_string(np, "config_fw_version",
- &pdata->config_fw_version))
- dev_warn(dev, "cannot get touchscreen firmware version\n");
-
- pdata->register_cb = NULL;
+ info->resume_done = false;
+ mms_ts_power(info, true);
+ info->enabled = true;
+ schedule_delayed_work(&info->work_config_set,
+ msecs_to_jiffies(10));
- return pdata;
-}
-#else
-static inline struct melfas_tsi_platform_data *mms_ts_parse_dt(struct device *dev)
-{
- return NULL;
+ return 0;
}
-#endif
-
-static int mms128_pm_notifier_callback(struct notifier_block *this,
- unsigned long event, void *ptr)
+static void mms_ts_stop_device(struct mms_ts_info *info)
{
- struct mms_ts_info *info = container_of(this, struct mms_ts_info,
- pm_notifier);
-
- switch (event) {
- case PM_SUSPEND_PREPARE:
- info->suspended = true;
- break;
- case PM_POST_RESTORE:
- case PM_POST_SUSPEND:
- info->suspended = false;
- break;
- }
+ disable_irq(info->irq);
+ release_all_fingers(info);
+ mms_ts_power(info, false);
- return NOTIFY_DONE;
+ return;
}
-static int mms_request_firmware(struct mms_ts_info *info)
+static void mms_ts_input_close(struct input_dev *dev)
{
- struct i2c_client *client = info->client;
- const struct firmware *fw, *fw_config;
- char fw_path[MAX_FW_PATH + 1];
- int ret = 0;
-
- /* firmware */
- snprintf(fw_path, MAX_FW_PATH, "%s%s", TSP_FW_DIRECTORY, TSP_FW_NAME);
- ret = request_firmware(&fw, fw_path, &client->dev);
- if (ret) {
- dev_err(&client->dev,
- "Failed to request firmware (%s)\n", fw_path);
- return -EINVAL;
- }
+ struct mms_ts_info *info = input_get_drvdata(dev);
+ int retries = 50;
- info->fw_data = kzalloc(fw->size, GFP_KERNEL);
- if (!info->fw_data) {
- dev_err(&client->dev,
- "Faild to allocate firmware memory (%s)\n", fw_path);
- goto err_fw;
- }
- memcpy(info->fw_data, fw->data, fw->size);
+ dev_info(&info->client->dev, "%s\n", __func__);
- /* configuration firmware */
- snprintf(fw_path, MAX_FW_PATH, "%s%s", TSP_FW_DIRECTORY, TSP_FW_CONFIG_NAME);
- ret = request_firmware(&fw_config, fw_path, &client->dev);
- if (ret) {
- dev_err(&client->dev,
- "Failed to request firmware (%s)\n", fw_path);
- goto err_fw_alloc;
+ if (!info->enabled){
+ dev_info(&info->client->dev,
+ "%s already power off\n", __func__);
+ return;
}
+ info->enabled = false;
- info->config_fw = kzalloc(fw_config->size, GFP_KERNEL);
- if (!info->config_fw) {
- dev_err(&client->dev,
- "Faild to allocate firmware memory (%s)\n", fw_path);
- goto err_fw_config;
+ while (!info->resume_done) {
+ if (!retries--)
+ break;
+ msleep(100);
+ dev_info(&info->client->dev, "%s:"
+ " waiting for resume done.[%d]\n", __func__, retries);
}
- memcpy(info->config_fw, fw_config->data, fw_config->size);
-
- release_firmware(fw_config);
- release_firmware(fw);
- return 0;
-err_fw_config:
- release_firmware(fw_config);
-err_fw_alloc:
- kfree(info->fw_data);
-err_fw:
- release_firmware(fw);
+ mms_ts_stop_device(info);
- return ret;
+ dev_info(&info->client->dev, "%s: close done.\n", __func__);
+ return;
}
static int mms_ts_probe(struct i2c_client *client,
int ret = 0;
int i;
-#if SEC_TSP_FACTORY_TEST
- struct device *fac_dev_ts;
- int rx_num;
- int tx_num;
-#endif
if (!i2c_check_functionality(adapter, I2C_FUNC_I2C))
return -EIO;
info->enabled = true;
info->resume_done= true;
-#ifdef CONFIG_SEC_FACTORY_MODE
- msleep(200);
- if (tsp_connector_check(info) == 0) {
- goto err_tsp_connect;
- }
-#endif
-
snprintf(info->phys, sizeof(info->phys),
"%s/input0", dev_name(&client->dev));
input_dev->name = "sec_touchscreen"; /*= "Melfas MMSxxx Touchscreen";*/
input_dev->phys = info->phys;
input_dev->id.bustype = BUS_I2C;
input_dev->dev.parent = &client->dev;
+ input_dev->open = mms_ts_input_open;
+ input_dev->close = mms_ts_input_close;
__set_bit(EV_ABS, input_dev->evbit);
__set_bit(EV_KEY, input_dev->evbit);
INIT_DELAYED_WORK(&info->work_config_set, work_mms_config_set);
-#if TOUCH_BOOSTER
- mutex_init(&info->dvfs_lock);
- INIT_DELAYED_WORK(&info->work_dvfs_off, set_dvfs_off);
- INIT_DELAYED_WORK(&info->work_dvfs_chg, change_dvfs_lock);
- info->bus_dev = dev_get("exynos-busfreq");
- info->sec_touchscreen = dev_get("sec_touchscreen");
- info->cpufreq_level = -1;
- info->dvfs_lock_status = false;
-#endif
-
-#ifdef CONFIG_HAS_EARLYSUSPEND
- info->early_suspend.level = EARLY_SUSPEND_LEVEL_STOP_DRAWING;
- info->early_suspend.suspend = mms_ts_early_suspend;
- info->early_suspend.resume = mms_ts_late_resume;
- register_early_suspend(&info->early_suspend);
-#endif
-
info->callbacks.inform_charger = melfas_ta_cb;
if (info->register_cb)
info->register_cb(&info->callbacks);
goto err_regulator;
}
#endif
+ disable_irq(info->irq);
+ info->enabled = false;
+ mms_ts_power(info, false);
dev_info(&client->dev,
"Melfas MMS-series touch controller initialized\n");
-#if SEC_TSP_FACTORY_TEST
- rx_num = info->pdata->tsp_rx;
- tx_num = info->pdata->tsp_tx;
-
- info->reference = kzalloc(sizeof(int) * rx_num * tx_num, GFP_KERNEL);
- info->cm_abs = kzalloc(sizeof(int) * rx_num * tx_num, GFP_KERNEL);
- info->cm_delta = kzalloc(sizeof(int) * rx_num * tx_num, GFP_KERNEL);
- info->intensity = kzalloc(sizeof(int) * rx_num * tx_num, GFP_KERNEL);
- if (unlikely(info->reference == NULL ||
- info->cm_abs == NULL ||
- info->cm_delta == NULL ||
- info->intensity == NULL)) {
- ret = -ENOMEM;
- goto err_alloc_node_data_failed;
- }
-
-
- INIT_LIST_HEAD(&info->cmd_list_head);
- for (i = 0; i < ARRAY_SIZE(tsp_cmds); i++)
- list_add_tail(&tsp_cmds[i].list, &info->cmd_list_head);
-
- mutex_init(&info->cmd_lock);
- info->cmd_is_running = false;
-
- fac_dev_ts = device_create(sec_class,
- NULL, 0, info, "tsp");
- if (IS_ERR(fac_dev_ts))
- dev_err(&client->dev, "Failed to create device for the sysfs\n");
-
- ret = sysfs_create_group(&fac_dev_ts->kobj,
- &sec_touch_factory_attr_group);
- if (ret)
- dev_err(&client->dev, "Failed to create sysfs group\n");
-#endif /* SEC_TSP_FACTORY_TEST */
return 0;
-#if SEC_TSP_FACTORY_TEST
-err_alloc_node_data_failed:
- dev_err(&client->dev, "Err_alloc_node_data failed\n");
- kfree(info->reference);
- kfree(info->cm_abs);
- kfree(info->cm_delta);
- kfree(info->intensity);
-#endif
err_regulator:
regulator_put(info->regulator_pwr);
regulator_put(info->regulator_vdd);
err_reg_input_dev:
input_unregister_device(input_dev);
-#ifdef CONFIG_SEC_FACTORY_MODE
-err_tsp_connect:
-#endif
err_fw_init:
mms_ts_power(info, false);
err_input_alloc:
kfree(info->config_fw);
}
-#if SEC_TSP_FACTORY_TEST
- dev_err(&client->dev, "Err_alloc_node_data failed\n");
- kfree(info->reference);
- kfree(info->cm_abs);
- kfree(info->cm_delta);
- kfree(info->intensity);
-#endif
-
-#ifdef CONFIG_HAS_EARLYSUSPEND
- unregister_early_suspend(&info->early_suspend);
-#endif
if (info->irq >= 0)
free_irq(info->irq, info);
input_unregister_device(info->input_dev);
return 0;
}
-#if defined(CONFIG_PM) || defined(CONFIG_HAS_EARLYSUSPEND)
static int mms_ts_suspend(struct device *dev)
{
struct i2c_client *client = to_i2c_client(dev);
return 0;
}
-#endif
-
-#ifdef CONFIG_HAS_EARLYSUSPEND
-static void mms_ts_early_suspend(struct early_suspend *h)
-{
- struct mms_ts_info *info;
- info = container_of(h, struct mms_ts_info, early_suspend);
- mms_ts_suspend(&info->client->dev);
-
-}
-static void mms_ts_late_resume(struct early_suspend *h)
-{
- struct mms_ts_info *info;
- info = container_of(h, struct mms_ts_info, early_suspend);
- mms_ts_resume(&info->client->dev);
-}
-#endif
-
-#if defined(CONFIG_PM) && !defined(CONFIG_HAS_EARLYSUSPEND)
-static const struct dev_pm_ops mms_ts_pm_ops = {
- .suspend = mms_ts_suspend,
- .resume = mms_ts_resume,
-};
-#endif
+static SIMPLE_DEV_PM_OPS(mms_ts_pm_ops, mms_ts_suspend, mms_ts_resume);
#ifdef CONFIG_OF
static struct of_device_id mms128_dt_match[] = {
.remove = mms_ts_remove,
.driver = {
.name = MELFAS_TS_NAME,
-#if defined(CONFIG_PM) && !defined(CONFIG_HAS_EARLYSUSPEND)
.pm = &mms_ts_pm_ops,
-#endif
.of_match_table = of_match_ptr(mms128_dt_match),
},
.id_table = mms_ts_id,
};
-static int __init mms_ts_init(void)
-{
-
- return i2c_add_driver(&mms_ts_driver);
-
-}
-
-static void __exit mms_ts_exit(void)
-{
- i2c_del_driver(&mms_ts_driver);
-}
-
-module_init(mms_ts_init);
-module_exit(mms_ts_exit);
+module_i2c_driver(mms_ts_driver);
/* Module information */
MODULE_DESCRIPTION("Touchscreen driver for Melfas MMS-series controllers");
projects / platform / kernel / linux-3.10.git / commitdiff