diff options
Diffstat (limited to 'drivers/input/touchscreen/mxt1664s.c')
| -rw-r--r-- | drivers/input/touchscreen/mxt1664s.c | 1808 |
1 files changed, 0 insertions, 1808 deletions
diff --git a/drivers/input/touchscreen/mxt1664s.c b/drivers/input/touchscreen/mxt1664s.c deleted file mode 100644 index cce3717..0000000 --- a/drivers/input/touchscreen/mxt1664s.c +++ /dev/null @@ -1,1808 +0,0 @@ -/* - * Copyright (C) 2012, Samsung Electronics Co. Ltd. All Rights Reserved. - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - */ - -#include <linux/kernel.h> -#include <linux/module.h> -#include <linux/input.h> -#include <linux/input/mt.h> -#include <linux/interrupt.h> -#include <linux/i2c.h> -#include <linux/delay.h> -#include <linux/slab.h> -#include <linux/gpio.h> -#include <linux/i2c/mxt1664s.h> -#include <asm/unaligned.h> -#include <linux/firmware.h> -#include <linux/string.h> -#ifdef CONFIG_HAS_EARLYSUSPEND -#include <linux/earlysuspend.h> -#endif - -#include "mxt1664s_dev.h" - -int mxt_read_mem(struct mxt_data *data, u16 reg, u8 len, u8 *buf) -{ - int ret = 0, i = 0; - u16 le_reg = cpu_to_le16(reg); - struct i2c_msg msg[2] = { - { - .addr = data->client->addr, - .flags = 0, - .len = 2, - .buf = (u8 *)&le_reg, - }, - { - .addr = data->client->addr, - .flags = I2C_M_RD, - .len = len, - .buf = buf, - }, - }; - - if (!data->mxt_enabled) { - dev_err(&data->client->dev, - "%s tsp ic is not ready\n", __func__); - return -EBUSY; - } - - for (i = 0; i < 3 ; i++) { - ret = i2c_transfer(data->client->adapter, msg, 2); - if (ret < 0) { - dev_err(&data->client->dev, "%s fail[%d] address[0x%x]\n", - __func__, ret, le_reg); - data->pdata->power_reset(); - } else - break; - } - - return ret == 2 ? 0 : -EIO; -} - -int mxt_write_mem(struct mxt_data *data, - u16 reg, u8 len, const u8 *buf) -{ - int ret = 0, i = 0; - u8 tmp[len + 2]; - - if (!data->mxt_enabled) { - dev_err(&data->client->dev, - "%s tsp ic is not ready\n", __func__); - return -EBUSY; - } - - put_unaligned_le16(cpu_to_le16(reg), tmp); - memcpy(tmp + 2, buf, len); - - for (i = 0; i < 3 ; i++) { - ret = i2c_master_send(data->client, tmp, sizeof(tmp)); - if (ret < 0) { - dev_err(&data->client->dev, - "%s %d times write error on address[0x%x,0x%x]\n", - __func__, i, tmp[1], tmp[0]); - data->pdata->power_reset(); - } else - break; - } - - return ret == sizeof(tmp) ? 0 : -EIO; -} - -struct mxt_object * - mxt_get_object_info(struct mxt_data *data, u8 object_type) -{ - struct mxt_object *object; - int i; - - for (i = 0; i < data->info.object_num; i++) { - object = data->objects + i; - if (object->object_type == object_type) - return object; - } - - dev_err(&data->client->dev, "Invalid object type T%d\n", - object_type); - - return NULL; -} - -int mxt_read_object(struct mxt_data *data, - u8 type, u8 offset, u8 *val) -{ - struct mxt_object *object; - u16 reg; - - object = mxt_get_object_info(data, type); - if (!object) - return -EINVAL; - - reg = object->start_address; - - return mxt_read_mem(data, reg + offset, 1, val); -} - -int mxt_write_object(struct mxt_data *data, - u8 type, u8 offset, u8 val) -{ - struct mxt_object *object; - u16 reg; - - object = mxt_get_object_info(data, type); - if (!object) - return -EINVAL; - - if (offset >= object->size * object->instances) { - dev_err(&data->client->dev, "Tried to write outside object T%d" - " offset:%d, size:%d\n", type, offset, object->size); - return -EINVAL; - } - reg = object->start_address; - return mxt_write_mem(data, reg + offset, 1, &val); -} - -static int mxt_reset(struct mxt_data *data) -{ - u8 buf = 1u; - return mxt_write_mem(data, data->cmd_proc + CMD_RESET_OFFSET, 1, &buf); -} - -static int mxt_backup(struct mxt_data *data) -{ - u8 buf = 0x55u; - return mxt_write_mem(data, data->cmd_proc + CMD_BACKUP_OFFSET, 1, &buf); -} - -static void mxt_start(struct mxt_data *data) -{ - /* Touch report enable */ - mxt_write_object(data, - TOUCH_MULTITOUCHSCREEN_T9, 0, - data->tsp_ctl); -} - -static void mxt_stop(struct mxt_data *data) -{ - /* Touch report disable */ - mxt_write_object(data, - TOUCH_MULTITOUCHSCREEN_T9, 0, 0); -} - -static int mxt_check_instance(struct mxt_data *data, u8 object_type) -{ - int i; - - for (i = 0; i < data->info.object_num; i++) { - if (data->objects[i].object_type == object_type) - return data->objects[i].instances; - } - return 0; -} - -static int mxt_init_write_config(struct mxt_data *data, - u8 type, const u8 *cfg) -{ - struct mxt_object *object; - u8 *temp; - int ret; - - object = mxt_get_object_info(data, type); - if (!object) - return -EINVAL; - - if ((object->size == 0) || (object->start_address == 0)) { - dev_err(&data->client->dev, - "%s error object_type T%d\n", __func__, type); - return -ENODEV; - } - - ret = mxt_write_mem(data, object->start_address, - object->size, cfg); - if (ret) { - dev_err(&data->client->dev, - "%s write error T%d address[0x%x]\n", - __func__, type, object->start_address); - return ret; - } - - if (mxt_check_instance(data, type)) { - temp = kzalloc(object->size, GFP_KERNEL); - - if (temp == NULL) - return -ENOMEM; - - ret |= mxt_write_mem(data, object->start_address + object->size, - object->size, temp); - kfree(temp); - } - - return ret; -} - -static u32 crc24(u32 crc, u8 byte1, u8 byte2) -{ - static const u32 crcpoly = 0x80001B; - u32 res; - u16 data_word; - - data_word = (((u16)byte2) << 8) | byte1; - res = (crc << 1) ^ (u32)data_word; - - if (res & 0x1000000) - res ^= crcpoly; - - return res; -} - -static int mxt_calculate_infoblock_crc(struct mxt_data *data, - u32 *crc_pointer) -{ - u32 crc = 0; - u8 mem[7 + data->info.object_num * 6]; - int status; - int i; - - status = mxt_read_mem(data, 0, sizeof(mem), mem); - - if (status) - return status; - - for (i = 0; i < sizeof(mem) - 1; i += 2) - crc = crc24(crc, mem[i], mem[i + 1]); - - *crc_pointer = crc24(crc, mem[i], 0) & 0x00FFFFFF; - - return 0; -} - -static int mxt_get_id_info(struct mxt_data *data) -{ - int ret = 0; - u8 id[ID_BLOCK_SIZE]; - - /* Read IC information */ - ret = mxt_read_mem(data, 0, sizeof(id), id); - if (ret) { - dev_err(&data->client->dev, "Read fail. IC information\n"); - goto out; - } else { - dev_info(&data->client->dev, - "family: 0x%x variant: 0x%x version: 0x%x" - " build: 0x%x matrix X,Y size: %d,%d" - " number of obect: %d\n" - , id[0], id[1], id[2], id[3], id[4], id[5], id[6]); - data->info.family_id = id[0]; - data->info.variant_id = id[1]; - data->info.version = id[2]; - data->info.build = id[3]; - data->info.matrix_xsize = id[4]; - data->info.matrix_ysize = id[5]; - data->info.object_num = id[6]; - } - -out: - return ret; -} - -static int mxt_get_object_table(struct mxt_data *data) -{ - int ret = 0; - int i; - u8 type_count = 0; - - ret = mxt_read_mem(data, OBJECT_TABLE_START_ADDRESS, - data->info.object_num * sizeof(*data->objects), - (u8 *)data->objects); - - if (ret) - goto out; - - data->max_report_id = 0; - - for (i = 0; i < data->info.object_num; i++) { - data->objects[i].start_address = - le16_to_cpu(data->objects[i].start_address); - /* size and instance values are smaller than atual value */ - data->objects[i].size += 1; - data->objects[i].instances += 1; - data->max_report_id += data->objects[i].num_report_ids * - (data->objects[i].instances); - - switch (data->objects[i].object_type) { - case GEN_MESSAGEPROCESSOR_T5: - data->msg_object_size = data->objects[i].size; - data->msg_proc = data->objects[i].start_address; - dev_dbg(&data->client->dev, "mesage object size: %d" - " message address: 0x%x\n", - data->msg_object_size, data->msg_proc); - break; - case GEN_COMMANDPROCESSOR_T6: - data->cmd_proc = data->objects[i].start_address; - break; - case TOUCH_MULTITOUCHSCREEN_T9: - data->finger_report_id = type_count + 1; - dev_dbg(&data->client->dev, "Finger report id: %d\n", - data->finger_report_id); - break; - } - - if (data->objects[i].num_report_ids) { - type_count += data->objects[i].num_report_ids * - (data->objects[i].instances); - } - } - - dev_info(&data->client->dev, "maXTouch: %d Objects\n", - data->info.object_num); -#if TSP_DEBUG_INFO - for (i = 0; i < data->info.object_num; i++) { - dev_info(&data->client->dev, "Object:T%d\t\t\t" - "Address:0x%x\tSize:%d\tInstance:%d\tReport Id's:%d\n", - data->objects[i].object_type, - data->objects[i].start_address, - data->objects[i].size, - data->objects[i].instances, - data->objects[i].num_report_ids); - } -#endif - -out: - return ret; -} - -static void __devinit mxt_make_reportid_table(struct mxt_data *data) -{ - struct mxt_object *objects = data->objects; - int i, j; - int cur_id, sta_id; - - data->rid_map[0].instance = 0; - data->rid_map[0].object_type = 0; - cur_id = 1; - - for (i = 0; i < data->info.object_num; i++) { - if (objects[i].num_report_ids == 0) - continue; - for (j = 1; j <= objects[i].instances; j++) { - for (sta_id = cur_id; - cur_id < (sta_id + objects[i].num_report_ids); - cur_id++) { - - data->rid_map[cur_id].instance = j; - data->rid_map[cur_id].object_type = - objects[i].object_type; - } - } - } - - dev_info(&data->client->dev, "maXTouch: %d report ID\n", - data->max_report_id); - -#if TSP_DEBUG_INFO - for (i = 0; i < data->max_report_id; i++) { - dev_info(&data->client->dev, "Report_id[%d]:\tT%d\n", - i, data->rid_map[i].object_type); - } -#endif -} - -static int mxt_write_configuration(struct mxt_data *data) -{ - int i = 0, ret = 0; - u8 ** tsp_config = (u8 **)data->pdata->config; - - - for (i = 0; tsp_config[i][0] != RESERVED_T255; i++) { - ret = mxt_init_write_config(data, tsp_config[i][0], - tsp_config[i] + 1); - if (ret) - goto out; - - if (tsp_config[i][0] == TOUCH_MULTITOUCHSCREEN_T9) { - data->tsp_ctl = tsp_config[i][1]; - data->x_num = tsp_config[i][4]; - data->y_num = tsp_config[i][5]; - /* Are x and y inverted? */ - if (tsp_config[i][10] & 0x1) { - data->x_dropbits = - (!(tsp_config[i][22] & 0xC)) << 1; - data->y_dropbits = - (!(tsp_config[i][20] & 0xC)) << 1; - } else { - data->x_dropbits = - (!(tsp_config[i][20] & 0xC)) << 1; - data->y_dropbits = - (!(tsp_config[i][22] & 0xC)) << 1; - } - } - } - -out: - return ret; -} - -static int mxt_reportid_to_type(struct mxt_data *data, - u8 report_id, u8 *instance) -{ - if (report_id <= data->max_report_id) { - *instance = data->rid_map[report_id].instance; - return data->rid_map[report_id].object_type; - } else - return 0; -} - -static int mxt_calibrate_chip(struct mxt_data *data) -{ - u8 cal_data = 1; - int ret = 0; - /* send calibration command to the chip */ - ret = mxt_write_mem(data, - data->cmd_proc + CMD_CALIBRATE_OFFSET, - 1, &cal_data); - if (!ret) - dev_info(&data->client->dev, "sucess sending calibration cmd!!!\n"); - return ret; -} - -#if TSP_INFORM_CHARGER -static bool check_acq_int(struct mxt_data *data, u8 *buf) -{ - bool int_conf = false; - - if ((!data->charging_mode) && - (GEN_POWERCONFIG_T7 == buf[0])) { - switch (buf[1]) { - case MXT_T7_IDLE_ACQ_INT: - case MXT_T7_ACT_ACQ_INT: - int_conf = true; - break; - default: - break; - } - } - - return int_conf; -} - -static void set_charger_config(struct mxt_data *data, - int mode) -{ - u8 *buf = data->charger_inform_buf; - int i = 1; - - while (data->charger_inform_buf_size > i + 3) { - u8 *tmp = &buf[i]; - int ret = 0; - if (mode == check_acq_int(data, tmp)) { - u8 type = buf[i]; - u8 offset = buf[i + 1]; - u8 val = buf[i + 2 + data->charging_mode]; - - ret = mxt_write_object(data, type, offset, val); - if (ret < 0) { - dev_err(&data->client->dev, - "%s : failed to write i2c %d %d %d\n", - __func__, type, offset, val); - return ; - } - if (data->debug_log) - dev_info(&data->client->dev, - "%s : %d %d %d\n", - __func__, type, offset, val); - } - i += 4; - } - -} - -static void inform_charger(struct mxt_callbacks *cb, - bool en) -{ - struct mxt_data *data = container_of(cb, - struct mxt_data, callbacks); - - cancel_delayed_work_sync(&data->noti_dwork); - cancel_delayed_work_sync(&data->acq_int_dwork); - data->charging_mode = en; - schedule_delayed_work(&data->noti_dwork, HZ / 5); -} - -static void charger_noti_dwork(struct work_struct *work) -{ - struct mxt_data *data = - container_of(work, struct mxt_data, - noti_dwork.work); - - if (!data->mxt_enabled) { - schedule_delayed_work(&data->noti_dwork, HZ / 5); - return ; - } - - dev_info(&data->client->dev, - "%s mode\n", - data->charging_mode ? "charging" : "battery"); - - set_charger_config(data, 0); - - if (!data->charging_mode) - schedule_delayed_work(&data->acq_int_dwork, HZ * 3); -} - -static void switch_acq_int_dwork(struct work_struct *work) -{ - struct mxt_data *data = - container_of(work, struct mxt_data, - acq_int_dwork.work); - - set_charger_config(data, 1); -} - -static void inform_charger_init(struct mxt_data *data, u8 *buf) -{ - data->charger_inform_buf_size = buf[0]; - data->charger_inform_buf = kzalloc(buf[0], GFP_KERNEL); - memcpy(data->charger_inform_buf, buf, buf[0]); - INIT_DELAYED_WORK(&data->noti_dwork, charger_noti_dwork); - INIT_DELAYED_WORK(&data->acq_int_dwork, switch_acq_int_dwork); -} -#endif - - -#if CHECK_ANTITOUCH -void mxt_t61_timer_set(struct mxt_data *data, u8 mode, u8 cmd, u16 ms_period) -{ - struct mxt_object *object; - int ret = 0; - u8 buf[5] = {3, 0, 0, 0, 0}; - - object = mxt_get_object_info(data, SPT_TIMER_T61); - - buf[1] = cmd; - buf[2] = mode; - buf[3] = ms_period & 0xFF; - buf[4] = (ms_period >> 8) & 0xFF; - - ret = mxt_write_mem(data, object->start_address, 5, buf); - if (ret) - dev_err(&data->client->dev, - "%s write error T%d address[0x%x]\n", - __func__, SPT_TIMER_T61, object->start_address); - - if (ms_period) - dev_info(&data->client->dev, - "T61 Timer Enabled %d\n", ms_period); -} - -void mxt_t8_autocal_set(struct mxt_data *data, u8 mstime) -{ - struct mxt_object *object; - int ret = 0; - - if (mstime) { - data->check_autocal = 1; - if (data->debug_log) - dev_info(&data->client->dev, - "T8 Autocal Enabled %d\n", mstime); - } else { - data->check_autocal = 0; - if (data->debug_log) - dev_info(&data->client->dev, - "T8 Autocal Disabled %d\n", mstime); - } - - object = mxt_get_object_info(data, - GEN_ACQUISITIONCONFIG_T8); - - ret = mxt_write_mem(data, - object->start_address + 4, - 1, &mstime); - if (ret) - dev_err(&data->client->dev, - "%s write error T%d address[0x%x]\n", - __func__, SPT_TIMER_T61, object->start_address); -} - -static void mxt_check_coordinate(struct mxt_data *data, - bool detect, u8 id, u16 *px, u16 *py) -{ - static int tcount[] = {0, }; - static u16 pre_x[][4] = {{0}, }; - static u16 pre_y[][4] = {{0}, }; - int distance = 0; - - if (detect) - tcount[id] = 0; - - if (tcount[id] > 1) { - distance = abs(pre_x[id][0] - *px) + abs(pre_y[id][0] - *py); - if (data->debug_log) - dev_info(&data->client->dev, - "Check Distance ID:%d, %d\n", - id, distance); - - /* AutoCal Disable */ - if (distance > 3) - mxt_t8_autocal_set(data, 0); - } - - pre_x[id][0] = *px; - pre_y[id][0] = *py; - - tcount[id]++; -} -#endif /* CHECK_ANTITOUCH */ - -static void mxt_report_input_data(struct mxt_data *data) -{ - int i; - int count = 0; - int report_count = 0; - - for (i = 0; i < data->num_fingers; i++) { - if (data->fingers[i].state == MXT_STATE_INACTIVE) - continue; - - if (data->fingers[i].state == MXT_STATE_RELEASE) { - input_mt_slot(data->input_dev, i); - input_mt_report_slot_state(data->input_dev, - MT_TOOL_FINGER, false); - } else { - input_mt_slot(data->input_dev, i); - input_mt_report_slot_state(data->input_dev, - MT_TOOL_FINGER, true); - input_report_abs(data->input_dev, ABS_MT_POSITION_X, - data->fingers[i].x); - input_report_abs(data->input_dev, ABS_MT_POSITION_Y, - data->fingers[i].y); - input_report_abs(data->input_dev, ABS_MT_TOUCH_MAJOR, - data->fingers[i].w); - input_report_abs(data->input_dev, ABS_MT_PRESSURE, - data->fingers[i].z); -#if TSP_USE_SHAPETOUCH - input_report_abs(data->input_dev, ABS_MT_COMPONENT, - data->fingers[i].component); - input_report_abs(data->input_dev, ABS_MT_SUMSIZE, - data->sumsize); -#endif - } - report_count++; - -#if TSP_DEBUG_INFO - if (data->fingers[i].state == MXT_STATE_PRESS) - dev_info(&data->client->dev, "P: id[%d] X[%d],Y[%d]" - " comp[%d], sum[%d] size[%d], pressure[%d]\n", - i, data->fingers[i].x, data->fingers[i].y, - data->fingers[i].component, data->sumsize, - data->fingers[i].w, data->fingers[i].z); -#else - if (data->fingers[i].state == MXT_STATE_PRESS) - dev_info(&data->client->dev, "P: id[%d]\n", i); -#endif - else if (data->fingers[i].state == MXT_STATE_RELEASE) - dev_info(&data->client->dev, "R: id[%d] M[%d]\n", - i, data->fingers[i].mcount); - - if (data->fingers[i].state == MXT_STATE_RELEASE) { - data->fingers[i].state = MXT_STATE_INACTIVE; - data->fingers[i].mcount = 0; - } else { - data->fingers[i].state = MXT_STATE_MOVE; - count++; - } - } - - if (report_count > 0) { -#if TSP_ITDEV - if (!data->driver_paused) -#endif - input_sync(data->input_dev); - } - -#if (TSP_USE_SHAPETOUCH || TSP_BOOSTER) - /* all fingers are released */ - if (count == 0) { -#if TSP_USE_SHAPETOUCH - data->sumsize = 0; -#endif -#if TSP_BOOSTER - mxt_set_dvfs_on(data, false); -#endif - } -#endif - - data->finger_mask = 0; -} - -static void mxt_treat_T6_object(struct mxt_data *data, u8 *msg) -{ - /* normal mode */ - if (msg[1] == 0x00) - dev_info(&data->client->dev, "normal mode\n"); - /* I2C checksum error */ - if (msg[1] & 0x04) - dev_err(&data->client->dev, "I2C checksum error\n"); - /* config error */ - if (msg[1] & 0x08) - dev_err(&data->client->dev, "config error\n"); - /* calibration */ - if (msg[1] & 0x10) { - dev_info(&data->client->dev, "calibration is on going !!\n"); -#if CHECK_ANTITOUCH - /* After Calibration */ - data->check_antitouch = 1; - mxt_t61_timer_set(data, - MXT_T61_TIMER_ONESHOT, - MXT_T61_TIMER_CMD_STOP, 0); - data->check_timer = 0; - data->check_calgood = 0; -#endif - } - /* signal error */ - if (msg[1] & 0x20) - dev_err(&data->client->dev, "signal error\n"); - /* overflow */ - if (msg[1] & 0x40) { - dev_err(&data->client->dev, "overflow detected\n"); - mxt_write_object(data, - GEN_POWERCONFIG_T7, 1, 0xff); - mxt_write_object(data, - TOUCH_MULTITOUCHSCREEN_T9, 8, 2); - mxt_write_object(data, - SPT_CTECONFIG_T46, 3, 24); - } - /* reset */ - if (msg[1] & 0x80) { - dev_info(&data->client->dev, "reset is ongoing\n"); - - if (data->charging_mode) - set_charger_config(data, 0); - else - schedule_delayed_work(&data->acq_int_dwork, HZ * 3); - } -} - -static void mxt_treat_T9_object(struct mxt_data *data, u8 *msg) -{ - int id; - - id = msg[0] - data->finger_report_id; - - /* If not a touch event, return */ - if (id < 0 || id >= data->num_fingers) - return; - - if (msg[1] & RELEASE_MSG_MASK) { - data->fingers[id].w = msg[5]; - data->fingers[id].state = MXT_STATE_RELEASE; - mxt_report_input_data(data); - } else if ((msg[1] & DETECT_MSG_MASK) - && (msg[1] & (PRESS_MSG_MASK | MOVE_MSG_MASK))) { - data->fingers[id].x = (((msg[2] << 4) | (msg[4] >> 4)) - >> data->x_dropbits); - data->fingers[id].y = (((msg[3] << 4) | (msg[4] & 0xF)) - >> data->y_dropbits); - data->fingers[id].w = msg[5]; - -#ifndef CONFIG_INPUT_WACOM - /* workaround for the hovering issue */ - if (msg[1] & PRESS_MSG_MASK) { - if (data->fingers[id].z == msg[6]) { - if (data->pdata->max_z == msg[6]) - data->fingers[id].z = msg[6] - 1; - else - data->fingers[id].z = msg[6] + 1; - } - } else - data->fingers[id].z = msg[6]; -#else - data->fingers[id].z = msg[6]; -#endif - -#if TSP_USE_SHAPETOUCH - data->fingers[id].component = msg[7]; -#endif - data->finger_mask |= 1U << id; - - if (msg[1] & PRESS_MSG_MASK) { - data->fingers[id].state = MXT_STATE_PRESS; - data->fingers[id].mcount = 0; - -#if CHECK_ANTITOUCH - if (data->check_autocal) - mxt_check_coordinate(data, 1, id, - &data->fingers[id].x, - &data->fingers[id].y); -#endif - - } else if (msg[1] & MOVE_MSG_MASK) { - data->fingers[id].mcount += 1; - -#if CHECK_ANTITOUCH - if (data->check_autocal) - mxt_check_coordinate(data, 0, id, - &data->fingers[id].x, - &data->fingers[id].y); -#endif - } - -#if TSP_BOOSTER - mxt_set_dvfs_on(data, true); -#endif - } else if ((msg[1] & SUPPRESS_MSG_MASK) - && (data->fingers[id].state != MXT_STATE_INACTIVE)) { - data->fingers[id].w = msg[5]; - data->fingers[id].state = MXT_STATE_RELEASE; - data->finger_mask |= 1U << id; - } else { - /* ignore changed amplitude message */ - if (!((msg[1] & DETECT_MSG_MASK) - && (msg[1] & AMPLITUDE_MSG_MASK))) - dev_err(&data->client->dev, "Unknown state %#02x %#02x\n", - msg[0], msg[1]); - } -} - -static void mxt_treat_T42_object(struct mxt_data *data, u8 *msg) -{ - if (msg[1] & 0x01) - /* Palm Press */ - dev_info(&data->client->dev, "palm touch detected\n"); - else - /* Palm release */ - dev_info(&data->client->dev, "palm touch released\n"); -} - -static void mxt_treat_T57_object(struct mxt_data *data, u8 *msg) -{ -#if CHECK_ANTITOUCH - u16 tch_area = 0, atch_area = 0; - - tch_area = msg[3] | (msg[4] << 8); - atch_area = msg[5] | (msg[6] << 8); - if (data->check_antitouch) { - if (tch_area) { - if (data->debug_log) - dev_info(&data->client->dev, - "TCHAREA=%d\n", tch_area); - - /* First Touch After Calibration */ - if (data->check_timer == 0) { - mxt_t61_timer_set(data, - MXT_T61_TIMER_ONESHOT, - MXT_T61_TIMER_CMD_START, - 3000); - data->check_timer = 1; - } - - if (tch_area <= 2) - mxt_t8_autocal_set(data, 5); - - if (atch_area > 5) { - if (atch_area - tch_area > 0) { - if (data->debug_log) - dev_info(&data->client->dev, - "Case:1 TCHAREA=%d ATCHAREA=%d\n", - tch_area, atch_area); - mxt_calibrate_chip(data); - } - } - - } else { - if (atch_area) { - /* Only Anti-touch */ - if (data->debug_log) - dev_info(&data->client->dev, - "Case:2 TCHAREA=%d ATCHAREA=%d\n", - tch_area, atch_area); - mxt_calibrate_chip(data); - } - } - } - - if (data->check_calgood == 1) { - if (tch_area) { - if ((atch_area - tch_area) > 8) { - if (tch_area < 35) { - if (data->debug_log) - dev_info(&data->client->dev, - "Cal Not Good 1 - %d %d\n", - atch_area, tch_area); - mxt_calibrate_chip(data); - } - } - if (((tch_area - atch_area) >= 40) && - (atch_area > 4)) { - if (data->debug_log) - dev_info(&data->client->dev, - "Cal Not Good 2 - %d %d\n", - atch_area, tch_area); - mxt_calibrate_chip(data); - } - } else { - if (atch_area) { - /* Only Anti-touch */ - if (data->debug_log) - dev_info(&data->client->dev, - "Cal Not Good 3 - %d %d\n", - atch_area, tch_area); - mxt_calibrate_chip(data); - } - } - } - -#endif /* CHECK_ANTITOUCH */ - -#if TSP_USE_SHAPETOUCH - data->sumsize = msg[1] + (msg[2] << 8); -#endif /* TSP_USE_SHAPETOUCH */ - -} - -#if CHECK_ANTITOUCH -static void mxt_treat_T61_object(struct mxt_data *data, u8 *msg) -{ - if ((msg[1] & 0xa0) == 0xa0) { - - if (data->check_calgood == 1) - data->check_calgood = 0; - - if (data->check_antitouch) { - if (data->debug_log) - dev_info(&data->client->dev, - "SPT_TIMER_T61 Stop\n"); - data->check_antitouch = 0; - data->check_timer = 0; - mxt_t8_autocal_set(data, 0); - data->check_calgood = 1; - mxt_t61_timer_set(data, - MXT_T61_TIMER_ONESHOT, - MXT_T61_TIMER_CMD_START, 10000); - } - } -} -#endif /* CHECK_ANTITOUCH */ - -static irqreturn_t mxt_irq_thread(int irq, void *ptr) -{ - struct mxt_data *data = ptr; - u8 msg[data->msg_object_size]; - u8 object_type, instance; - - do { - if (mxt_read_mem(data, data->msg_proc, sizeof(msg), msg)) - return IRQ_HANDLED; - -#if TSP_ITDEV - if (data->debug_enabled) - print_hex_dump(KERN_INFO, "MXT MSG:", - DUMP_PREFIX_NONE, 16, 1, - msg, sizeof(msg), false); -#endif /* TSP_ITDEV */ - object_type = mxt_reportid_to_type(data, msg[0] , &instance); - - if (object_type == RESERVED_T0) - continue; - - switch (object_type) { - case GEN_COMMANDPROCESSOR_T6: - mxt_treat_T6_object(data, msg); - break; - - case TOUCH_MULTITOUCHSCREEN_T9: - mxt_treat_T9_object(data, msg); - break; - - case PROCI_TOUCHSUPPRESSION_T42: - mxt_treat_T42_object(data, msg); - break; - - case PROCI_EXTRATOUCHSCREENDATA_T57: - mxt_treat_T57_object(data, msg); - break; - -#if CHECK_ANTITOUCH - case SPT_TIMER_T61: - mxt_treat_T61_object(data, msg); - break; -#endif /* CHECK_ANTITOUCH */ - - default: - if (data->debug_log) - dev_info(&data->client->dev, "Untreated Object type[%d]\t" - "message[0x%x,0x%x,0x%x,0x%x,0x%x,0x%x," - "0x%x,0x%x,0x%x]\n", - object_type, msg[0], msg[1], - msg[2], msg[3], msg[4], msg[5], - msg[6], msg[7], msg[8]); - break; - } - } while (!gpio_get_value(data->pdata->gpio_read_done)); - - if (data->finger_mask) - mxt_report_input_data(data); - - return IRQ_HANDLED; -} - -static int mxt_internal_suspend(struct mxt_data *data) -{ - int i; - int count = 0; - - for (i = 0; i < data->num_fingers; i++) { - if (data->fingers[i].state == MXT_STATE_INACTIVE) - continue; - data->fingers[i].state = MXT_STATE_RELEASE; - count++; - } - if (count) - mxt_report_input_data(data); - -#if TSP_BOOSTER - mxt_set_dvfs_on(data, false); -#endif - - data->pdata->power_off(); - - return 0; -} - -static int mxt_internal_resume(struct mxt_data *data) -{ - data->pdata->power_on(); - return 0; -} - -static int mxt_get_bootloader_version(struct i2c_client *client, u8 val) -{ - u8 buf[3]; - - if (val & MXT_BOOT_EXTENDED_ID) { - if (i2c_master_recv(client, buf, sizeof(buf)) != sizeof(buf)) { - dev_err(&client->dev, "%s: i2c recv failed\n", - __func__); - return -EIO; - } - dev_info(&client->dev, "Bootloader ID:%d Version:%d", - buf[1], buf[2]); - } else { - dev_info(&client->dev, "Bootloader ID:%d", - val & MXT_BOOT_ID_MASK); - } - return 0; -} - -static int mxt_check_bootloader(struct i2c_client *client, - unsigned int state) -{ - u8 val; - -recheck: - if (i2c_master_recv(client, &val, 1) != 1) { - dev_err(&client->dev, "%s: i2c recv failed\n", __func__); - return -EIO; - } - - switch (state) { - case MXT_WAITING_BOOTLOAD_CMD: - if (mxt_get_bootloader_version(client, val)) - return -EIO; - val &= ~MXT_BOOT_STATUS_MASK; - break; - case MXT_WAITING_FRAME_DATA: - case MXT_APP_CRC_FAIL: - val &= ~MXT_BOOT_STATUS_MASK; - break; - case MXT_FRAME_CRC_PASS: - if (val == MXT_FRAME_CRC_CHECK) - goto recheck; - if (val == MXT_FRAME_CRC_FAIL) { - dev_err(&client->dev, "Bootloader CRC fail\n"); - return -EINVAL; - } - break; - default: - return -EINVAL; - } - - if (val != state) { - dev_err(&client->dev, - "Invalid bootloader mode state 0x%X\n", val); - return -EINVAL; - } - - return 0; -} - -static int mxt_unlock_bootloader(struct i2c_client *client) -{ - u8 buf[2] = {MXT_UNLOCK_CMD_LSB, MXT_UNLOCK_CMD_MSB}; - - if (i2c_master_send(client, buf, 2) != 2) { - dev_err(&client->dev, "%s: i2c send failed\n", __func__); - - return -EIO; - } - - return 0; -} - -static int mxt_probe_bootloader(struct i2c_client *client) -{ - u8 val; - - if (i2c_master_recv(client, &val, 1) != 1) { - dev_err(&client->dev, "%s: i2c recv failed\n", __func__); - return -EIO; - } - - val &= ~MXT_BOOT_STATUS_MASK; - if (val & MXT_APP_CRC_FAIL) - dev_err(&client->dev, "Application CRC failure\n"); - else - dev_err(&client->dev, "Device in bootloader mode\n"); - - return 0; -} - -static int mxt_fw_write(struct i2c_client *client, - const u8 *frame_data, unsigned int frame_size) -{ - if (i2c_master_send(client, frame_data, frame_size) != frame_size) { - dev_err(&client->dev, "%s: i2c send failed\n", __func__); - return -EIO; - } - - return 0; -} - -static int mxt_flash_fw(struct mxt_data *data, - const u8 *fw_data, size_t fw_size) -{ - struct device *dev = &data->client->dev; - struct i2c_client *client = data->client_boot; - unsigned int frame_size; - unsigned int pos = 0; - int ret; - - ret = mxt_check_bootloader(client, MXT_WAITING_BOOTLOAD_CMD); - if (ret) { - /*may still be unlocked from previous update attempt */ - ret = mxt_check_bootloader(client, MXT_WAITING_FRAME_DATA); - if (ret) - goto out; - } else { - dev_info(dev, "Unlocking bootloader\n"); - /* Unlock bootloader */ - mxt_unlock_bootloader(client); - } - while (pos < fw_size) { - ret = mxt_check_bootloader(client, - MXT_WAITING_FRAME_DATA); - if (ret) { - dev_err(dev, "Fail updating firmware. wating_frame_data err\n"); - goto out; - } - - frame_size = ((*(fw_data + pos) << 8) | *(fw_data + pos + 1)); - - /* - * We should add 2 at frame size as the the firmware data is not - * included the CRC bytes. - */ - - frame_size += 2; - - /* Write one frame to device */ - mxt_fw_write(client, fw_data + pos, frame_size); - - ret = mxt_check_bootloader(client, - MXT_FRAME_CRC_PASS); - if (ret) { - dev_err(dev, "Fail updating firmware. frame_crc err\n"); - goto out; - } - - pos += frame_size; - - dev_info(dev, "Updated %d bytes / %zd bytes\n", - pos, fw_size); - - msleep(20); - } - - dev_info(dev, "Sucess updating firmware\n"); -out: - return ret; -} - -static int mxt_load_fw(struct mxt_data *data, bool is_bootmode) -{ - struct i2c_client *client = data->client; - struct device *dev = &client->dev; - const struct firmware *fw = NULL; - char *fw_path; - int ret; - - dev_info(dev, "Enter updating firmware from %s\n", - is_bootmode ? "Boot" : "App"); - - fw_path = kzalloc(MXT_MAX_FW_PATH, GFP_KERNEL); - if (fw_path == NULL) { - dev_err(dev, "failed to allocate firmware path.\n"); - return -ENOMEM; - } - - snprintf(fw_path, MXT_MAX_FW_PATH, "tsp_atmel/%s", MXT_FW_NAME); - ret = request_firmware(&fw, fw_path, dev); - if (ret) { - dev_err(dev, "Unable to open firmware %s\n", fw_path); - goto out; - } - - if (!is_bootmode) { - /* Change to the bootloader mode */ - ret = mxt_write_object(data, GEN_COMMANDPROCESSOR_T6, - CMD_RESET_OFFSET, MXT_BOOT_VALUE); - if (ret) { - dev_err(dev, "Fail to change bootloader mode\n"); - goto out; - } - msleep(MXT_1664S_SW_RESET_TIME); - } - - ret = mxt_flash_fw(data, fw->data, fw->size); - if (ret) - goto out; - else - msleep(MXT_1664S_FW_RESET_TIME); - -out: - kfree(fw_path); - release_firmware(fw); - - return ret; -} - -static int mxt_input_open(struct input_dev *dev) -{ - struct mxt_data *data = input_get_drvdata(dev); - - mxt_start(data); - - return 0; -} - -static void mxt_input_close(struct input_dev *dev) -{ - struct mxt_data *data = input_get_drvdata(dev); - - mxt_stop(data); -} - -static void late_resume_dwork(struct work_struct *work) -{ - struct mxt_data *data = - container_of(work, struct mxt_data, - resume_dwork.work); - - set_charger_config(data, 0); - - if (!data->charging_mode) - schedule_delayed_work(&data->acq_int_dwork, HZ * 3); - - enable_irq(data->client->irq); -} - -#ifdef CONFIG_HAS_EARLYSUSPEND -#define mxt_suspend NULL -#define mxt_resume NULL - -static void mxt_early_suspend(struct early_suspend *h) -{ - struct mxt_data *data = container_of(h, struct mxt_data, - early_suspend); -#if TSP_INFORM_CHARGER - cancel_delayed_work_sync(&data->noti_dwork); -#endif - - mutex_lock(&data->lock); - - if (data->mxt_enabled) { - disable_irq(data->client->irq); - data->mxt_enabled = false; - mxt_internal_suspend(data); - } else { - dev_err(&data->client->dev, - "%s. but touch already off\n", __func__); - } - - mutex_unlock(&data->lock); -} - -static void mxt_late_resume(struct early_suspend *h) -{ - struct mxt_data *data = container_of(h, struct mxt_data, - early_suspend); - - mutex_lock(&data->lock); - - if (data->mxt_enabled) { - dev_err(&data->client->dev, - "%s. but touch already on\n", __func__); - } else { - mxt_internal_resume(data); - data->mxt_enabled = true; - schedule_delayed_work(&data->resume_dwork, - msecs_to_jiffies(MXT_1664S_HW_RESET_TIME)); - } - - mutex_unlock(&data->lock); -} -#else -static int mxt_suspend(struct device *dev) -{ - struct i2c_client *client = to_i2c_client(dev); - struct mxt_data *data = i2c_get_clientdata(client); - - mutex_lock(&data->lock); - - disable_irq(data->client->irq); - mxt_internal_suspend(data); - data->mxt_enabled = false; - - mutex_unlock(&data->lock); - return 0; -} - -static int mxt_resume(struct device *dev) -{ - struct i2c_client *client = to_i2c_client(dev); - struct mxt_data *data = i2c_get_clientdata(client); - - mutex_lock(&data->lock); - - mxt_internal_resume(data); - data->mxt_enabled = true; - enable_irq(data->client->irq); - - mutex_unlock(&data->lock); - return 0; -} -#endif - -static int mxt_init_touch(struct mxt_data *data) -{ - struct device *dev = &data->client->dev; - u32 read_crc = 0; - u32 calc_crc; - u16 crc_address; - int ret; - - ret = mxt_get_id_info(data); - if (ret) { - /* Check the IC is in Boot mode or not - * if it is in bootmode wating state, excute firmware upgrade - */ - ret = mxt_probe_bootloader(data->client_boot); - if (ret) { - dev_err(dev, "Failed to verify bootloader's status\n"); - goto out; - } else { - ret = mxt_load_fw(data, true); - if (ret) { - dev_err(dev, "Failed updating firmware\n"); - goto out; - } - } - ret = mxt_get_id_info(data); - if (ret) - goto out; - } - - /* If objects and rid_map are already allocated, - * realloc that. because number of objects, report ID can be changed - * when firmware is changed. - */ - if (data->objects) { - dev_err(&data->client->dev, "objects are already allocated\n"); - kfree(data->objects); - } - if (data->rid_map) { - dev_err(&data->client->dev, "rid_map are already allocated\n"); - kfree(data->rid_map); - } - - data->objects = kcalloc(data->info.object_num, - sizeof(*data->objects), - GFP_KERNEL); - if (!data->objects) - return -ENOMEM; - - /* Get object table */ - ret = mxt_get_object_table(data); - if (ret) - goto free_objects; - - data->rid_map = kcalloc(data->max_report_id + 1, - sizeof(*data->rid_map), - GFP_KERNEL); - - if (!data->rid_map) - goto free_objects; - - /* Make report id table */ - mxt_make_reportid_table(data); - - /* Verify CRC */ - crc_address = OBJECT_TABLE_START_ADDRESS + - data->info.object_num * OBJECT_TABLE_ELEMENT_SIZE; - -#ifdef __BIG_ENDIAN -#error The following code will likely break on a big endian machine -#endif - ret = mxt_read_mem(data, crc_address, 3, (u8 *)&read_crc); - if (ret) - goto free_rid_map; - - read_crc = le32_to_cpu(read_crc); - - ret = mxt_calculate_infoblock_crc(data, &calc_crc); - if (ret) - goto free_rid_map; - - if (read_crc != calc_crc) { - dev_err(&data->client->dev, "CRC error\n"); - ret = -EFAULT; - goto free_rid_map; - } - return 0; - -free_rid_map: - kfree(data->rid_map); -free_objects: - kfree(data->objects); -out: - return ret; -} - -static int mxt_rest_init_touch(struct mxt_data *data) -{ - struct device *dev = &data->client->dev; - int i; - int ret; - - /* tsp_family_id - 0xA2 : MXT-1446-S series */ - if (data->info.family_id == 0xA2) { - for (i = 0; i < data->num_fingers; i++) - data->fingers[i].state = MXT_STATE_INACTIVE; - -#if TSP_FIRMUP_ON_PROBE - if (data->info.version != MXT_FIRM_VERSION - || (data->info.version == MXT_FIRM_VERSION - && data->info.build != MXT_FIRM_BUILD)) { - if (mxt_load_fw(data, false)) - goto out; - else - mxt_init_touch(data); - } -#endif - } else { - dev_err(dev, "There is no valid TSP ID\n"); - goto out; - } - - ret = mxt_write_configuration(data); - if (ret) { - dev_err(dev, "Failed init write config\n"); - goto out; - } - ret = mxt_backup(data); - if (ret) { - dev_err(dev, "Failed backup NV data\n"); - goto out; - } - /* reset the touch IC. */ - ret = mxt_reset(data); - if (ret) { - dev_err(dev, "Failed Reset IC\n"); - goto out; - } - msleep(MXT_1664S_SW_RESET_TIME); - -out: - return ret; -} - -#if TSP_SEC_SYSFS -int mxt_flash_fw_from_sysfs(struct mxt_data *data, - const u8 *fw_data, size_t fw_size) -{ - struct i2c_client *client = data->client; - int ret; - - /* Change to the bootloader mode */ - ret = mxt_write_object(data, GEN_COMMANDPROCESSOR_T6, - CMD_RESET_OFFSET, MXT_BOOT_VALUE); - if (ret) { - dev_err(&client->dev, "Fail to change bootloader mode\n"); - goto out; - } - msleep(MXT_1664S_SW_RESET_TIME); - - /* writing firmware */ - ret = mxt_flash_fw(data, fw_data, fw_size); - if (ret) { - dev_err(&client->dev, "Failed updating firmware: %s\n", - __func__); - goto out; - } - msleep(MXT_1664S_FW_RESET_TIME); - - ret = mxt_init_touch(data); - if (ret) { - dev_err(&client->dev, "initialization failed: %s\n", __func__); - goto out; - } - - /* rest touch ic such as write config and backup */ - ret = mxt_write_configuration(data); - if (ret) { - dev_err(&client->dev, "Failed init write config\n"); - goto out; - } - ret = mxt_backup(data); - if (ret) { - dev_err(&client->dev, "Failed backup NV data\n"); - goto out; - } - /* reset the touch IC. */ - ret = mxt_reset(data); - if (ret) { - dev_err(&client->dev, "Failed Reset IC\n"); - goto out; - } - msleep(MXT_1664S_SW_RESET_TIME); -out: - return ret; -} -#endif - -static int __devinit mxt_probe(struct i2c_client *client, - const struct i2c_device_id *id) -{ - const struct mxt_platform_data *pdata = client->dev.platform_data; - struct mxt_data *data; - struct input_dev *input_dev; - u16 boot_address; - int ret = 0; - - if (!pdata) { - dev_err(&client->dev, "missing platform data\n"); - return -ENODEV; - } - - if (pdata->max_finger_touches <= 0) - return -EINVAL; - - data = kzalloc(sizeof(*data) + pdata->max_finger_touches * - sizeof(*data->fingers), GFP_KERNEL); - input_dev = input_allocate_device(); - if (!data || !input_dev) { - ret = -ENOMEM; - dev_err(&client->dev, "input device allocation failed\n"); - goto err_alloc_dev; - } - - data->client = client; - data->input_dev = input_dev; - data->pdata = pdata; - data->num_fingers = pdata->max_finger_touches; - data->mxt_enabled = true; - data->config_version = pdata->config_version; - mutex_init(&data->lock); - - input_dev->name = "sec_touchscreen"; - input_dev->id.bustype = BUS_I2C; - input_dev->dev.parent = &client->dev; - input_dev->open = mxt_input_open; - input_dev->close = mxt_input_close; - - set_bit(EV_ABS, input_dev->evbit); - set_bit(EV_KEY, input_dev->evbit); - set_bit(MT_TOOL_FINGER, input_dev->keybit); - set_bit(INPUT_PROP_DIRECT, input_dev->propbit); - - input_mt_init_slots(input_dev, data->num_fingers); - - input_set_abs_params(input_dev, ABS_MT_POSITION_X, pdata->min_x, - pdata->max_x, 0, 0); - input_set_abs_params(input_dev, ABS_MT_POSITION_Y, pdata->min_y, - pdata->max_y, 0, 0); - input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR, pdata->min_w, - pdata->max_w, 0, 0); - input_set_abs_params(input_dev, ABS_MT_PRESSURE, pdata->min_z, - pdata->max_z, 0, 0); - -#if TSP_USE_SHAPETOUCH - input_set_abs_params(input_dev, ABS_MT_COMPONENT, 0, 255, 0, 0); - input_set_abs_params(input_dev, ABS_MT_SUMSIZE, 0, 16 * 26, 0, 0); -#endif - - input_set_drvdata(input_dev, data); - i2c_set_clientdata(client, data); - - /* regist dummy device for boot_address */ - if (data->pdata->boot_address) { - boot_address = data->pdata->boot_address; - } else { - if (client->addr == MXT_APP_LOW) - boot_address = MXT_BOOT_LOW; - else - boot_address = MXT_BOOT_HIGH; - } - data->client_boot = i2c_new_dummy(client->adapter, boot_address); - if (!data->client_boot) { - dev_err(&client->dev, "Fail to register sub client[0x%x]\n", - boot_address); - goto err_alloc_dev; - } - - /* regist input device */ - ret = input_register_device(input_dev); - if (ret) - goto err_reg_dev; - - INIT_DELAYED_WORK(&data->resume_dwork, late_resume_dwork); - - data->pdata->power_on(); - msleep(MXT_1664S_HW_RESET_TIME); - - /* init touch ic */ - ret = mxt_init_touch(data); - if (ret) { - dev_err(&client->dev, "initialization failed\n"); - goto err_init_drv; - } - - /* rest touch ic such as write config and backup */ - ret = mxt_rest_init_touch(data); - if (ret) - goto err_free_mem; - - /* disabled report touch event to prevent unnecessary event. - * it will be enabled in open function - */ - mxt_stop(data); - -#if TSP_INFORM_CHARGER - /* Register callbacks */ - /* To inform tsp , charger connection status*/ - data->callbacks.inform_charger = inform_charger; - if (pdata->register_cb) { - u8 *tmp = pdata->register_cb(&data->callbacks); - inform_charger_init(data, tmp); - } -#endif - - ret = request_threaded_irq(client->irq, NULL, mxt_irq_thread, - IRQF_TRIGGER_LOW | IRQF_ONESHOT, "mxt_ts", data); - - if (ret < 0) { - dev_err(&client->dev, "Failed register irq\n"); - goto err_free_mem; - } -#ifdef CONFIG_HAS_EARLYSUSPEND - data->early_suspend.level = EARLY_SUSPEND_LEVEL_DISABLE_FB + 1; - data->early_suspend.suspend = mxt_early_suspend; - data->early_suspend.resume = mxt_late_resume; - register_early_suspend(&data->early_suspend); -#endif - - ret = mxt_sysfs_init(client); - if (ret < 0) { - dev_err(&client->dev, "Failed to creat sysfs\n"); - goto err_free_mem; - } - -#if TSP_BOOSTER - ret = mxt_init_dvfs(data); - if (ret < 0) { - dev_err(&client->dev, "Fail get dvfs level for touch booster\n"); - goto err_free_mem; - } -#endif - dev_info(&client->dev, "Mxt touch success initialization\n"); - - return 0; - -err_free_mem: - kfree(data->objects); - kfree(data->rid_map); -err_init_drv: - input_unregister_device(input_dev); - input_dev = NULL; - gpio_free(data->pdata->gpio_read_done); - data->pdata->power_off(); -err_reg_dev: - input_free_device(input_dev); - i2c_unregister_device(data->client_boot); -err_alloc_dev: - kfree(data); - - return ret; -} - -static int __devexit mxt_remove(struct i2c_client *client) -{ - struct mxt_data *data = i2c_get_clientdata(client); - -#ifdef CONFIG_HAS_EARLYSUSPEND - unregister_early_suspend(&data->early_suspend); -#endif - free_irq(client->irq, data); -#if TSP_INFORM_CHARGER - kfree(data->charger_inform_buf); -#endif - kfree(data->objects); - kfree(data->rid_map); - gpio_free(data->pdata->gpio_read_done); - data->pdata->power_off(); - input_unregister_device(data->input_dev); - i2c_unregister_device(data->client_boot); - kfree(data); - - return 0; -} - -static struct i2c_device_id mxt_idtable[] = { - {MXT_DEV_NAME, 0}, - {}, -}; - -MODULE_DEVICE_TABLE(i2c, mxt_idtable); - -static const struct dev_pm_ops mxt_pm_ops = { - .suspend = mxt_suspend, - .resume = mxt_resume, -}; - -static struct i2c_driver mxt_i2c_driver = { - .id_table = mxt_idtable, - .probe = mxt_probe, - .remove = __devexit_p(mxt_remove), - .driver = { - .owner = THIS_MODULE, - .name = MXT_DEV_NAME, -#ifdef CONFIG_PM - .pm = &mxt_pm_ops, -#endif - }, -}; - -static int __init mxt_init(void) -{ - return i2c_add_driver(&mxt_i2c_driver); -} - -static void __exit mxt_exit(void) -{ - i2c_del_driver(&mxt_i2c_driver); -} - -module_init(mxt_init); -module_exit(mxt_exit); - -MODULE_DESCRIPTION("Atmel MaXTouch driver"); -MODULE_AUTHOR("bumwoo.lee<bw365.lee@samsung.com>"); -MODULE_LICENSE("GPL"); |