| /* |
| * Synaptics DSX touchscreen driver |
| * |
| * Copyright (C) 2012 Synaptics Incorporated |
| * |
| * Copyright (C) 2012 Alexandra Chin <alexandra.chin@tw.synaptics.com> |
| * Copyright (C) 2012 Scott Lin <scott.lin@tw.synaptics.com> |
| * |
| * 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. |
| */ |
| #define BROKEN_TUNNEL_SHORT_TRANSFER |
| |
| #define pr_fmt(fmt) "%s: " fmt, __func__ |
| |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/slab.h> |
| #include <linux/i2c.h> |
| #include <linux/of.h> |
| #include <linux/of_gpio.h> |
| #include <linux/interrupt.h> |
| #include <linux/delay.h> |
| #include <linux/input.h> |
| #include <linux/gpio.h> |
| #include <linux/ctype.h> |
| #include <linux/jiffies.h> |
| #include <linux/semaphore.h> |
| #include <linux/regulator/consumer.h> |
| #include <linux/input/synaptics_rmi_dsx.h> |
| #include "synaptics_dsx_i2c.h" |
| #ifdef KERNEL_ABOVE_2_6_38 |
| #include <linux/input/mt.h> |
| #endif |
| |
| #define DRIVER_NAME "synaptics_dsx_i2c" |
| #define INPUT_PHYS_NAME "synaptics_dsx_i2c/input0" |
| #define TYPE_B_PROTOCOL |
| |
| #define NO_0D_WHILE_2D |
| /* |
| #define REPORT_2D_Z |
| */ |
| #define REPORT_2D_W |
| |
| #define RPT_TYPE (1 << 0) |
| #define RPT_X_LSB (1 << 1) |
| #define RPT_X_MSB (1 << 2) |
| #define RPT_Y_LSB (1 << 3) |
| #define RPT_Y_MSB (1 << 4) |
| #define RPT_Z (1 << 5) |
| #define RPT_WX (1 << 6) |
| #define RPT_WY (1 << 7) |
| #define RPT_DEFAULT (RPT_TYPE | RPT_X_LSB | RPT_X_MSB | RPT_Y_LSB | RPT_Y_MSB) |
| |
| #define EXP_FN_DET_INTERVAL 1000 /* ms */ |
| #define POLLING_PERIOD 1 /* ms */ |
| #define SYN_I2C_RETRY_TIMES 10 |
| #define MAX_ABS_MT_TOUCH_MAJOR 15 |
| #define SYN_MAX_BUTTONS 4 |
| |
| #define F01_STD_QUERY_LEN 21 |
| #define F01_BUID_ID_OFFSET 18 |
| #define F11_STD_QUERY_LEN 9 |
| #define F11_STD_CTRL_LEN 10 |
| #define F11_STD_DATA_LEN 12 |
| #define F12_STD_QUERY_LEN 10 |
| #define F12_STD_CTRL_LEN 4 |
| #define F12_STD_DATA_LEN 80 |
| |
| #define NORMAL_OPERATION (0 << 0) |
| #define SENSOR_SLEEP (1 << 0) |
| #define NO_SLEEP_OFF (0 << 2) |
| #define NO_SLEEP_ON (1 << 2) |
| |
| #define ONE_TOUCH_RECALIBRATION 49 |
| #define ONE_TOUCH_SUPPRESSION 5 |
| #define MULTI_TOUCH_SUPPRESSION 1 |
| #define F11_DELTA_MAX (2*MULTI_TOUCH_SUPPRESSION) |
| |
| #define X_1T_SUPPRESSION ONE_TOUCH_SUPPRESSION |
| #define Y_1T_SUPPRESSION ONE_TOUCH_SUPPRESSION |
| #define X_MT_SUPPRESSION MULTI_TOUCH_SUPPRESSION |
| #define Y_MT_SUPPRESSION MULTI_TOUCH_SUPPRESSION |
| |
| #define TYPE_FINGER (1 << 0) |
| #define TYPE_STYLUS (1 << 1) |
| |
| #define RESET_GPIO_NAME "touch_reset" |
| #define IRQ_GPIO_NAME "touch_irq" |
| |
| #define SYDBG(fmt, args...) printk(KERN_ERR "%s: " fmt, __func__, ##args) |
| #define SYDBG_REG(subpkt, fld) SYDBG(#subpkt "." #fld " = 0x%02X\n", subpkt.fld) |
| |
| /* F12 packet register description */ |
| |
| static struct { |
| unsigned char max_x_lsb; |
| unsigned char max_x_msb; |
| unsigned char max_y_lsb; |
| unsigned char max_y_msb; |
| } f12_c08_0; |
| |
| static struct { |
| unsigned char recv_pitch_lsb; |
| unsigned char recv_pitch_msb; |
| unsigned char trans_pitch_lsb; |
| unsigned char trans_pitch_msb; |
| } f12_c08_1; |
| |
| static struct { |
| unsigned char low_recv_clip; |
| unsigned char high_recv_clip; |
| unsigned char low_trans_clip; |
| unsigned char high_trans_clip; |
| } f12_c08_2; |
| |
| static struct { |
| unsigned char num_2d_recv; |
| unsigned char num_2d_trans; |
| } f12_c08_3; |
| |
| static struct f12_c20_0_type { |
| unsigned char x_suppression; |
| unsigned char y_suppression; |
| } f12_c20_0; |
| |
| static struct { |
| union { |
| struct { |
| unsigned char report_always:1; |
| unsigned char reserved:7; |
| } __packed; |
| unsigned char data[1]; |
| }; |
| } f12_c20_1; |
| |
| static struct f12_c23_0_type { |
| union { |
| struct { |
| unsigned char finger:1; |
| unsigned char stylus:1; |
| unsigned char palm:1; |
| unsigned char unclassified:1; |
| unsigned char reserved:4; |
| } __packed; |
| unsigned char data[1]; |
| }; |
| } f12_c23_0; |
| |
| static struct f12_c23_1_type { |
| unsigned char max_num_reported_objects; |
| } f12_c23_1; |
| |
| static struct { |
| unsigned char reported_bytes_per_object; |
| } f12_c28_0; |
| |
| static struct synaptics_rmi4_subpkt f12_c08[] = { |
| RMI4_SUBPKT(f12_c08_0), |
| RMI4_SUBPKT(f12_c08_1), |
| RMI4_SUBPKT(f12_c08_2), |
| RMI4_SUBPKT(f12_c08_3), |
| }; |
| |
| static struct synaptics_rmi4_subpkt f12_c20[] = { |
| RMI4_SUBPKT(f12_c20_0), |
| RMI4_SUBPKT(f12_c20_1), |
| }; |
| |
| static struct synaptics_rmi4_subpkt f12_c23[] = { |
| RMI4_SUBPKT(f12_c23_0), |
| RMI4_SUBPKT(f12_c23_1), |
| }; |
| |
| static struct synaptics_rmi4_subpkt f12_c28[] = { |
| RMI4_SUBPKT(f12_c28_0), |
| }; |
| |
| static struct synaptics_rmi4_packet_reg f12_ctrl_reg_array[] = { |
| RMI4_NO_REG(), /*00*/ |
| RMI4_NO_REG(), /*01*/ |
| RMI4_NO_REG(), /*02*/ |
| RMI4_NO_REG(), /*03*/ |
| RMI4_NO_REG(), /*04*/ |
| RMI4_NO_REG(), /*05*/ |
| RMI4_NO_REG(), /*06*/ |
| RMI4_NO_REG(), /*07*/ |
| RMI4_REG(f12_c08), /*08*/ |
| RMI4_NO_REG(), /*09*/ |
| RMI4_NO_REG(), /*10*/ |
| RMI4_NO_REG(), /*11*/ |
| RMI4_NO_REG(), /*12*/ |
| RMI4_NO_REG(), /*13*/ |
| RMI4_NO_REG(), /*14*/ |
| RMI4_NO_REG(), /*15*/ |
| RMI4_NO_REG(), /*16*/ |
| RMI4_NO_REG(), /*17*/ |
| RMI4_NO_REG(), /*18*/ |
| RMI4_NO_REG(), /*19*/ |
| RMI4_REG(f12_c20), /*20*/ |
| RMI4_NO_REG(), /*21*/ |
| RMI4_NO_REG(), /*22*/ |
| RMI4_REG(f12_c23), /*23*/ |
| RMI4_NO_REG(), /*24*/ |
| RMI4_NO_REG(), /*25*/ |
| RMI4_NO_REG(), /*26*/ |
| RMI4_NO_REG(), /*27*/ |
| RMI4_REG(f12_c28), /*28*/ |
| }; |
| |
| static struct synaptics_rmi4_func_packet_regs f12_ctrl_regs = { |
| .base_addr = 0, |
| .nr_regs = ARRAY_SIZE(f12_ctrl_reg_array), |
| .regs = f12_ctrl_reg_array |
| }; |
| |
| struct synaptics_dsx_hob { |
| struct f12_c20_0_type f12_c20_0; |
| struct f12_c23_0_type f12_c23_0; |
| struct f12_c23_1_type f12_c23_1; |
| unsigned char f01_c9; |
| }; |
| |
| /* global variable init-ed from kernel cmd line */ |
| static int touch_test_mode; |
| |
| int __init touch_test_mode_init(char *s) |
| { |
| touch_test_mode = 1; |
| pr_info("touch driver in TEST mode\n"); |
| return 1; |
| } |
| |
| __setup("touch_test_mode", touch_test_mode_init); |
| |
| static struct synaptics_dsx_hob hob_data; |
| static unsigned char tsb_buff_clean_flag = 1; |
| |
| #define LAST_SUBPACKET_ROW_IND_MASK 0x80 |
| #define NR_SUBPKT_PRESENCE_BITS 7 |
| |
| int synaptics_rmi4_scan_packet_reg_info( |
| struct synaptics_rmi4_data *rmi4_data, |
| unsigned short query_addr, |
| unsigned short regs_base_addr, |
| struct synaptics_rmi4_func_packet_regs *regs) |
| { |
| unsigned char sz, mask; |
| int ii, jj, r, s, retval; |
| unsigned short r_offset; |
| unsigned short addr = query_addr; |
| unsigned char data[255]; |
| |
| for (r = 0; r < regs->nr_regs; ++r) { |
| regs->regs[r].offset = -1; |
| regs->regs[r].size = 0; |
| for (s = 0; s < regs->regs[r].nr_subpkts; ++s) { |
| regs->regs[r].subpkt[s].present = 0; |
| if (regs->regs[r].subpkt[s].data && |
| regs->regs[r].subpkt[s].size) |
| memset(regs->regs[r].subpkt[s].data, 0, |
| regs->regs[r].subpkt[s].size); |
| } |
| } |
| |
| regs->base_addr = regs_base_addr; |
| retval = rmi4_data->i2c_read(rmi4_data, addr, &sz, 1); |
| pr_debug("size of reg presence = %d\n", sz); |
| if (retval < 0) |
| return retval; |
| if (!sz) |
| return -EIO; |
| /* Scan register presence */ |
| retval = rmi4_data->i2c_read(rmi4_data, ++addr, data, sz); |
| if (retval < 0) |
| return retval; |
| if (!data[0]) { |
| pr_err("packet register size greater 255 bytes" |
| " not supported\n"); |
| return -ENOSYS; |
| } |
| ii = 1; |
| for (r = 0, r_offset = 0; ii < sz; ++ii) { |
| pr_debug("reg presence [%d] = 0x%02x\n", ii, data[ii]); |
| for (jj = 0, mask = 1; jj < 8; ++jj, ++r, mask <<= 1) { |
| struct synaptics_rmi4_packet_reg *reg = regs->regs + r; |
| int present = (data[ii] & mask) != 0; |
| int allocated = r < regs->nr_regs; |
| int expected = allocated && reg->expected; |
| if (!present || !expected) { |
| if (allocated && present) |
| reg->offset = r_offset++; |
| if (present != expected) |
| pr_debug(" reg: r%d" |
| " is%s present, but was%s" |
| " expected\n", r, |
| present ? "" : " NOT", |
| expected ? "" : " NOT"); |
| continue; |
| } |
| pr_debug(" r%d offset = %d\n", r, r_offset); |
| reg->offset = r_offset++; |
| } |
| } |
| |
| /* Scan register size and subpacket presence*/ |
| sz = data[0]; |
| pr_debug("subpacket presence sz = %d\n", sz); |
| retval = rmi4_data->i2c_read(rmi4_data, ++addr, data, sz); |
| if (retval < 0) |
| return retval; |
| for (r = 0, ii = 0; r < regs->nr_regs && ii < sz; ++r) { |
| unsigned int expected_reg_size; |
| struct synaptics_rmi4_packet_reg *reg = regs->regs + r; |
| if (reg->offset == -1) |
| continue; |
| reg->size = data[ii++]; |
| pr_debug("r%d sz = %d\n", r, reg->size); |
| if (!reg->size) { |
| pr_err("packet register size greater 255 bytes" |
| " not supported\n"); |
| return -ENOSYS; |
| } |
| expected_reg_size = 0; |
| for (s = 0; ii < sz;) { |
| pr_debug(" subpkt presence [%d] = 0x%02x\n", |
| ii, data[ii]); |
| for (jj = 0, mask = 1; jj < NR_SUBPKT_PRESENCE_BITS; |
| ++jj, ++s, mask <<= 1) { |
| struct synaptics_rmi4_subpkt *subpkt = |
| reg->subpkt + s; |
| int present = (data[ii] & mask) != 0; |
| int expected = (s < reg->nr_subpkts) && |
| subpkt->expected; |
| if (!present || !expected) { |
| if (present != expected) |
| pr_debug(" subpacket:" |
| " r%d s%d is%s present," |
| " but was%s expected\n", |
| r, s, |
| present ? "" : " NOT", |
| expected ? "" : " NOT"); |
| continue; |
| } |
| pr_debug(" r%d.s%d is present\n", r, s); |
| subpkt->present = 1; |
| expected_reg_size += subpkt->size; |
| } |
| if ((data[ii++] & LAST_SUBPACKET_ROW_IND_MASK) == 0) |
| break; |
| } |
| if (reg->expected && reg->size != expected_reg_size) { |
| pr_debug(" r%d size error:" |
| " expected %d actual is %d\n", |
| r, expected_reg_size, reg->size); |
| } |
| } |
| return 0; |
| } |
| |
| int synaptics_rmi4_read_packet_reg( |
| struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_func_packet_regs *regs, unsigned char r) |
| { |
| int s, retval, offset; |
| static unsigned char data[255]; |
| struct synaptics_rmi4_packet_reg *reg = regs->regs + r; |
| |
| if (r >= regs->nr_regs || !reg->size) |
| return -EINVAL; |
| |
| if (reg->offset == -1) { |
| pr_err("touch register error: can't read r%d - not present\n", |
| r); |
| return -ENOENT; |
| } |
| |
| retval = rmi4_data->i2c_read( |
| rmi4_data, |
| regs->base_addr + reg->offset, |
| data, |
| reg->size); |
| |
| if (retval < 0) |
| return retval; |
| |
| for (s = 0, offset = 0; s < reg->nr_subpkts; ++s) { |
| struct synaptics_rmi4_subpkt *subpkt = reg->subpkt + s; |
| if (!subpkt->present) |
| continue; |
| |
| if ((reg->size - offset) < subpkt->size) { |
| pr_err("subpkt size error: expected %d bytes," |
| " only %d present\n", subpkt->size, |
| (reg->size - offset)); |
| break; |
| } |
| |
| memcpy(subpkt->data, data+offset, subpkt->size); |
| offset += subpkt->size; |
| #if defined(CONFIG_DYNAMIC_DEBUG) || defined(DEBUG) |
| { |
| int kk; |
| pr_debug("read r%d.s%d =\n", r, s); |
| for (kk = 0; kk < subpkt->size; ++kk) |
| pr_debug("%02x\n", |
| ((unsigned char *)subpkt->data)[kk]); |
| } |
| #endif |
| } |
| return retval; |
| } |
| |
| int synaptics_rmi4_read_packet_regs( |
| struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_func_packet_regs *regs) |
| { |
| int r; |
| int retval = 0; |
| |
| for (r = 0; r < regs->nr_regs; ++r) { |
| if (regs->regs[r].expected && regs->regs[r].offset >= 0) { |
| retval = synaptics_rmi4_read_packet_reg( |
| rmi4_data, regs, r); |
| if (retval < 0) |
| break; |
| } |
| } |
| return retval; |
| } |
| |
| static int synaptics_rmi4_write_packet_reg( |
| struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_func_packet_regs *regs, unsigned char r) |
| { |
| unsigned char data[255]; |
| struct synaptics_rmi4_packet_reg *reg = regs->regs + r; |
| int sz, ii, offset, retval; |
| |
| if (r >= regs->nr_regs || !reg->size) |
| return -EINVAL; |
| if (reg->offset == -1) { |
| pr_err("touch register error: writing to absent register r%d\n", |
| r); |
| return -ENOENT; |
| } |
| |
| for (ii = 0, sz = 0, offset = 0; ii < reg->nr_subpkts; ++ii) { |
| struct synaptics_rmi4_subpkt *subpkt = reg->subpkt + ii; |
| if (!subpkt->present) |
| continue; |
| |
| if (subpkt->data && subpkt->size && |
| (offset + subpkt->size) < sizeof(data)) { |
| if ((reg->size - offset) >= subpkt->size) { |
| memcpy(data + sz, subpkt->data, subpkt->size); |
| sz += subpkt->size; |
| } else { |
| pr_err("expected %d bytes, only %d present\n", |
| offset + subpkt->size, reg->size); |
| break; |
| } |
| } else { |
| retval = -EINVAL; |
| pr_err("bad subpacket or register greater %d bytes\n", |
| sizeof(data)); |
| goto out; |
| } |
| } |
| retval = rmi4_data->i2c_write(rmi4_data, regs->base_addr + reg->offset, |
| data, sz); |
| out: |
| return retval; |
| } |
| |
| int synaptics_dsx_gpio_config( |
| struct synaptics_dsx_platform_data *pdata, bool enable) |
| { |
| int retval = 0; |
| |
| if (enable) { |
| if (!gpio_is_valid(pdata->irq_gpio)) { |
| pr_err("invalid %s\n", IRQ_GPIO_NAME); |
| retval = -EINVAL; |
| } |
| retval = gpio_request(pdata->irq_gpio, IRQ_GPIO_NAME); |
| if (retval) { |
| pr_err("unable to request %s [%d]: rc=%d\n", |
| IRQ_GPIO_NAME, pdata->irq_gpio, retval); |
| goto err_gpio; |
| } |
| retval = gpio_direction_input(pdata->irq_gpio); |
| if (retval) { |
| pr_err("unable to set %s [%d] dir: rc=%d\n", |
| IRQ_GPIO_NAME, pdata->irq_gpio, retval); |
| goto err_gpio; |
| } |
| |
| if (!gpio_is_valid(pdata->reset_gpio)) { |
| pr_err("invalid %s\n", RESET_GPIO_NAME); |
| retval = -EINVAL; |
| } |
| retval = gpio_request(pdata->reset_gpio, RESET_GPIO_NAME); |
| if (retval) { |
| pr_err("unable to request %s [%d]: rc=%d\n", |
| RESET_GPIO_NAME, pdata->reset_gpio, retval); |
| goto err_gpio; |
| } |
| retval = gpio_direction_output(pdata->reset_gpio, 1); |
| if (retval) { |
| pr_err("unable to set %s [%d] dir: rc=%d\n", |
| RESET_GPIO_NAME, pdata->reset_gpio, retval); |
| goto err_gpio; |
| } |
| } else { |
| gpio_free(pdata->irq_gpio); |
| gpio_free(pdata->reset_gpio); |
| } |
| |
| err_gpio: |
| return retval; |
| } |
| |
| #if 0 |
| static struct synaptics_dsx_platform_data * |
| synaptics_dsx_of_init(struct i2c_client *client, |
| struct synaptics_rmi4_data *rmi4_data) |
| { |
| int retval; |
| unsigned key_codes[SYN_MAX_BUTTONS]; |
| struct synaptics_dsx_platform_data *pdata; |
| struct device_node *np = client->dev.of_node; |
| struct synaptics_dsx_cap_button_map *button_map = NULL; |
| |
| pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL); |
| if (!pdata) { |
| dev_err(&client->dev, "pdata allocation failure\n"); |
| return NULL; |
| } |
| |
| pdata->irq_gpio = of_get_gpio(np, 0); |
| pdata->reset_gpio = of_get_gpio(np, 1); |
| |
| memset(key_codes, 0, sizeof(key_codes)); |
| retval = of_property_read_u32_array(np, "synaptics,key-buttons", |
| key_codes, SYN_MAX_BUTTONS); |
| if (!retval) { |
| int ii; |
| unsigned char *button_codes; |
| |
| button_map = kzalloc(sizeof(*button_map), GFP_KERNEL); |
| if (IS_ERR_OR_NULL(button_map)) { |
| dev_err(&client->dev, "button allocation failure\n"); |
| return NULL; |
| } |
| |
| for (ii = 0; ii < SYN_MAX_BUTTONS; ii++) |
| if (key_codes[ii]) |
| button_map->nbuttons++; |
| |
| button_codes = kzalloc(button_map->nbuttons, GFP_KERNEL); |
| if (IS_ERR_OR_NULL(button_codes)) { |
| dev_err(&client->dev, "button allocation failure\n"); |
| kfree(button_map); |
| return NULL; |
| } |
| |
| for (ii = 0; ii < button_map->nbuttons; ii++) |
| *(button_codes + ii) = (unsigned char)key_codes[ii]; |
| |
| button_map->map = button_codes; |
| } |
| |
| pdata->irq_flags = IRQF_TRIGGER_LOW | IRQF_ONESHOT; |
| pdata->cap_button_map = button_map; |
| |
| if (of_property_read_bool(np, "synaptics,gpio-config")) { |
| pr_notice("using gpio config\n"); |
| pdata->gpio_config = synaptics_dsx_gpio_config; |
| } |
| |
| if (of_property_read_bool(np, "synaptics,x-flip")) { |
| pr_notice("using flipped X axis\n"); |
| pdata->x_flip = true; |
| } |
| |
| if (of_property_read_bool(np, "synaptics,y-flip")) { |
| pr_notice("using flipped Y axis\n"); |
| pdata->y_flip = true; |
| } |
| |
| if (of_property_read_bool(np, "synaptics,purge-enabled")) { |
| pr_notice("using purge\n"); |
| rmi4_data->purge_enabled = true; |
| } |
| |
| if (of_property_read_bool(np, "synaptics,reset-on-resume")) { |
| pr_notice("using reset ic on resume\n"); |
| rmi4_data->reset_on_resume = true; |
| } |
| |
| if (of_property_read_bool(np, "synaptics,one-touch-enabled")) { |
| pr_notice("using one touch while suspended\n"); |
| rmi4_data->one_touch_enabled = true; |
| } |
| |
| if (!of_property_read_bool(np, "synaptics,normal-mode")) { |
| pr_notice("using normal mode settings from tdat\n"); |
| rmi4_data->normal_mode = -1; |
| } else { |
| of_property_read_u32(np, "synaptics,normal-mode", |
| &rmi4_data->normal_mode); |
| pr_notice("%s mode\n", rmi4_data->normal_mode ? |
| "using normal" : "enforce no sleep"); |
| } |
| |
| if (of_property_read_bool(np, "synaptics,hw-reset")) { |
| pr_notice("using hard ic reset\n"); |
| rmi4_data->hw_reset = true; |
| } |
| |
| return pdata; |
| } |
| #else |
| static inline struct synaptics_dsx_platform_data * |
| synaptics_dsx_of_init(struct i2c_client *client) |
| { |
| struct synaptics_dsx_platform_data *pdata = client->dev.platform_data; |
| pdata->irq_flags = IRQF_TRIGGER_LOW | IRQF_ONESHOT; |
| |
| return pdata; |
| } |
| #endif |
| |
| #define HYPHEN '-' |
| #define letter_i 'i' |
| #define letter_s 's' |
| #define letter_t 't' |
| |
| static void synaptics_dsx_darn_product_string(unsigned char *id, size_t len) |
| { |
| unsigned char *hyphen; |
| |
| hyphen = strnchr(id, len, HYPHEN); |
| if (hyphen) { |
| if (*(hyphen+1) == toupper(letter_t)) { |
| memmove(id+1, id, hyphen-id); |
| hyphen++; |
| *hyphen++ = letter_t; |
| } else if (*(hyphen+1) == toupper(letter_i)) |
| *hyphen++ = letter_i; |
| *id = letter_s; |
| *hyphen = 0; |
| } else { |
| int i; |
| for (i = 0; *(id+i) != 0; i++) |
| if (isupper(*(id+i))) |
| *(id+i) = tolower(*(id+i)); |
| } |
| } |
| |
| static int synaptics_rmi4_i2c_read(struct synaptics_rmi4_data *rmi4_data, |
| unsigned short addr, unsigned char *data, |
| unsigned short length); |
| |
| static int synaptics_rmi4_i2c_write(struct synaptics_rmi4_data *rmi4_data, |
| unsigned short addr, unsigned char *data, |
| unsigned short length); |
| |
| static int synaptics_rmi4_reset_device(struct synaptics_rmi4_data *rmi4_data, |
| unsigned char *f01_cmd_base_addr); |
| |
| static void synaptics_rmi4_sensor_sleep(struct synaptics_rmi4_data *rmi4_data); |
| |
| static void synaptics_rmi4_sensor_wake(struct synaptics_rmi4_data *rmi4_data); |
| |
| static void synaptics_rmi4_sensor_one_touch( |
| struct synaptics_rmi4_data *rmi4_data, bool enable); |
| |
| static void synaptics_rmi4_sensor_multi_touch( |
| struct synaptics_rmi4_data *rmi4_data, unsigned char function); |
| |
| static int synaptics_rmi4_irq_enable(struct synaptics_rmi4_data *rmi4_data, |
| bool enable); |
| |
| static void synaptics_dsx_sensor_state(struct synaptics_rmi4_data *rmi4_data, |
| int state); |
| |
| #if defined(CONFIG_FB) && !defined(CONFIG_MMI_PANEL_NOTIFICATIONS) |
| static int synaptics_dsx_panel_cb(struct notifier_block *nb, |
| unsigned long event, void *data); |
| #endif |
| |
| static int synaptics_rmi4_suspend(struct device *dev); |
| |
| static int synaptics_rmi4_resume(struct device *dev); |
| |
| static ssize_t synaptics_rmi4_f01_reset_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count); |
| |
| static ssize_t synaptics_rmi4_f01_productinfo_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_f01_buildid_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_f01_flashprog_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_0dbutton_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_0dbutton_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count); |
| |
| static ssize_t synaptics_rmi4_resume_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_irqtimes_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_drv_irq_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_drv_irq_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count); |
| |
| static ssize_t synaptics_rmi4_hw_irqstat_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_ic_ver_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| static ssize_t synaptics_rmi4_poweron_show(struct device *dev, |
| struct device_attribute *attr, char *buf); |
| |
| struct synaptics_rmi4_f01_device_status { |
| union { |
| struct { |
| unsigned char status_code:4; |
| unsigned char reserved:2; |
| unsigned char flash_prog:1; |
| unsigned char unconfigured:1; |
| } __packed; |
| unsigned char data[1]; |
| }; |
| }; |
| |
| struct synaptics_rmi4_f1a_query { |
| union { |
| struct { |
| unsigned char max_button_count:3; |
| unsigned char reserved:5; |
| unsigned char has_general_control:1; |
| unsigned char has_interrupt_enable:1; |
| unsigned char has_multibutton_select:1; |
| unsigned char has_tx_rx_map:1; |
| unsigned char has_perbutton_threshold:1; |
| unsigned char has_release_threshold:1; |
| unsigned char has_strongestbtn_hysteresis:1; |
| unsigned char has_filter_strength:1; |
| } __packed; |
| unsigned char data[2]; |
| }; |
| }; |
| |
| struct synaptics_rmi4_f1a_control_0 { |
| union { |
| struct { |
| unsigned char multibutton_report:2; |
| unsigned char filter_mode:2; |
| unsigned char reserved:4; |
| } __packed; |
| unsigned char data[1]; |
| }; |
| }; |
| |
| struct synaptics_rmi4_f1a_control_3_4 { |
| unsigned char transmitterbutton; |
| unsigned char receiverbutton; |
| }; |
| |
| struct synaptics_rmi4_f1a_control { |
| struct synaptics_rmi4_f1a_control_0 general_control; |
| unsigned char *button_int_enable; |
| unsigned char *multi_button; |
| struct synaptics_rmi4_f1a_control_3_4 *electrode_map; |
| unsigned char *button_threshold; |
| unsigned char button_release_threshold; |
| unsigned char strongest_button_hysteresis; |
| unsigned char filter_strength; |
| }; |
| |
| struct synaptics_rmi4_f1a_handle { |
| int button_bitmask_size; |
| unsigned char button_count; |
| unsigned char valid_button_count; |
| unsigned char *button_data_buffer; |
| unsigned char *button_map; |
| struct synaptics_rmi4_f1a_query button_query; |
| struct synaptics_rmi4_f1a_control button_control; |
| }; |
| |
| struct synaptics_rmi4_exp_fn { |
| enum exp_fn fn_type; |
| enum ic_modes mode; |
| bool inserted; |
| int (*func_init)(struct synaptics_rmi4_data *rmi4_data); |
| void (*func_remove)(struct synaptics_rmi4_data *rmi4_data); |
| void (*func_attn)(struct synaptics_rmi4_data *rmi4_data, |
| unsigned char intr_mask); |
| struct list_head link; |
| }; |
| |
| static struct device_attribute attrs[] = { |
| __ATTR(reset, S_IWUSR | S_IWGRP, |
| synaptics_rmi4_show_error, |
| synaptics_rmi4_f01_reset_store), |
| __ATTR(productinfo, S_IRUGO, |
| synaptics_rmi4_f01_productinfo_show, |
| synaptics_rmi4_store_error), |
| __ATTR(buildid, S_IRUGO, |
| synaptics_rmi4_f01_buildid_show, |
| synaptics_rmi4_store_error), |
| __ATTR(flashprog, S_IRUSR | S_IRGRP, |
| synaptics_rmi4_f01_flashprog_show, |
| synaptics_rmi4_store_error), |
| __ATTR(0dbutton, (S_IRUSR | S_IRGRP | S_IWUSR | S_IWGRP), |
| synaptics_rmi4_0dbutton_show, |
| synaptics_rmi4_0dbutton_store), |
| __ATTR(resumeinfo, S_IRUSR | S_IRGRP, |
| synaptics_rmi4_resume_show, |
| synaptics_rmi4_store_error), |
| __ATTR(drv_irq, (S_IRUSR | S_IRGRP | S_IWUSR | S_IWGRP), |
| synaptics_rmi4_drv_irq_show, |
| synaptics_rmi4_drv_irq_store), |
| __ATTR(hw_irqstat, S_IRUSR | S_IRGRP, |
| synaptics_rmi4_hw_irqstat_show, |
| synaptics_rmi4_store_error), |
| __ATTR(ic_ver, S_IRUGO, |
| synaptics_rmi4_ic_ver_show, |
| synaptics_rmi4_store_error), |
| __ATTR(irqinfo, S_IRUSR | S_IRGRP, |
| synaptics_rmi4_irqtimes_show, |
| synaptics_rmi4_store_error), |
| __ATTR(poweron, S_IRUSR | S_IRGRP, |
| synaptics_rmi4_poweron_show, |
| synaptics_rmi4_store_error), |
| }; |
| |
| struct synaptics_exp_fn_ctrl { |
| bool inited; |
| struct mutex list_mutex; |
| struct list_head fn_list; |
| struct delayed_work det_work; |
| struct workqueue_struct *det_workqueue; |
| struct synaptics_rmi4_data *rmi4_data_ptr; |
| }; |
| |
| DEFINE_MUTEX(exp_fn_ctrl_mutex); |
| static struct synaptics_exp_fn_ctrl exp_fn_ctrl; |
| static struct semaphore reset_semaphore; |
| |
| static irqreturn_t synaptics_dsx_reset_irq(int irq, void *data) |
| { |
| struct semaphore *sema = data; |
| up(sema); |
| return IRQ_HANDLED; |
| } |
| |
| static int synaptics_dsx_ic_reset( |
| struct synaptics_rmi4_data *rmi4_data, bool hw_reset) |
| { |
| int retval; |
| unsigned long start = jiffies; |
| const struct synaptics_dsx_platform_data *platform_data = |
| rmi4_data->board; |
| |
| sema_init(&reset_semaphore, 0); |
| |
| if (hw_reset) { |
| gpio_set_value(platform_data->reset_gpio, 0); |
| udelay(1500); |
| } |
| |
| retval = request_irq(rmi4_data->irq, synaptics_dsx_reset_irq, |
| IRQF_TRIGGER_RISING, "synaptics_reset", |
| &reset_semaphore); |
| if (retval < 0) |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to request irq: %d\n", |
| __func__, retval); |
| |
| if (hw_reset) |
| gpio_set_value(platform_data->reset_gpio, 1); |
| |
| retval = down_timeout(&reset_semaphore, msecs_to_jiffies(100)); |
| if (retval) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "timed out waiting for reset to complete\n"); |
| retval = -ETIMEDOUT; |
| } else { |
| retval = (int)jiffies_to_msecs(jiffies-start); |
| /* delay extra 0.5 ms to ensure 1st i2c bus access succeeds */ |
| udelay(500); |
| } |
| |
| free_irq(rmi4_data->irq, &reset_semaphore); |
| |
| return retval; |
| } |
| |
| static int synaptics_dsx_alloc_input(struct synaptics_rmi4_data *rmi4_data) |
| { |
| rmi4_data->input_dev = input_allocate_device(); |
| if (IS_ERR_OR_NULL(rmi4_data->input_dev)) |
| return PTR_ERR(rmi4_data->input_dev); |
| |
| rmi4_data->input_dev->name = DRIVER_NAME; |
| rmi4_data->input_dev->phys = INPUT_PHYS_NAME; |
| rmi4_data->input_dev->id.bustype = BUS_I2C; |
| rmi4_data->input_dev->dev.parent = &rmi4_data->i2c_client->dev; |
| |
| set_bit(EV_SYN, rmi4_data->input_dev->evbit); |
| input_set_drvdata(rmi4_data->input_dev, rmi4_data); |
| |
| pr_debug("allocated input device\n"); |
| |
| return 0; |
| } |
| |
| #define DSX(a) (#a) |
| static const char * const synaptics_state_names[] = SYNAPTICS_DSX_STATES; |
| #undef DSX |
| |
| static const char *synaptics_dsx_state_name(int state) |
| { |
| int index = state < 0 || state > STATE_INVALID ? STATE_INVALID : state; |
| return synaptics_state_names[index]; |
| } |
| |
| static int synaptics_dsx_get_state_safe(struct synaptics_rmi4_data *rmi4_data) |
| { |
| int state; |
| mutex_lock(&(rmi4_data->state_mutex)); |
| state = rmi4_data->state; |
| mutex_unlock(&(rmi4_data->state_mutex)); |
| return state; |
| } |
| |
| static void synaptics_dsx_set_state_safe(struct synaptics_rmi4_data *rmi4_data, |
| int state) |
| { |
| mutex_lock(&(rmi4_data->state_mutex)); |
| rmi4_data->state = state; |
| mutex_unlock(&(rmi4_data->state_mutex)); |
| } |
| |
| static int synaptics_dsx_wait_for_idle(struct synaptics_rmi4_data *rmi4_data) |
| { |
| unsigned long start_wait_jiffies = jiffies; |
| |
| do { |
| int current_state; |
| |
| current_state = synaptics_dsx_get_state_safe(rmi4_data); |
| if (!(current_state == STATE_INIT || |
| current_state == STATE_FLASH || |
| current_state == STATE_UNKNOWN || |
| touch_test_mode)) |
| break; |
| |
| usleep_range(1000, 1000); |
| |
| } while (1); |
| |
| if ((jiffies - start_wait_jiffies)) |
| pr_info("entering suspend delayed for %ums\n", |
| jiffies_to_msecs(jiffies - start_wait_jiffies)); |
| return 0; |
| } |
| |
| static int synaptics_dsx_sensor_ready_state( |
| struct synaptics_rmi4_data *rmi4_data, bool standby) |
| { |
| bool ui_mode; |
| int retval, state; |
| struct synaptics_rmi4_f01_device_status status; |
| |
| /* ensure ic is woken up, since older beta firmware cannot */ |
| /* access device status register when ic is in sleep mode */ |
| if (rmi4_data->sensor_sleep) |
| synaptics_rmi4_sensor_wake(rmi4_data); |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_data_base_addr, |
| status.data, |
| sizeof(status.data)); |
| if (retval < 0) { |
| pr_err("failed to query touch ic status\n"); |
| return retval; |
| } |
| |
| state = synaptics_dsx_get_state_safe(rmi4_data); |
| |
| ui_mode = status.flash_prog == 0; |
| pr_debug("UI mode: %s\n", ui_mode ? "true" : "false"); |
| |
| if (ui_mode) { |
| state = standby ? STATE_STANDBY : STATE_ACTIVE; |
| state = touch_test_mode ? STATE_ACTIVE : state; |
| } else |
| if (!(state == STATE_INIT || state == STATE_FLASH)) |
| state = STATE_BL; |
| |
| synaptics_dsx_sensor_state(rmi4_data, state); |
| |
| return 0; |
| } |
| |
| static void synaptics_dsx_sensor_state(struct synaptics_rmi4_data *rmi4_data, |
| int state) |
| { |
| if (synaptics_dsx_get_state_safe(rmi4_data) == state) |
| return; |
| |
| switch (state) { |
| case STATE_UNKNOWN: |
| case STATE_FLASH: |
| /* no special handling for these states */ |
| break; |
| |
| case STATE_SUSPEND: |
| synaptics_dsx_wait_for_idle(rmi4_data); |
| synaptics_rmi4_irq_enable(rmi4_data, false); |
| |
| if (rmi4_data->one_touch_enabled) |
| synaptics_rmi4_sensor_one_touch(rmi4_data, true); |
| |
| if (!rmi4_data->sensor_sleep) |
| synaptics_rmi4_sensor_sleep(rmi4_data); |
| break; |
| |
| case STATE_ACTIVE: |
| if (rmi4_data->sensor_sleep) |
| synaptics_rmi4_sensor_wake(rmi4_data); |
| |
| if (rmi4_data->one_touch_enabled) |
| synaptics_rmi4_sensor_one_touch(rmi4_data, false); |
| |
| synaptics_rmi4_irq_enable(rmi4_data, true); |
| break; |
| |
| case STATE_STANDBY: |
| synaptics_rmi4_irq_enable(rmi4_data, false); |
| /* put sensor to sleep to ensure the same */ |
| /* initial conditions apply to all */ |
| if (!rmi4_data->sensor_sleep) |
| synaptics_rmi4_sensor_sleep(rmi4_data); |
| break; |
| |
| case STATE_BL: |
| if (!rmi4_data->in_bootloader) |
| rmi4_data->in_bootloader = true; |
| case STATE_INIT: |
| synaptics_rmi4_irq_enable(rmi4_data, false); |
| if (rmi4_data->sensor_sleep) |
| synaptics_rmi4_sensor_wake(rmi4_data); |
| break; |
| } |
| |
| pr_info("state change %s -> %s\n", |
| synaptics_dsx_state_name(rmi4_data->state), |
| synaptics_dsx_state_name(state)); |
| |
| synaptics_dsx_set_state_safe(rmi4_data, state); |
| } |
| |
| static ssize_t synaptics_rmi4_f01_reset_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count) |
| { |
| int retval; |
| unsigned int reset; |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| |
| if (sscanf(buf, "%u", &reset) != 1) |
| return -EINVAL; |
| |
| if (reset != 1) |
| return -EINVAL; |
| |
| retval = synaptics_rmi4_reset_device(rmi4_data, NULL); |
| if (retval < 0) { |
| dev_err(dev, |
| "%s: Failed to issue reset command, error = %d\n", |
| __func__, retval); |
| return retval; |
| } |
| |
| return count; |
| } |
| |
| static ssize_t synaptics_rmi4_f01_productinfo_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| |
| return scnprintf(buf, PAGE_SIZE, "%s\n", |
| rmi4_data->rmi4_mod_info.product_id_string); |
| } |
| |
| static ssize_t synaptics_rmi4_f01_buildid_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| unsigned int firmware_id; |
| unsigned int config_id; |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| struct synaptics_rmi4_device_info *rmi; |
| |
| rmi = &(rmi4_data->rmi4_mod_info); |
| |
| batohui(&firmware_id, rmi->build_id, sizeof(rmi->build_id)); |
| batohui(&config_id, rmi->config_id, sizeof(rmi->config_id)); |
| |
| return scnprintf(buf, PAGE_SIZE, "%x-%08x\n", firmware_id, config_id); |
| } |
| |
| static ssize_t synaptics_rmi4_resume_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| int i; |
| int c_res; |
| int offset = 0; |
| |
| c_res = rmi4_data->last_resume; |
| /* Resume buffer not allocated or there were no resumes yet */ |
| if (rmi4_data->number_resumes <= 0 || c_res < 0) |
| return scnprintf(buf, PAGE_SIZE, |
| "No resume information found.\n"); |
| |
| offset += scnprintf(buf + offset, PAGE_SIZE - offset, |
| "Count\tStart\t\tFinish\t# no-events\t" |
| "ISR\t\tpurge off\tsendevent\n"); |
| |
| for (i = 0; i < rmi4_data->number_resumes; i++) { |
| offset += scnprintf(buf + offset, PAGE_SIZE - offset, |
| "%d\t%4ld.%03ld\t%4ld.%03ld\t%d\t%4ld.%03ld\t" |
| "%4ld.%03ld\t%4ld.%03ld\n", |
| i+1, |
| rmi4_data->resume_info[c_res].start.tv_sec%1000, |
| rmi4_data->resume_info[c_res].start.tv_nsec/1000000, |
| rmi4_data->resume_info[c_res].finish.tv_sec%1000, |
| rmi4_data->resume_info[c_res].finish.tv_nsec/1000000, |
| rmi4_data->resume_info[c_res].ignored_events, |
| rmi4_data->resume_info[c_res].isr.tv_sec%1000, |
| rmi4_data->resume_info[c_res].isr.tv_nsec/1000000, |
| rmi4_data->resume_info[c_res].purge_off.tv_sec%1000, |
| rmi4_data->resume_info[c_res].purge_off.tv_nsec/1000000, |
| rmi4_data->resume_info[c_res].send_touch.tv_sec%1000, |
| rmi4_data->resume_info[c_res].send_touch.tv_nsec/1000000); |
| |
| if (c_res <= 0) |
| c_res = rmi4_data->number_resumes-1; |
| else |
| c_res--; |
| } |
| return offset; |
| } |
| |
| static ssize_t synaptics_rmi4_irqtimes_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| int i; |
| int c_res; |
| int offset = 0; |
| |
| c_res = rmi4_data->last_irq; |
| /* Resume buffer not allocated or there were no irq data collected yet*/ |
| if (rmi4_data->number_irq <= 0 || c_res < 0) |
| return scnprintf(buf, PAGE_SIZE, |
| "No resume information found.\n"); |
| |
| offset += scnprintf(buf + offset, PAGE_SIZE - offset, |
| "Count\tIRQ Start\n"); |
| |
| for (i = 0; i < rmi4_data->number_irq; i++) { |
| offset += scnprintf(buf + offset, PAGE_SIZE - offset, |
| "%d\t%4ld.%03ld\n", |
| i+1, |
| rmi4_data->irq_info[i].irq_time.tv_sec%1000, |
| rmi4_data->irq_info[i].irq_time.tv_nsec/1000000); |
| |
| if (c_res <= 0) |
| c_res = rmi4_data->number_irq-1; |
| else |
| c_res--; |
| } |
| return offset; |
| } |
| |
| static ssize_t synaptics_rmi4_f01_flashprog_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| int retval; |
| struct synaptics_rmi4_f01_device_status device_status; |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_data_base_addr, |
| device_status.data, |
| sizeof(device_status.data)); |
| if (retval < 0) { |
| dev_err(dev, |
| "%s: Failed to read device status, error = %d\n", |
| __func__, retval); |
| return retval; |
| } |
| |
| return scnprintf(buf, PAGE_SIZE, "%u\n", |
| device_status.flash_prog); |
| } |
| |
| static ssize_t synaptics_rmi4_hw_irqstat_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| |
| switch (gpio_get_value(rmi4_data->board->irq_gpio)) { |
| case 0: |
| return scnprintf(buf, PAGE_SIZE, "Low\n"); |
| case 1: |
| return scnprintf(buf, PAGE_SIZE, "High\n"); |
| default: |
| printk(KERN_ERR "%s: Failed to get GPIO for irq %d.\n", |
| __func__, |
| rmi4_data->irq); |
| return scnprintf(buf, PAGE_SIZE, "Unknown\n"); |
| } |
| } |
| |
| static ssize_t synaptics_rmi4_drv_irq_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| |
| return scnprintf(buf, PAGE_SIZE, "%s\n", |
| rmi4_data->irq_enabled ? "ENABLED" : "DISABLED"); |
| } |
| |
| static ssize_t synaptics_rmi4_drv_irq_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| unsigned long value = 0; |
| int err = 0; |
| |
| err = kstrtoul(buf, 10, &value); |
| if (err < 0) { |
| printk(KERN_ERR "%s: Failed to convert value.\n", __func__); |
| return -EINVAL; |
| } |
| |
| switch (value) { |
| case 0: |
| /* Disable irq */ |
| synaptics_rmi4_irq_enable(rmi4_data, false); |
| break; |
| case 1: |
| /* Enable irq */ |
| synaptics_rmi4_irq_enable(rmi4_data, true); |
| break; |
| default: |
| printk(KERN_ERR "%s: Invalid value\n", __func__); |
| return -EINVAL; |
| } |
| return count; |
| } |
| |
| static ssize_t synaptics_rmi4_0dbutton_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| |
| return scnprintf(buf, PAGE_SIZE, "%u\n", |
| rmi4_data->button_0d_enabled); |
| } |
| |
| static ssize_t synaptics_rmi4_0dbutton_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count) |
| { |
| int retval; |
| unsigned int input; |
| unsigned char ii; |
| unsigned char intr_enable; |
| struct synaptics_rmi4_fn *fhandler; |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| struct synaptics_rmi4_device_info *rmi; |
| |
| rmi = &(rmi4_data->rmi4_mod_info); |
| |
| if (sscanf(buf, "%u", &input) != 1) |
| return -EINVAL; |
| |
| input = input > 0 ? 1 : 0; |
| |
| if (rmi4_data->button_0d_enabled == input) |
| return count; |
| |
| list_for_each_entry(fhandler, &rmi->support_fn_list, link) { |
| if (fhandler->fn_number == SYNAPTICS_RMI4_F1A) { |
| ii = fhandler->intr_reg_num; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_ctrl_base_addr + 1 + ii, |
| &intr_enable, |
| sizeof(intr_enable)); |
| if (retval < 0) |
| return retval; |
| |
| if (input == 1) |
| intr_enable |= fhandler->intr_mask; |
| else |
| intr_enable &= ~fhandler->intr_mask; |
| |
| retval = synaptics_rmi4_i2c_write(rmi4_data, |
| rmi4_data->f01_ctrl_base_addr + 1 + ii, |
| &intr_enable, |
| sizeof(intr_enable)); |
| if (retval < 0) |
| return retval; |
| } |
| } |
| |
| rmi4_data->button_0d_enabled = input; |
| |
| return count; |
| } |
| |
| static ssize_t synaptics_rmi4_ic_ver_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| unsigned int build_id, config_id; |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| struct synaptics_rmi4_device_info *rmi; |
| rmi = &(rmi4_data->rmi4_mod_info); |
| batohui(&build_id, rmi->build_id, sizeof(rmi->build_id)); |
| batohui(&config_id, rmi->config_id, sizeof(rmi->config_id)); |
| return scnprintf(buf, PAGE_SIZE, |
| "%s%s\n%s%x\n%s%x\n", |
| "Product ID: ", rmi->product_id_string, |
| "Build ID: ", build_id, |
| "Config ID: ", config_id); |
| } |
| |
| static ssize_t synaptics_rmi4_poweron_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| return scnprintf(buf, PAGE_SIZE, "%d\n", rmi4_data->poweron); |
| } |
| |
| /** |
| * synaptics_rmi4_set_page() |
| * |
| * Called by synaptics_rmi4_i2c_read() and synaptics_rmi4_i2c_write(). |
| * |
| * This function writes to the page select register to switch to the |
| * assigned page. |
| */ |
| static int synaptics_rmi4_set_page(struct synaptics_rmi4_data *rmi4_data, |
| unsigned int address) |
| { |
| int retval = 0; |
| unsigned char retry; |
| unsigned char buf[PAGE_SELECT_LEN]; |
| unsigned char page; |
| struct i2c_client *i2c = rmi4_data->i2c_client; |
| |
| page = ((address >> 8) & MASK_8BIT); |
| if (page != rmi4_data->current_page) { |
| buf[0] = MASK_8BIT; |
| buf[1] = page; |
| for (retry = 0; retry < SYN_I2C_RETRY_TIMES; retry++) { |
| retval = i2c_master_send(i2c, buf, PAGE_SELECT_LEN); |
| if (retval != PAGE_SELECT_LEN) { |
| dev_err(&i2c->dev, |
| "%s: I2C retry %d\n", |
| __func__, retry + 1); |
| msleep(20); |
| } else { |
| rmi4_data->current_page = page; |
| break; |
| } |
| } |
| } else |
| return PAGE_SELECT_LEN; |
| return (retval == PAGE_SELECT_LEN) ? retval : -EIO; |
| } |
| |
| /** |
| * synaptics_rmi4_i2c_read() |
| * |
| * Called by various functions in this driver, and also exported to |
| * other expansion Function modules such as rmi_dev. |
| * |
| * This function reads data of an arbitrary length from the sensor, |
| * starting from an assigned register address of the sensor, via I2C |
| * with a retry mechanism. |
| */ |
| static int synaptics_rmi4_i2c_read(struct synaptics_rmi4_data *rmi4_data, |
| unsigned short addr, unsigned char *data, unsigned short length) |
| { |
| int retval; |
| unsigned char retry; |
| unsigned char buf; |
| struct i2c_msg msg[] = { |
| { |
| .addr = rmi4_data->i2c_client->addr, |
| .flags = 0, |
| .len = 1, |
| .buf = &buf, |
| }, |
| { |
| .addr = rmi4_data->i2c_client->addr, |
| .flags = I2C_M_RD, |
| .len = length, |
| .buf = data, |
| }, |
| }; |
| |
| buf = addr & MASK_8BIT; |
| |
| mutex_lock(&(rmi4_data->rmi4_io_ctrl_mutex)); |
| |
| retval = synaptics_rmi4_set_page(rmi4_data, addr); |
| if (retval != PAGE_SELECT_LEN) |
| goto exit; |
| #ifdef BROKEN_TUNNEL_SHORT_TRANSFER |
| for (retry = 0; retry < SYN_I2C_RETRY_TIMES; retry++) { |
| if (i2c_transfer(rmi4_data->i2c_client->adapter, &msg[0], 1) == 1) { |
| retval = length; |
| break; |
| } |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: I2C retry %d\n", |
| __func__, retry + 1); |
| msleep(20); |
| } |
| |
| for (retry = 0; retry < SYN_I2C_RETRY_TIMES; retry++) { |
| if (i2c_transfer(rmi4_data->i2c_client->adapter, &msg[1], 1) == 1) { |
| retval = length; |
| break; |
| } |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: I2C retry %d\n", |
| __func__, retry + 1); |
| msleep(20); |
| } |
| #else |
| for (retry = 0; retry < SYN_I2C_RETRY_TIMES; retry++) { |
| if (i2c_transfer(rmi4_data->i2c_client->adapter, msg, 2) == 2) { |
| retval = length; |
| break; |
| } |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: I2C retry %d\n", |
| __func__, retry + 1); |
| msleep(20); |
| } |
| #endif |
| |
| if (retry == SYN_I2C_RETRY_TIMES) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: I2C read %db@x%x over retry limit\n", |
| __func__, length, addr); |
| retval = -EIO; |
| } |
| |
| exit: |
| mutex_unlock(&(rmi4_data->rmi4_io_ctrl_mutex)); |
| |
| return retval; |
| } |
| |
| /** |
| * synaptics_rmi4_i2c_write() |
| * |
| * Called by various functions in this driver, and also exported to |
| * other expansion Function modules such as rmi_dev. |
| * |
| * This function writes data of an arbitrary length to the sensor, |
| * starting from an assigned register address of the sensor, via I2C with |
| * a retry mechanism. |
| */ |
| static int synaptics_rmi4_i2c_write(struct synaptics_rmi4_data *rmi4_data, |
| unsigned short addr, unsigned char *data, unsigned short length) |
| { |
| int retval; |
| unsigned char retry; |
| unsigned char buf[length + 1]; |
| struct i2c_msg msg[] = { |
| { |
| .addr = rmi4_data->i2c_client->addr, |
| .flags = 0, |
| .len = length + 1, |
| .buf = buf, |
| } |
| }; |
| |
| mutex_lock(&(rmi4_data->rmi4_io_ctrl_mutex)); |
| |
| retval = synaptics_rmi4_set_page(rmi4_data, addr); |
| if (retval != PAGE_SELECT_LEN) |
| goto exit; |
| |
| buf[0] = addr & MASK_8BIT; |
| memcpy(&buf[1], &data[0], length); |
| |
| for (retry = 0; retry < SYN_I2C_RETRY_TIMES; retry++) { |
| if (i2c_transfer(rmi4_data->i2c_client->adapter, msg, 1) == 1) { |
| retval = length; |
| break; |
| } |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: I2C retry %d\n", |
| __func__, retry + 1); |
| msleep(20); |
| } |
| |
| if (retry == SYN_I2C_RETRY_TIMES) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: I2C write %db@x%x over retry limit\n", |
| __func__, length, addr); |
| retval = -EIO; |
| } |
| |
| exit: |
| mutex_unlock(&(rmi4_data->rmi4_io_ctrl_mutex)); |
| |
| return retval; |
| } |
| |
| /** |
| * synaptics_rmi4_f12_abs_report() |
| * |
| * Called by synaptics_rmi4_report_touch() when valid Function $12 |
| * finger data has been detected. |
| * |
| * This function reads the Function $12 data registers, determines the |
| * status of each finger supported by the Function, processes any |
| * necessary coordinate manipulation, reports the finger data to |
| * the input subsystem, and returns the number of fingers detected. |
| */ |
| static int synaptics_rmi4_f12_abs_report(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler) |
| { |
| struct synaptics_rmi4_resume_info *tmp_resume_i = NULL; |
| int retval; |
| unsigned char touch_count = 0; /* number of touch points */ |
| unsigned char index = 0; |
| unsigned char finger; |
| unsigned char fingers_supported; |
| unsigned char finger_data[F12_STD_DATA_LEN]; |
| unsigned short data_addr; |
| unsigned short data_size; |
| int x; |
| int y; |
| int p; |
| int w; |
| int id; |
| |
| fingers_supported = fhandler->num_of_data_points; |
| data_addr = fhandler->full_addr.data_base; |
| data_size = fingers_supported * fhandler->size_of_data_register_block; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| data_addr, |
| finger_data, |
| data_size); |
| if (retval < 0) |
| return 0; |
| |
| if (rmi4_data->number_resumes > 0) { |
| tmp_resume_i = |
| &(rmi4_data->resume_info[rmi4_data->last_resume]); |
| |
| if (atomic_read(&rmi4_data->panel_off_flag)) { |
| tmp_resume_i->ignored_events++; |
| return 0; |
| } |
| if (tmp_resume_i->purge_off.tv_sec == 0) |
| getnstimeofday(&(tmp_resume_i->purge_off)); |
| } else { |
| if (atomic_read(&rmi4_data->panel_off_flag)) { |
| return 0; |
| } |
| } |
| |
| for (finger = 0; finger < fingers_supported; finger++, |
| index += fhandler->size_of_data_register_block) { |
| if (finger_data[index] == 0) |
| continue; |
| |
| x = finger_data[index+1] | (finger_data[index+2] << 8); |
| y = finger_data[index+3] | (finger_data[index+4] << 8); |
| p = finger_data[index+5]; |
| w = finger_data[index+5]; |
| id = finger; |
| |
| if (rmi4_data->board->x_flip) |
| x = rmi4_data->sensor_max_x - x; |
| if (rmi4_data->board->y_flip) |
| y = rmi4_data->sensor_max_y - y; |
| |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Finger %d:\n" |
| "x = %d\n" |
| "y = %d\n" |
| "p = %d\n" |
| "w = %d\n", |
| __func__, finger, |
| x, y, p, w); |
| |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_POSITION_X, x); |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_POSITION_Y, y); |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_PRESSURE, p); |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_TOUCH_MAJOR, w); |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_TRACKING_ID, id); |
| input_mt_sync(rmi4_data->input_dev); |
| touch_count++; |
| |
| if (rmi4_data->number_resumes > 0 && |
| tmp_resume_i->send_touch.tv_sec == 0) |
| getnstimeofday(&(tmp_resume_i->send_touch)); |
| } |
| |
| if (!touch_count) |
| input_mt_sync(rmi4_data->input_dev); |
| |
| input_sync(rmi4_data->input_dev); |
| |
| return touch_count; |
| } |
| |
| /** |
| * synaptics_rmi4_f11_abs_report() |
| * |
| * Called by synaptics_rmi4_report_touch() when valid Function $11 |
| * finger data has been detected. |
| * |
| * This function reads the Function $11 data registers, determines the |
| * status of each finger supported by the Function, processes any |
| * necessary coordinate manipulation, reports the finger data to |
| * the input subsystem, and returns the number of fingers detected. |
| */ |
| static int synaptics_rmi4_f11_abs_report(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler) |
| { |
| int retval; |
| unsigned char touch_count = 0; /* number of touch points */ |
| unsigned char reg_index; |
| unsigned char finger; |
| unsigned char fingers_supported; |
| unsigned char num_of_finger_status_regs; |
| unsigned char finger_shift; |
| unsigned char finger_status; |
| unsigned char data_reg_blk_size; |
| unsigned char finger_status_reg[3]; |
| unsigned char data[F11_STD_DATA_LEN]; |
| unsigned short data_addr; |
| unsigned short data_offset; |
| int x; |
| int y; |
| int wx; |
| int wy; |
| int z; |
| |
| /* |
| * The number of finger status registers is determined by the |
| * maximum number of fingers supported - 2 bits per finger. So |
| * the number of finger status registers to read is: |
| * register_count = ceil(max_num_of_fingers / 4) |
| */ |
| fingers_supported = fhandler->num_of_data_points; |
| num_of_finger_status_regs = (fingers_supported + 3) / 4; |
| data_addr = fhandler->full_addr.data_base; |
| data_reg_blk_size = fhandler->size_of_data_register_block; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| data_addr, |
| finger_status_reg, |
| num_of_finger_status_regs); |
| if (retval < 0) |
| return 0; |
| |
| if (atomic_read(&rmi4_data->panel_off_flag)) |
| return 0; |
| |
| for (finger = 0; finger < fingers_supported; finger++) { |
| reg_index = finger / 4; |
| finger_shift = (finger % 4) * 2; |
| finger_status = (finger_status_reg[reg_index] >> finger_shift) |
| & MASK_2BIT; |
| |
| /* |
| * Each 2-bit finger status field represents the following: |
| * 00 = finger not present |
| * 01 = finger present and data accurate |
| * 10 = finger present but data may be inaccurate |
| * 11 = reserved |
| */ |
| #ifdef TYPE_B_PROTOCOL |
| input_mt_slot(rmi4_data->input_dev, finger); |
| input_mt_report_slot_state(rmi4_data->input_dev, |
| MT_TOOL_FINGER, finger_status); |
| #endif |
| if (finger_status) { |
| data_offset = data_addr + |
| num_of_finger_status_regs + |
| (finger * data_reg_blk_size); |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| data_offset, |
| data, |
| data_reg_blk_size); |
| if (retval < 0) |
| goto end; |
| |
| x = (data[0] << 4) | (data[2] & MASK_4BIT); |
| y = (data[1] << 4) | ((data[2] >> 4) & MASK_4BIT); |
| wx = (data[3] & MASK_4BIT); |
| wy = (data[3] >> 4) & MASK_4BIT; |
| z = data[4]; |
| |
| if (rmi4_data->board->x_flip) |
| x = rmi4_data->sensor_max_x - x; |
| if (rmi4_data->board->y_flip) |
| y = rmi4_data->sensor_max_y - y; |
| |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Finger %d:\n" |
| "status = 0x%02x\n" |
| "x = %d\n" |
| "y = %d\n" |
| "wx = %d\n" |
| "wy = %d\n" |
| "z = %d\n", |
| __func__, finger, |
| finger_status, |
| x, y, wx, wy, z); |
| |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_POSITION_X, x); |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_POSITION_Y, y); |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_PRESSURE, z); |
| |
| #ifdef REPORT_2D_W |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_TOUCH_MAJOR, max(wx, wy)); |
| input_report_abs(rmi4_data->input_dev, |
| ABS_MT_TOUCH_MINOR, min(wx, wy)); |
| #endif |
| #ifndef TYPE_B_PROTOCOL |
| input_mt_sync(rmi4_data->input_dev); |
| #endif |
| touch_count++; |
| } |
| } |
| |
| end: |
| #ifndef TYPE_B_PROTOCOL |
| if (!touch_count) |
| input_mt_sync(rmi4_data->input_dev); |
| #endif |
| |
| input_sync(rmi4_data->input_dev); |
| |
| return touch_count; |
| } |
| |
| static void synaptics_rmi4_f1a_report(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler) |
| { |
| int retval; |
| unsigned char button; |
| unsigned char index; |
| unsigned char shift; |
| unsigned char status; |
| unsigned char *data; |
| unsigned short data_addr = fhandler->full_addr.data_base; |
| struct synaptics_rmi4_f1a_handle *f1a = fhandler->data; |
| static bool current_status[MAX_NUMBER_OF_BUTTONS]; |
| #ifdef NO_0D_WHILE_2D |
| static bool before_2d_status[MAX_NUMBER_OF_BUTTONS]; |
| static bool while_2d_status[MAX_NUMBER_OF_BUTTONS]; |
| #endif |
| |
| if (tsb_buff_clean_flag) { |
| memset(current_status, 0, sizeof(current_status)); |
| #ifdef NO_0D_WHILE_2D |
| memset(before_2d_status, 0, sizeof(before_2d_status)); |
| memset(while_2d_status, 0, sizeof(while_2d_status)); |
| #endif |
| tsb_buff_clean_flag = 0; |
| } |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| data_addr, |
| f1a->button_data_buffer, |
| f1a->button_bitmask_size); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to read button data registers\n", |
| __func__); |
| return; |
| } |
| |
| if (atomic_read(&rmi4_data->panel_off_flag)) |
| return; |
| |
| data = f1a->button_data_buffer; |
| |
| for (button = 0; button < f1a->valid_button_count; button++) { |
| index = button / 8; |
| shift = button % 8; |
| status = ((data[index] >> shift) & MASK_1BIT); |
| |
| if (current_status[button] == status) |
| continue; |
| else |
| current_status[button] = status; |
| |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Button %d (code %d) ->%d\n", |
| __func__, button, |
| f1a->button_map[button], |
| status); |
| #ifdef NO_0D_WHILE_2D |
| if (rmi4_data->fingers_on_2d == false) { |
| if (status == 1) { |
| before_2d_status[button] = 1; |
| } else { |
| if (while_2d_status[button] == 1) { |
| while_2d_status[button] = 0; |
| continue; |
| } else { |
| before_2d_status[button] = 0; |
| } |
| } |
| input_report_key(rmi4_data->input_dev, |
| f1a->button_map[button], |
| status); |
| } else { |
| if (before_2d_status[button] == 1) { |
| before_2d_status[button] = 0; |
| input_report_key(rmi4_data->input_dev, |
| f1a->button_map[button], |
| status); |
| } else { |
| if (status == 1) |
| while_2d_status[button] = 1; |
| else |
| while_2d_status[button] = 0; |
| } |
| } |
| #else |
| input_report_key(rmi4_data->input_dev, |
| f1a->button_map[button], |
| status); |
| #endif |
| } |
| |
| input_sync(rmi4_data->input_dev); |
| |
| return; |
| } |
| |
| static void synaptics_rmi4_f01_handler(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler) |
| { |
| int retval; |
| unsigned short data_addr = fhandler->full_addr.data_base; |
| struct synaptics_rmi4_f01_device_status status; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| data_addr, |
| status.data, |
| sizeof(status.data)); |
| if (retval < 0) |
| return; |
| |
| switch (status.status_code) { |
| case 0x00: |
| printk(KERN_INFO "%s: No error.\n", __func__); |
| break; |
| |
| case 0x01: |
| printk(KERN_INFO "%s: Touch IC reset complete.\n", __func__); |
| break; |
| |
| case 0x02: |
| printk(KERN_ERR "%s: Touch IC configuration error--%s.\n", |
| __func__, "check platform settings"); |
| break; |
| |
| case 0x03: |
| printk(KERN_ERR "%s: Touch IC device failure.\n", __func__); |
| break; |
| |
| case 0x04: |
| printk(KERN_ERR "%s: Configuration CRC failure.\n", __func__); |
| break; |
| |
| case 0x05: |
| printk(KERN_ERR "%s: Firmware CRC failure.\n", __func__); |
| break; |
| |
| case 0x06: |
| printk(KERN_ERR "%s: CRC in progress.\n", __func__); |
| break; |
| |
| default: |
| printk(KERN_ERR "%s: Unknown error 0x%02X received.\n", |
| __func__, status.status_code); |
| break; |
| } |
| } |
| |
| /** |
| * synaptics_rmi4_report_touch() |
| * |
| * Called by synaptics_rmi4_sensor_report(). |
| * |
| * This function calls the appropriate finger data reporting function |
| * based on the function handler it receives and returns the number of |
| * fingers detected. |
| */ |
| static void synaptics_rmi4_report_touch(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler, |
| unsigned char *touch_count) |
| { |
| unsigned char touch_count_2d; |
| |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Function %02x reporting\n", |
| __func__, fhandler->fn_number); |
| |
| switch (fhandler->fn_number) { |
| case SYNAPTICS_RMI4_F01: |
| synaptics_rmi4_f01_handler(rmi4_data, fhandler); |
| break; |
| |
| case SYNAPTICS_RMI4_F11: |
| touch_count_2d = synaptics_rmi4_f11_abs_report(rmi4_data, |
| fhandler); |
| |
| *touch_count += touch_count_2d; |
| |
| if (touch_count_2d) |
| rmi4_data->fingers_on_2d = true; |
| else |
| rmi4_data->fingers_on_2d = false; |
| break; |
| |
| case SYNAPTICS_RMI4_F12: |
| touch_count_2d = synaptics_rmi4_f12_abs_report(rmi4_data, |
| fhandler); |
| |
| *touch_count += touch_count_2d; |
| |
| if (touch_count_2d) |
| rmi4_data->fingers_on_2d = true; |
| else |
| rmi4_data->fingers_on_2d = false; |
| break; |
| |
| case SYNAPTICS_RMI4_F1A: |
| synaptics_rmi4_f1a_report(rmi4_data, fhandler); |
| break; |
| |
| default: |
| break; |
| } |
| |
| return; |
| } |
| |
| /** |
| * synaptics_rmi4_sensor_report() |
| * |
| * Called by synaptics_rmi4_irq(). |
| * |
| * This function determines the interrupt source(s) from the sensor |
| * and calls synaptics_rmi4_report_touch() with the appropriate |
| * function handler for each function with valid data inputs. |
| */ |
| static int synaptics_rmi4_sensor_report(struct synaptics_rmi4_data *rmi4_data) |
| { |
| int retval; |
| unsigned char touch_count = 0; |
| unsigned char intr[MAX_INTR_REGISTERS]; |
| unsigned int intr_status_mask; |
| struct synaptics_rmi4_fn *fhandler; |
| struct synaptics_rmi4_exp_fn *exp_fhandler; |
| struct synaptics_rmi4_device_info *rmi; |
| |
| rmi = &(rmi4_data->rmi4_mod_info); |
| |
| /* |
| * Get interrupt status information from F01 Data1 register to |
| * determine the source(s) that are flagging the interrupt. |
| */ |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_data_base_addr + 1, |
| intr, |
| rmi4_data->num_of_intr_regs); |
| if (retval < 0) |
| return retval; |
| |
| /* |
| * Traverse the function handler list and service the source(s) |
| * of the interrupt accordingly. |
| */ |
| list_for_each_entry(fhandler, &rmi->support_fn_list, link) { |
| if (fhandler->num_of_data_sources) { |
| if (fhandler->intr_mask & |
| intr[fhandler->intr_reg_num]) { |
| synaptics_rmi4_report_touch(rmi4_data, |
| fhandler, &touch_count); |
| } |
| } |
| } |
| |
| batohui(&intr_status_mask, intr, rmi4_data->num_of_intr_regs); |
| /* |
| * Go through external handlers list only when interrupt |
| * is not handled by currently active internal functions. |
| */ |
| if (intr_status_mask & (~rmi4_data->active_fn_intr_mask)) { |
| mutex_lock(&exp_fn_ctrl.list_mutex); |
| if (!list_empty(&exp_fn_ctrl.fn_list)) { |
| list_for_each_entry(exp_fhandler, |
| &exp_fn_ctrl.fn_list, link) { |
| if (exp_fhandler->inserted && |
| (exp_fhandler->func_attn != NULL)) |
| exp_fhandler->func_attn( |
| rmi4_data, intr[0]); |
| } |
| } |
| mutex_unlock(&exp_fn_ctrl.list_mutex); |
| } |
| |
| return touch_count; |
| } |
| |
| /** |
| * synaptics_rmi4_irq() |
| * |
| * Called by the kernel when an interrupt occurs (when the sensor |
| * asserts the attention irq). |
| * |
| * This function is the ISR thread and handles the acquisition |
| * and the reporting of finger data when the presence of fingers |
| * is detected. |
| */ |
| static irqreturn_t synaptics_rmi4_irq(int irq, void *data) |
| { |
| struct synaptics_rmi4_data *rmi4_data = data; |
| struct synaptics_rmi4_resume_info *tmp_resume_i; |
| struct synaptics_rmi4_irq_info *tmp_q; |
| |
| if (rmi4_data->number_irq > 0) { |
| rmi4_data->last_irq++; |
| if (rmi4_data->last_irq >= rmi4_data->number_irq) |
| rmi4_data->last_irq = 0; |
| tmp_q = |
| &(rmi4_data->irq_info[rmi4_data->last_irq]); |
| getnstimeofday(&(tmp_q->irq_time)); |
| } |
| |
| if (rmi4_data->number_resumes > 0) { |
| tmp_resume_i = |
| &(rmi4_data->resume_info[rmi4_data->last_resume]); |
| if (tmp_resume_i->isr.tv_sec == 0) |
| getnstimeofday(&(tmp_resume_i->isr)); |
| } |
| |
| synaptics_rmi4_sensor_report(rmi4_data); |
| |
| return IRQ_HANDLED; |
| } |
| |
| /** |
| * synaptics_rmi4_irq_enable() |
| * |
| * Called by synaptics_rmi4_probe() and the power management functions |
| * in this driver and also exported to other expansion Function modules |
| * such as rmi_dev. |
| * |
| * This function handles the enabling and disabling of the attention |
| * irq including the setting up of the ISR thread. |
| */ |
| static int synaptics_rmi4_irq_enable(struct synaptics_rmi4_data *rmi4_data, |
| bool enable) |
| { |
| int retval = 0; |
| unsigned char intr_status; |
| const struct synaptics_dsx_platform_data *platform_data = |
| rmi4_data->board; |
| |
| if (enable) { |
| if (rmi4_data->irq_enabled) |
| return retval; |
| |
| /* Clear interrupts first */ |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_data_base_addr + 1, |
| &intr_status, |
| rmi4_data->num_of_intr_regs); |
| if (retval < 0) |
| return retval; |
| |
| retval = request_threaded_irq(rmi4_data->irq, NULL, |
| synaptics_rmi4_irq, platform_data->irq_flags, |
| DRIVER_NAME, rmi4_data); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to create irq thread\n", |
| __func__); |
| return retval; |
| } |
| |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Started irq thread\n", __func__); |
| |
| rmi4_data->irq_enabled = true; |
| } else { |
| if (rmi4_data->irq_enabled) { |
| disable_irq(rmi4_data->irq); |
| free_irq(rmi4_data->irq, rmi4_data); |
| rmi4_data->irq_enabled = false; |
| |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Stopped irq thread\n", __func__); |
| } |
| } |
| |
| return retval; |
| } |
| |
| /** |
| * synaptics_rmi4_f11_init() |
| * |
| * Called by synaptics_rmi4_query_device(). |
| * |
| * This funtion parses information from the Function 11 registers |
| * and determines the number of fingers supported, x and y data ranges, |
| * offset to the associated interrupt status register, interrupt bit |
| * mask, and gathers finger data acquisition capabilities from the query |
| * registers. |
| */ |
| static int synaptics_rmi4_f11_init(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler, |
| struct synaptics_rmi4_fn_desc *fd, |
| unsigned int intr_count) |
| { |
| int retval; |
| unsigned char ii; |
| unsigned char intr_offset; |
| unsigned char abs_data_size; |
| unsigned char abs_data_blk_size; |
| unsigned char query[F11_STD_QUERY_LEN]; |
| unsigned char control[F11_STD_CTRL_LEN]; |
| |
| fhandler->fn_number = fd->fn_number; |
| fhandler->num_of_data_sources = (fd->intr_src_count & MASK_3BIT); |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| fhandler->full_addr.query_base, |
| query, |
| sizeof(query)); |
| if (retval < 0) |
| return retval; |
| |
| /* Maximum number of fingers supported */ |
| if ((query[1] & MASK_3BIT) <= 4) |
| fhandler->num_of_data_points = (query[1] & MASK_3BIT) + 1; |
| else if ((query[1] & MASK_3BIT) == 5) |
| fhandler->num_of_data_points = 10; |
| |
| rmi4_data->num_of_fingers = fhandler->num_of_data_points; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| fhandler->full_addr.ctrl_base, |
| control, |
| sizeof(control)); |
| if (retval < 0) |
| return retval; |
| |
| /* Maximum x and y */ |
| rmi4_data->sensor_max_x = ((control[6] & MASK_8BIT) << 0) | |
| ((control[7] & MASK_4BIT) << 8); |
| rmi4_data->sensor_max_y = ((control[8] & MASK_8BIT) << 0) | |
| ((control[9] & MASK_4BIT) << 8); |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Function %02x max x = %d max y = %d\n", |
| __func__, fhandler->fn_number, |
| rmi4_data->sensor_max_x, |
| rmi4_data->sensor_max_y); |
| |
| /* Reporting mode */ |
| if (!(control[0] & MASK_3BIT)) { |
| pr_warn("Reporting mode: continuous\n"); |
| } else { |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: thresholds: x=0x%x, y=0x%x\n", |
| __func__, control[2], control[3]); |
| /* Delta thresholds */ |
| if (control[2] > F11_DELTA_MAX) |
| pr_warn("excessive x threshold: 0x%x\n", control[2]); |
| if (control[3] > F11_DELTA_MAX) |
| pr_warn("excessive y threshold: 0x%x\n", control[3]); |
| } |
| |
| fhandler->intr_reg_num = (intr_count + 7) / 8; |
| if (fhandler->intr_reg_num != 0) |
| fhandler->intr_reg_num -= 1; |
| |
| /* Set an enable bit for each data source */ |
| intr_offset = intr_count % 8; |
| fhandler->intr_mask = 0; |
| for (ii = intr_offset; |
| ii < ((fd->intr_src_count & MASK_3BIT) + |
| intr_offset); |
| ii++) |
| fhandler->intr_mask |= 1 << ii; |
| |
| abs_data_size = query[5] & MASK_2BIT; |
| abs_data_blk_size = 3 + (2 * (abs_data_size == 0 ? 1 : 0)); |
| fhandler->size_of_data_register_block = abs_data_blk_size; |
| |
| #ifdef INPUT_PROP_DIRECT |
| set_bit(INPUT_PROP_DIRECT, rmi4_data->input_dev->propbit); |
| #endif |
| set_bit(EV_ABS, rmi4_data->input_dev->evbit); |
| |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_POSITION_X, 0, |
| rmi4_data->sensor_max_x, 0, 0); |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_POSITION_Y, 0, |
| rmi4_data->sensor_max_y, 0, 0); |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_PRESSURE, 0, |
| 255, 0, 0); |
| #ifdef REPORT_2D_W |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_TOUCH_MAJOR, 0, |
| 15, 0, 0); |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_TOUCH_MINOR, 0, |
| 15, 0, 0); |
| #endif |
| #ifdef TYPE_B_PROTOCOL |
| input_mt_init_slots(rmi4_data->input_dev, |
| rmi4_data->num_of_fingers); |
| #else |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_TRACKING_ID, 0, |
| rmi4_data->num_of_fingers - 1, 0, 0); |
| input_set_events_per_packet(rmi4_data->input_dev, 64); |
| #endif |
| |
| return retval; |
| } |
| |
| static int synaptics_rmi4_f1a_alloc_mem(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler) |
| { |
| int retval; |
| struct synaptics_rmi4_f1a_handle *f1a; |
| |
| f1a = kzalloc(sizeof(*f1a), GFP_KERNEL); |
| if (!f1a) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to alloc mem for function handle\n", |
| __func__); |
| return -ENOMEM; |
| } |
| |
| fhandler->data = (void *)f1a; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| fhandler->full_addr.query_base, |
| f1a->button_query.data, |
| sizeof(f1a->button_query.data)); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to read query registers\n", |
| __func__); |
| return retval; |
| } |
| |
| f1a->button_count = f1a->button_query.max_button_count + 1; |
| f1a->button_bitmask_size = (f1a->button_count + 7) / 8; |
| |
| f1a->button_data_buffer = kcalloc(f1a->button_bitmask_size, |
| sizeof(*(f1a->button_data_buffer)), GFP_KERNEL); |
| if (!f1a->button_data_buffer) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to alloc mem for data buffer\n", |
| __func__); |
| return -ENOMEM; |
| } |
| |
| f1a->button_map = kcalloc(f1a->button_count, |
| sizeof(*(f1a->button_map)), GFP_KERNEL); |
| if (!f1a->button_map) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to alloc mem for button map\n", |
| __func__); |
| return -ENOMEM; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * synaptics_rmi4_f12_init() |
| * |
| * Called by synaptics_rmi4_query_device(). |
| * |
| * This funtion parses information from the Function 12 registers |
| * and determines the number of fingers supported, x and y data ranges, |
| * offset to the associated interrupt status register, interrupt bit |
| * mask, and gathers finger data acquisition capabilities from the query |
| * registers. |
| */ |
| static int synaptics_rmi4_f12_init(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler, |
| struct synaptics_rmi4_fn_desc *fd, |
| unsigned int intr_count) |
| { |
| int retval; |
| unsigned char ii; |
| unsigned char intr_offset; |
| |
| fhandler->fn_number = fd->fn_number; |
| fhandler->num_of_data_sources = (fd->intr_src_count & MASK_3BIT); |
| |
| pr_debug("scan F12 ctrl registers\n"); |
| retval = synaptics_rmi4_scan_packet_reg_info( |
| rmi4_data, |
| fhandler->full_addr.query_base + 4, |
| fhandler->full_addr.ctrl_base, |
| &f12_ctrl_regs); |
| if (retval < 0) |
| return retval; |
| |
| retval = synaptics_rmi4_read_packet_regs(rmi4_data, &f12_ctrl_regs); |
| if (retval < 0) |
| return retval; |
| |
| /* Maximum number of fingers supported */ |
| if (f12_c23[1].present) { |
| fhandler->num_of_data_points = |
| f12_c23_1.max_num_reported_objects; |
| rmi4_data->num_of_fingers = f12_c23_1.max_num_reported_objects; |
| } else |
| return -ENOENT; |
| |
| if (f12_c08[0].present) { |
| rmi4_data->sensor_max_x = |
| (f12_c08_0.max_x_msb << 8) | f12_c08_0.max_x_lsb; |
| rmi4_data->sensor_max_y = |
| (f12_c08_0.max_y_msb << 8) | f12_c08_0.max_y_lsb; |
| } else |
| return -ENOENT; |
| |
| fhandler->intr_reg_num = (intr_count + 7) / 8; |
| if (fhandler->intr_reg_num != 0) |
| fhandler->intr_reg_num -= 1; |
| |
| /* Set an enable bit for each data source */ |
| intr_offset = intr_count % 8; |
| fhandler->intr_mask = 0; |
| for (ii = intr_offset; |
| ii < ((fd->intr_src_count & MASK_3BIT) + |
| intr_offset); |
| ii++) |
| fhandler->intr_mask |= 1 << ii; |
| |
| /* Data size per touch */ |
| if (f12_c28[0].present) { |
| for (ii = 0; ii < 8; ii++) |
| if (f12_c28_0.reported_bytes_per_object & (1 << ii)) |
| fhandler->size_of_data_register_block++; |
| } else |
| return -ENOENT; |
| |
| #ifdef INPUT_PROP_DIRECT |
| set_bit(INPUT_PROP_DIRECT, rmi4_data->input_dev->propbit); |
| #endif |
| set_bit(EV_ABS, rmi4_data->input_dev->evbit); |
| |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_POSITION_X, 0, |
| rmi4_data->sensor_max_x, 0, 0); |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_POSITION_Y, 0, |
| rmi4_data->sensor_max_y, 0, 0); |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_PRESSURE, 0, |
| 255, 0, 0); |
| #ifdef REPORT_2D_W |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_TOUCH_MAJOR, 0, |
| 255, 0, 0); |
| #endif |
| input_set_abs_params(rmi4_data->input_dev, |
| ABS_MT_TRACKING_ID, 0, |
| rmi4_data->num_of_fingers - 1, 0, 0); |
| |
| input_set_events_per_packet(rmi4_data->input_dev, 64); |
| |
| return retval; |
| } |
| |
| static int synaptics_rmi4_cap_button_map( |
| struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler) |
| { |
| unsigned char ii; |
| struct synaptics_rmi4_f1a_handle *f1a = fhandler->data; |
| const struct synaptics_dsx_platform_data *pdata = rmi4_data->board; |
| |
| if (!pdata->cap_button_map) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: cap_button_map is \ |
| NULL in board file\n", |
| __func__); |
| return -ENODEV; |
| } else if (!pdata->cap_button_map->map) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Button map is missing in board file\n", |
| __func__); |
| return -ENODEV; |
| } else { |
| if (pdata->cap_button_map->nbuttons != |
| f1a->button_count) { |
| f1a->valid_button_count = min(f1a->button_count, |
| pdata->cap_button_map->nbuttons); |
| } else { |
| f1a->valid_button_count = f1a->button_count; |
| } |
| |
| set_bit(EV_KEY, rmi4_data->input_dev->evbit); |
| |
| for (ii = 0; ii < f1a->valid_button_count; ii++) { |
| f1a->button_map[ii] = |
| pdata->cap_button_map->map[ii]; |
| set_bit(f1a->button_map[ii], |
| rmi4_data->input_dev->keybit); |
| input_set_capability(rmi4_data->input_dev, |
| EV_KEY, f1a->button_map[ii]); |
| } |
| } |
| |
| return 0; |
| } |
| |
| static void synaptics_rmi4_f1a_kfree(struct synaptics_rmi4_fn *fhandler) |
| { |
| struct synaptics_rmi4_f1a_handle *f1a = fhandler->data; |
| |
| if (f1a) { |
| kfree(f1a->button_data_buffer); |
| kfree(f1a->button_map); |
| kfree(f1a); |
| fhandler->data = NULL; |
| } |
| |
| return; |
| } |
| |
| static int synaptics_rmi4_f1a_init(struct synaptics_rmi4_data *rmi4_data, |
| struct synaptics_rmi4_fn *fhandler, |
| struct synaptics_rmi4_fn_desc *fd, |
| unsigned int intr_count) |
| { |
| int retval; |
| unsigned char ii; |
| unsigned short intr_offset; |
| |
| fhandler->fn_number = fd->fn_number; |
| fhandler->num_of_data_sources = (fd->intr_src_count & MASK_3BIT); |
| |
| fhandler->intr_reg_num = (intr_count + 7) / 8; |
| if (fhandler->intr_reg_num != 0) |
| fhandler->intr_reg_num -= 1; |
| |
| /* Set an enable bit for each data source */ |
| intr_offset = intr_count % 8; |
| fhandler->intr_mask = 0; |
| for (ii = intr_offset; |
| ii < ((fd->intr_src_count & MASK_3BIT) + |
| intr_offset); |
| ii++) |
| fhandler->intr_mask |= 1 << ii; |
| |
| retval = synaptics_rmi4_f1a_alloc_mem(rmi4_data, fhandler); |
| if (retval < 0) |
| goto error_exit; |
| |
| retval = synaptics_rmi4_cap_button_map(rmi4_data, fhandler); |
| if (retval < 0) |
| goto error_exit; |
| |
| rmi4_data->button_0d_enabled = 1; |
| |
| return 0; |
| |
| error_exit: |
| synaptics_rmi4_f1a_kfree(fhandler); |
| |
| return retval; |
| } |
| |
| static int synaptics_rmi4_alloc_fh(struct synaptics_rmi4_fn **fhandler, |
| struct synaptics_rmi4_fn_desc *rmi_fd, int page_number) |
| { |
| *fhandler = kzalloc(sizeof(**fhandler), GFP_KERNEL); |
| if (!(*fhandler)) |
| return -ENOMEM; |
| |
| (*fhandler)->full_addr.data_base = |
| (rmi_fd->data_base_addr | |
| (page_number << 8)); |
| (*fhandler)->full_addr.ctrl_base = |
| (rmi_fd->ctrl_base_addr | |
| (page_number << 8)); |
| (*fhandler)->full_addr.cmd_base = |
| (rmi_fd->cmd_base_addr | |
| (page_number << 8)); |
| (*fhandler)->full_addr.query_base = |
| (rmi_fd->query_base_addr | |
| (page_number << 8)); |
| |
| return 0; |
| } |
| |
| /** |
| * synaptics_rmi4_query_device() |
| * |
| * Called by synaptics_rmi4_probe(). |
| * |
| * This funtion scans the page description table, records the offsets |
| * to the register types of Function $01, sets up the function handlers |
| * for Function $11 and Function $12, determines the number of interrupt |
| * sources from the sensor, adds valid Functions with data inputs to the |
| * Function linked list, parses information from the query registers of |
| * Function $01, and enables the interrupt sources from the valid Functions |
| * with data inputs. |
| */ |
| static int synaptics_rmi4_query_device(struct synaptics_rmi4_data *rmi4_data) |
| { |
| int retval; |
| unsigned char page_number; |
| unsigned char intr_count = 0; |
| unsigned char data_sources = 0; |
| unsigned char f01_query[F01_STD_QUERY_LEN] = {0}; |
| unsigned short pdt_entry_addr; |
| struct synaptics_rmi4_fn_desc rmi_fd; |
| struct synaptics_rmi4_fn *fhandler; |
| struct synaptics_rmi4_device_info *rmi; |
| struct f34_properties f34_query; |
| struct synaptics_rmi4_f01_device_status status; |
| |
| rmi = &(rmi4_data->rmi4_mod_info); |
| |
| INIT_LIST_HEAD(&rmi->support_fn_list); |
| |
| /* Scan the page description tables of the pages to service */ |
| for (page_number = 0; page_number < PAGES_TO_SERVICE; page_number++) { |
| for (pdt_entry_addr = PDT_START; pdt_entry_addr > PDT_END; |
| pdt_entry_addr -= PDT_ENTRY_SIZE) { |
| pdt_entry_addr |= (page_number << 8); |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| pdt_entry_addr, |
| (unsigned char *)&rmi_fd, |
| sizeof(rmi_fd)); |
| if (retval < 0) |
| return retval; |
| |
| fhandler = NULL; |
| |
| if (rmi_fd.fn_number == 0) { |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Reached end of PDT\n", |
| __func__); |
| break; |
| } |
| |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: F%02x found (page %d)\n", |
| __func__, rmi_fd.fn_number, |
| page_number); |
| |
| switch (rmi_fd.fn_number) { |
| case SYNAPTICS_RMI4_F34: |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi_fd.query_base_addr + |
| F34_PROPERTIES_OFFSET, |
| &f34_query.data[0], |
| sizeof(f34_query)); |
| if (retval < 0) |
| return retval; |
| |
| if (f34_query.has_config_id) { |
| retval = synaptics_rmi4_i2c_read( |
| rmi4_data, |
| rmi_fd.ctrl_base_addr, |
| rmi->config_id, |
| sizeof(rmi->config_id)); |
| if (retval < 0) |
| return retval; |
| } |
| break; |
| |
| case SYNAPTICS_RMI4_F01: |
| rmi4_data->f01_query_base_addr = |
| rmi_fd.query_base_addr; |
| rmi4_data->f01_ctrl_base_addr = |
| rmi_fd.ctrl_base_addr; |
| rmi4_data->f01_data_base_addr = |
| rmi_fd.data_base_addr; |
| rmi4_data->f01_cmd_base_addr = |
| rmi_fd.cmd_base_addr; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_data_base_addr, |
| status.data, |
| sizeof(status.data)); |
| if (retval < 0) |
| return retval; |
| |
| synaptics_rmi4_sensor_multi_touch( |
| rmi4_data, SYNAPTICS_RMI4_F01); |
| |
| rmi4_data->in_bootloader = |
| status.flash_prog == 1; |
| break; |
| |
| case SYNAPTICS_RMI4_F11: |
| if (rmi_fd.intr_src_count == 0) |
| break; |
| |
| retval = synaptics_rmi4_alloc_fh(&fhandler, |
| &rmi_fd, page_number); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to alloc for F%d\n", |
| __func__, |
| rmi_fd.fn_number); |
| return retval; |
| } |
| |
| retval = synaptics_rmi4_f11_init(rmi4_data, |
| fhandler, &rmi_fd, intr_count); |
| if (retval < 0) |
| return retval; |
| break; |
| |
| case SYNAPTICS_RMI4_F12: |
| if (rmi_fd.intr_src_count == 0) |
| break; |
| |
| retval = synaptics_rmi4_alloc_fh(&fhandler, |
| &rmi_fd, page_number); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to alloc for F%d\n", |
| __func__, |
| rmi_fd.fn_number); |
| return retval; |
| } |
| |
| retval = synaptics_rmi4_f12_init(rmi4_data, |
| fhandler, &rmi_fd, intr_count); |
| if (retval < 0) |
| return retval; |
| |
| synaptics_rmi4_sensor_multi_touch( |
| rmi4_data, SYNAPTICS_RMI4_F12); |
| break; |
| |
| case SYNAPTICS_RMI4_F1A: |
| if (rmi_fd.intr_src_count == 0) |
| break; |
| |
| retval = synaptics_rmi4_alloc_fh(&fhandler, |
| &rmi_fd, page_number); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to alloc for F%d\n", |
| __func__, |
| rmi_fd.fn_number); |
| return retval; |
| } |
| |
| retval = synaptics_rmi4_f1a_init(rmi4_data, |
| fhandler, &rmi_fd, intr_count); |
| switch (retval) { |
| case -ENOMEM: |
| return retval; |
| case -ENODEV: |
| /* removing buttons handler if there */ |
| /* were no key codes in platform data */ |
| kfree(fhandler); |
| fhandler = NULL; |
| rmi_fd.intr_src_count = 0; |
| break; |
| } |
| break; |
| } |
| |
| /* Accumulate the interrupt count */ |
| intr_count += (rmi_fd.intr_src_count & MASK_3BIT); |
| |
| if (fhandler && rmi_fd.intr_src_count) { |
| list_add_tail(&fhandler->link, |
| &rmi->support_fn_list); |
| } |
| } |
| } |
| |
| rmi4_data->num_of_intr_regs = (intr_count + 7) / 8; |
| dev_dbg(&rmi4_data->i2c_client->dev, |
| "%s: Number of interrupt registers = %d\n", |
| __func__, rmi4_data->num_of_intr_regs); |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_query_base_addr, |
| f01_query, |
| sizeof(f01_query)); |
| if (retval < 0) |
| return retval; |
| |
| /* RMI Version 4.0 currently supported */ |
| rmi->version_major = 4; |
| rmi->version_minor = 0; |
| |
| rmi->manufacturer_id = f01_query[0]; |
| rmi->product_props = f01_query[1]; |
| memcpy(&rmi->product_info[0], &f01_query[2], |
| SYNAPTICS_RMI4_PRODUCT_INFO_SIZE); |
| memcpy(rmi->serial, &f01_query[4], SYNAPTICS_RMI4_SERIAL_SIZE); |
| memcpy(rmi->product_id_string, &f01_query[11], |
| SYNAPTICS_RMI4_PRODUCT_ID_SIZE); |
| rmi->product_id_string[SYNAPTICS_RMI4_PRODUCT_ID_SIZE] = 0; |
| |
| /* handle wrongfully programmed product id strings here */ |
| synaptics_dsx_darn_product_string(rmi->product_id_string, |
| SYNAPTICS_RMI4_PRODUCT_ID_SIZE); |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_query_base_addr+PACKAGE_ID_OFFSET, |
| rmi->package_id, |
| sizeof(rmi->package_id)); |
| if (retval < 0) |
| return retval; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_query_base_addr+FW_VERSION_OFFSET, |
| rmi->build_id, |
| sizeof(rmi->build_id)); |
| if (retval < 0) |
| return retval; |
| |
| if (rmi->manufacturer_id != 1) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Non-Synaptics device found, manufacturer ID = %d\n", |
| __func__, rmi->manufacturer_id); |
| } |
| |
| if (!rmi4_data->in_bootloader && !rmi4_data->input_registered) { |
| retval = input_register_device(rmi4_data->input_dev); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to register input device\n", |
| __func__); |
| return retval; |
| } |
| rmi4_data->input_registered = true; |
| } |
| |
| memset(rmi4_data->intr_mask, 0x00, sizeof(rmi4_data->intr_mask)); |
| |
| /* |
| * Map out the interrupt bit masks for the interrupt sources |
| * from the registered function handlers. |
| */ |
| list_for_each_entry(fhandler, &rmi->support_fn_list, link) |
| data_sources += fhandler->num_of_data_sources; |
| if (data_sources) { |
| list_for_each_entry(fhandler, &rmi->support_fn_list, link) { |
| if (fhandler->num_of_data_sources) { |
| rmi4_data->intr_mask[fhandler->intr_reg_num] |= |
| fhandler->intr_mask; |
| } |
| } |
| } |
| |
| /* interrupt mask for currently active functions */ |
| batohui(&rmi4_data->active_fn_intr_mask, |
| rmi4_data->intr_mask, rmi4_data->num_of_intr_regs); |
| pr_debug("active func intr_mask 0x%x\n", |
| rmi4_data->active_fn_intr_mask); |
| |
| if (rmi4_data->in_bootloader) |
| pr_info("Product: %s is in bootloader mode\n", |
| rmi->product_id_string); |
| else { |
| unsigned int config_id, firmware_id; |
| |
| batohui(&firmware_id, rmi->build_id, sizeof(rmi->build_id)); |
| batohui(&config_id, rmi->config_id, sizeof(config_id)); |
| pr_info("Product: %s, firmware id: %x, config id: %08x\n", |
| rmi->product_id_string, firmware_id, config_id); |
| } |
| |
| return 0; |
| } |
| |
| static void synaptics_rmi4_cleanup(struct synaptics_rmi4_data *rmi4_data) |
| { |
| struct synaptics_rmi4_fn *fhandler, *next_list_entry; |
| struct synaptics_rmi4_device_info *rmi; |
| |
| rmi = &(rmi4_data->rmi4_mod_info); |
| |
| list_for_each_entry_safe(fhandler, next_list_entry, |
| &rmi->support_fn_list, link) { |
| if (fhandler->fn_number == SYNAPTICS_RMI4_F1A) |
| synaptics_rmi4_f1a_kfree(fhandler); |
| else |
| kfree(fhandler->data); |
| list_del(&fhandler->link); |
| kfree(fhandler); |
| } |
| } |
| |
| static void synaptics_dsx_on_resume(struct synaptics_rmi4_data *rmi4_data) |
| { |
| /* |
| * Enforce touch release event report to work-around such event |
| * missing while touch IC is off. |
| */ |
| #ifdef TYPE_B_PROTOCOL |
| int i; |
| for (i = 0; i < rmi4_data->num_of_fingers; i++) { |
| input_mt_slot(rmi4_data->input_dev, i); |
| input_mt_report_slot_state(rmi4_data->input_dev, |
| MT_TOOL_FINGER, false); |
| } |
| #else |
| input_mt_sync(rmi4_data->input_dev); |
| #endif |
| input_sync(rmi4_data->input_dev); |
| |
| /* reset some TSB global vars like fingers_on_2d after resume |
| * of reset touch IC |
| */ |
| if (rmi4_data->button_0d_enabled) { |
| tsb_buff_clean_flag = 1; |
| rmi4_data->fingers_on_2d = false; |
| } |
| } |
| |
| static int synaptics_rmi4_reset_device(struct synaptics_rmi4_data *rmi4_data, |
| unsigned char *f01_cmd_base_addr) |
| { |
| int current_state, retval; |
| bool need_to_query = false; |
| unsigned char command = 0x01; |
| |
| current_state = synaptics_dsx_get_state_safe(rmi4_data); |
| if (current_state == STATE_UNKNOWN) { |
| synaptics_rmi4_cleanup(rmi4_data); |
| |
| if (rmi4_data->input_registered) { |
| input_unregister_device(rmi4_data->input_dev); |
| rmi4_data->input_dev = NULL; |
| rmi4_data->input_registered = false; |
| |
| pr_debug("de-allocated input device\n"); |
| } |
| need_to_query = true; |
| } |
| |
| if (rmi4_data->hw_reset) |
| /* do hard reset instead of soft */ |
| synaptics_dsx_ic_reset(rmi4_data, true); |
| else { |
| retval = synaptics_rmi4_i2c_write(rmi4_data, |
| f01_cmd_base_addr ? *f01_cmd_base_addr : |
| rmi4_data->f01_cmd_base_addr, |
| &command, |
| sizeof(command)); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to issue reset command, error = %d\n", |
| __func__, retval); |
| return retval; |
| } |
| msleep(100); |
| } |
| |
| if (need_to_query) { |
| if (!rmi4_data->input_dev) { |
| retval = synaptics_dsx_alloc_input(rmi4_data); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to allocate input device\n", |
| __func__); |
| return retval; |
| } |
| } |
| |
| retval = synaptics_rmi4_query_device(rmi4_data); |
| if (retval < 0) { |
| dev_err(&rmi4_data->i2c_client->dev, |
| "%s: Failed to query device\n", |
| __func__); |
| return retval; |
| } |
| /* kick off detection work after touch ic changes its mode */ |
| if (exp_fn_ctrl.det_workqueue) |
| queue_delayed_work(exp_fn_ctrl.det_workqueue, |
| &exp_fn_ctrl.det_work, 0); |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * synaptics_rmi4_detection_work() |
| * |
| * Called by the kernel at the scheduled time. |
| * |
| * This function is armed by synaptics_new_function call. It checks for |
| * the insertion and removal of other expansion Function modules such as |
| * rmi_dev and calls their initialization and removal callback functions |
| * accordingly. |
| */ |
| static void synaptics_rmi4_detection_work(struct work_struct *work) |
| { |
| struct synaptics_rmi4_exp_fn *exp_fhandler, *next_list_entry; |
| struct synaptics_rmi4_data *rmi4_data; |
| int state; |
| |
| mutex_lock(&exp_fn_ctrl_mutex); |
| rmi4_data = exp_fn_ctrl.rmi4_data_ptr; |
| mutex_unlock(&exp_fn_ctrl_mutex); |
| |
| if (rmi4_data == NULL) { |
| if (exp_fn_ctrl.det_workqueue) |
| queue_delayed_work(exp_fn_ctrl.det_workqueue, |
| &exp_fn_ctrl.det_work, |
| msecs_to_jiffies(EXP_FN_DET_INTERVAL)); |
| return; |
| } |
| |
| mutex_lock(&exp_fn_ctrl.list_mutex); |
| if (list_empty(&exp_fn_ctrl.fn_list)) |
| goto release_mutex; |
| |
| list_for_each_entry_safe(exp_fhandler, |
| next_list_entry, |
| &exp_fn_ctrl.fn_list, |
| link) { |
| if ((exp_fhandler->func_init != NULL) && |
| (exp_fhandler->inserted == false)) { |
| if (rmi4_data->in_bootloader && |
| (exp_fhandler->mode == IC_MODE_UI)) |
| continue; |
| if (rmi4_data->sensor_sleep) |
| synaptics_rmi4_sensor_wake(rmi4_data); |
| exp_fhandler->func_init(rmi4_data); |
| state = synaptics_dsx_get_state_safe(rmi4_data); |
| if (state == STATE_STANDBY) |
| synaptics_rmi4_sensor_sleep(rmi4_data); |
| exp_fhandler->inserted = true; |
| } else if ((exp_fhandler->func_init == NULL) && |
| (exp_fhandler->inserted == true)) { |
| exp_fhandler->func_remove(rmi4_data); |
| list_del(&exp_fhandler->link); |
| kfree(exp_fhandler); |
| } |
| } |
| |
| release_mutex: |
| mutex_unlock(&exp_fn_ctrl.list_mutex); |
| |
| return; |
| } |
| |
| /** |
| * synaptics_rmi4_new_function() |
| * |
| * Called by other expansion Function modules in their module init and |
| * module exit functions. |
| * |
| * This function is used by other expansion Function modules such as |
| * rmi_dev to register themselves with the driver by providing their |
| * initialization and removal callback function pointers so that they |
| * can be inserted or removed dynamically at module init and exit times, |
| * respectively. |
| */ |
| void synaptics_rmi4_new_function(enum exp_fn fn_type, bool insert, |
| int (*func_init)(struct synaptics_rmi4_data *rmi4_data), |
| void (*func_remove)(struct synaptics_rmi4_data *rmi4_data), |
| void (*func_attn)(struct synaptics_rmi4_data *rmi4_data, |
| unsigned char intr_mask), enum ic_modes mode) |
| { |
| struct synaptics_rmi4_exp_fn *exp_fhandler; |
| |
| mutex_lock(&exp_fn_ctrl_mutex); |
| if (!exp_fn_ctrl.inited) { |
| mutex_init(&exp_fn_ctrl.list_mutex); |
| INIT_LIST_HEAD(&exp_fn_ctrl.fn_list); |
| exp_fn_ctrl.det_workqueue = |
| create_singlethread_workqueue("rmi_det_workqueue"); |
| if (IS_ERR_OR_NULL(exp_fn_ctrl.det_workqueue)) |
| pr_err("unable to create a workqueue\n"); |
| INIT_DELAYED_WORK(&exp_fn_ctrl.det_work, |
| synaptics_rmi4_detection_work); |
| exp_fn_ctrl.inited = true; |
| } |
| mutex_unlock(&exp_fn_ctrl_mutex); |
| |
| mutex_lock(&exp_fn_ctrl.list_mutex); |
| if (insert) { |
| exp_fhandler = kzalloc(sizeof(*exp_fhandler), GFP_KERNEL); |
| if (!exp_fhandler) { |
| pr_err("failed to alloc mem for expansion function\n"); |
| goto exit; |
| } |
| exp_fhandler->fn_type = fn_type; |
| exp_fhandler->func_init = func_init; |
| exp_fhandler->func_attn = func_attn; |
| exp_fhandler->func_remove = func_remove; |
| exp_fhandler->inserted = false; |
| exp_fhandler->mode = mode; |
| list_add_tail(&exp_fhandler->link, &exp_fn_ctrl.fn_list); |
| } else { |
| list_for_each_entry(exp_fhandler, &exp_fn_ctrl.fn_list, link) { |
| if (exp_fhandler->func_init == func_init) { |
| exp_fhandler->inserted = false; |
| exp_fhandler->func_init = NULL; |
| exp_fhandler->func_attn = NULL; |
| goto exit; |
| } |
| } |
| } |
| |
| exit: |
| mutex_unlock(&exp_fn_ctrl.list_mutex); |
| if (exp_fn_ctrl.det_workqueue) |
| queue_delayed_work(exp_fn_ctrl.det_workqueue, |
| &exp_fn_ctrl.det_work, 0); |
| return; |
| } |
| EXPORT_SYMBOL(synaptics_rmi4_new_function); |
| |
| /** |
| * synaptics_rmi4_probe() |
| * |
| * Called by the kernel when an association with an I2C device of the |
| * same name is made (after doing i2c_add_driver). |
| * |
| * This funtion allocates and initializes the resources for the driver |
| * as an input driver, turns on the power to the sensor, queries the |
| * sensor for its supported Functions and characteristics, registers |
| * the driver to the input subsystem, sets up the interrupt, and creates |
| * a work queue for detection of other expansion Function modules. |
| */ |
| static int __devinit synaptics_rmi4_probe(struct i2c_client *client, |
| const struct i2c_device_id *dev_id) |
| { |
| int retval; |
| unsigned char attr_count; |
| struct synaptics_rmi4_data *rmi4_data; |
| struct synaptics_rmi4_device_info *rmi; |
| struct synaptics_dsx_platform_data *platform_data; |
| |
| if (!i2c_check_functionality(client->adapter, |
| I2C_FUNC_SMBUS_BYTE_DATA)) { |
| dev_err(&client->dev, |
| "%s: SMBus byte data not supported\n", |
| __func__); |
| return -EIO; |
| } |
| |
| rmi4_data = kzalloc(sizeof(*rmi4_data), GFP_KERNEL); |
| if (!rmi4_data) { |
| dev_err(&client->dev, |
| "%s: Failed to alloc mem for rmi4_data\n", |
| __func__); |
| return -ENOMEM; |
| } |
| |
| platform_data = synaptics_dsx_of_init(client); |
| if (!platform_data) { |
| dev_err(&client->dev, |
| "%s: No platform data found\n", |
| __func__); |
| kfree(rmi4_data); |
| return -EINVAL; |
| } |
| |
| rmi4_data->purge_enabled = platform_data->purge_enabled; |
| rmi4_data->reset_on_resume = platform_data->reset_on_resume; |
| rmi4_data->one_touch_enabled = platform_data->one_touch_enabled; |
| rmi4_data->normal_mode = platform_data->normal_mode; |
| rmi4_data->hw_reset = platform_data->hw_reset; |
| |
| rmi = &(rmi4_data->rmi4_mod_info); |
| |
| rmi4_data->i2c_client = client; |
| rmi4_data->current_page = MASK_8BIT; |
| rmi4_data->board = platform_data; |
| rmi4_data->touch_stopped = false; |
| rmi4_data->sensor_sleep = false; |
| rmi4_data->irq_enabled = false; |
| |
| rmi4_data->i2c_read = synaptics_rmi4_i2c_read; |
| rmi4_data->i2c_write = synaptics_rmi4_i2c_write; |
| rmi4_data->set_state = synaptics_dsx_sensor_state; |
| rmi4_data->ready_state = synaptics_dsx_sensor_ready_state; |
| rmi4_data->irq_enable = synaptics_rmi4_irq_enable; |
| rmi4_data->reset_device = synaptics_rmi4_reset_device; |
| |
| /* Initialize some resume debug information */ |
| rmi4_data->resume_info = kzalloc( |
| sizeof(struct synaptics_rmi4_resume_info) * |
| MAX_NUMBER_TRACKED_RESUMES, |
| GFP_KERNEL); |
| if (!rmi4_data->resume_info) { |
| dev_err(&client->dev, |
| "%s: Failed to allocate memory for resume information\n", |
| __func__); |
| rmi4_data->number_resumes = 0; |
| } else |
| rmi4_data->number_resumes = MAX_NUMBER_TRACKED_RESUMES; |
| rmi4_data->last_resume = -1; |
| |
| /* Initialize some interrupit timing debug information */ |
| rmi4_data->irq_info = kzalloc( |
| sizeof(struct synaptics_rmi4_irq_info) * |
| MAX_NUMBER_TRACKED_IRQS, |
| GFP_KERNEL); |
| if (!rmi4_data->irq_info) { |
| dev_err(&client->dev, |
| "%s: Failed to allocate memory for IRQ debug information\n", |
| __func__); |
| rmi4_data->number_irq = 0; |
| } else |
| rmi4_data->number_irq = MAX_NUMBER_TRACKED_IRQS; |
| rmi4_data->last_irq = -1; |
| |
| mutex_init(&(rmi4_data->rmi4_io_ctrl_mutex)); |
| mutex_init(&(rmi4_data->state_mutex)); |
| |
| if (platform_data->gpio_config) |
| retval = platform_data->gpio_config(platform_data, true); |
| else { |
| retval = gpio_request(platform_data->reset_gpio, |
| RESET_GPIO_NAME); |
| if (!retval) |
| retval = gpio_direction_output( |
| platform_data->reset_gpio, 1); |
| } |
| if (retval < 0) { |
| dev_err(&client->dev, |
| "%s: Failed to configure GPIO\n", |
| __func__); |
| goto err_input_device; |
| } |
| |
| /* get irq number initialized before calling reset */ |
| rmi4_data->irq = gpio_to_irq(platform_data->irq_gpio); |
| |
| i2c_set_clientdata(client, rmi4_data); |
| |
| retval = synaptics_dsx_alloc_input(rmi4_data); |
| if (retval < 0) { |
| dev_err(&client->dev, |
| "%s: Failed to allocate input device\n", |
| __func__); |
| goto err_input_device; |
| } |
| |
| rmi4_data->regulator = regulator_get(&client->dev, "touch_vdd"); |
| if (IS_ERR(rmi4_data->regulator)) { |
| dev_err(&client->dev, |
| "%s: Failed to get regulator\n", |
| __func__); |
| } else { |
| platform_data->regulator_en = true; |
| regulator_enable(rmi4_data->regulator); |
| pr_debug("touch-vdd regulator is %s\n", |
| regulator_is_enabled(rmi4_data->regulator) ? |
| "on" : "off"); |
| } |
| |
| retval = synaptics_dsx_ic_reset(rmi4_data, true); |
| if (retval > 0) |
| pr_debug("successful reset took %dms\n", retval); |
| |
| retval = synaptics_rmi4_query_device(rmi4_data); |
| if (retval < 0) { |
| dev_err(&client->dev, |
| "%s: Failed to query device\n", |
| __func__); |
| goto err_query_device; |
| } |
| |
| init_waitqueue_head(&rmi4_data->wait); |
| |
| #if defined(CONFIG_MMI_PANEL_NOTIFICATIONS) |
| rmi4_data->panel_nb.suspend = synaptics_rmi4_suspend; |
| rmi4_data->panel_nb.resume = synaptics_rmi4_resume; |
| rmi4_data->panel_nb.dev = &client->dev; |
| if (!mmi_panel_register_notifier(&rmi4_data->panel_nb)) |
| pr_info("registered MMI panel notifier\n"); |
| else |
| dev_err(&client->dev, |
| "%s: Unable to register MMI notifier\n", |
| __func__); |
| #elif defined(CONFIG_FB) |
| rmi4_data->panel_nb.notifier_call = synaptics_dsx_panel_cb; |
| if (!fb_register_client(&rmi4_data->panel_nb)) |
| pr_debug("registered FB notifier\n"); |
| else |
| dev_err(&client->dev, |
| "%s: Unable to register FB notifier\n", |
| __func__); |
| #endif |
| mutex_lock(&exp_fn_ctrl_mutex); |
| if (!exp_fn_ctrl.inited) { |
| mutex_init(&exp_fn_ctrl.list_mutex); |
| INIT_LIST_HEAD(&exp_fn_ctrl.fn_list); |
| exp_fn_ctrl.det_workqueue = |
| create_singlethread_workqueue("rmi_det_workqueue"); |
| if (IS_ERR_OR_NULL(exp_fn_ctrl.det_workqueue)) |
| pr_err("unable to create a workqueue\n"); |
| INIT_DELAYED_WORK(&exp_fn_ctrl.det_work, |
| synaptics_rmi4_detection_work); |
| exp_fn_ctrl.inited = true; |
| } |
| mutex_unlock(&exp_fn_ctrl_mutex); |
| |
| for (attr_count = 0; attr_count < ARRAY_SIZE(attrs); attr_count++) { |
| retval = sysfs_create_file(&rmi4_data->i2c_client->dev.kobj, |
| &attrs[attr_count].attr); |
| if (retval < 0) { |
| dev_err(&client->dev, |
| "%s: Failed to create sysfs attributes\n", |
| __func__); |
| goto err_sysfs; |
| } |
| } |
| |
| synaptics_dsx_sensor_ready_state(rmi4_data, true); |
| |
| mutex_lock(&exp_fn_ctrl_mutex); |
| exp_fn_ctrl.rmi4_data_ptr = rmi4_data; |
| mutex_unlock(&exp_fn_ctrl_mutex); |
| |
| return retval; |
| |
| err_sysfs: |
| for (attr_count--; attr_count >= 0; attr_count--) { |
| sysfs_remove_file(&rmi4_data->i2c_client->dev.kobj, |
| &attrs[attr_count].attr); |
| } |
| |
| #if defined(CONFIG_MMI_PANEL_NOTIFICATIONS) |
| mmi_panel_unregister_notifier(&rmi4_data->panel_nb); |
| #elif defined(CONFIG_FB) |
| fb_unregister_client(&rmi4_data->panel_nb); |
| #endif |
| |
| err_query_device: |
| if (rmi4_data->input_registered) { |
| input_unregister_device(rmi4_data->input_dev); |
| rmi4_data->input_dev = NULL; |
| } |
| |
| if (platform_data->regulator_en) { |
| regulator_disable(rmi4_data->regulator); |
| regulator_put(rmi4_data->regulator); |
| } |
| |
| synaptics_rmi4_cleanup(rmi4_data); |
| input_free_device(rmi4_data->input_dev); |
| |
| err_input_device: |
| kfree(rmi4_data); |
| |
| return retval; |
| } |
| |
| /** |
| * synaptics_rmi4_remove() |
| * |
| * Called by the kernel when the association with an I2C device of the |
| * same name is broken (when the driver is unloaded). |
| * |
| * This funtion terminates the work queue, stops sensor data acquisition, |
| * frees the interrupt, unregisters the driver from the input subsystem, |
| * turns off the power to the sensor, and frees other allocated resources. |
| */ |
| static int __devexit synaptics_rmi4_remove(struct i2c_client *client) |
| { |
| unsigned char attr_count; |
| struct synaptics_rmi4_data *rmi4_data = i2c_get_clientdata(client); |
| struct synaptics_rmi4_device_info *rmi; |
| const struct synaptics_dsx_platform_data *platform_data = |
| rmi4_data->board; |
| |
| rmi = &(rmi4_data->rmi4_mod_info); |
| |
| if (exp_fn_ctrl.inited) { |
| cancel_delayed_work_sync(&exp_fn_ctrl.det_work); |
| flush_workqueue(exp_fn_ctrl.det_workqueue); |
| destroy_workqueue(exp_fn_ctrl.det_workqueue); |
| } |
| |
| rmi4_data->touch_stopped = true; |
| wake_up(&rmi4_data->wait); |
| |
| synaptics_rmi4_irq_enable(rmi4_data, false); |
| |
| for (attr_count = 0; attr_count < ARRAY_SIZE(attrs); attr_count++) { |
| sysfs_remove_file(&rmi4_data->i2c_client->dev.kobj, |
| &attrs[attr_count].attr); |
| } |
| |
| if (rmi4_data->input_registered) { |
| input_unregister_device(rmi4_data->input_dev); |
| rmi4_data->input_dev = NULL; |
| } |
| |
| if (platform_data->regulator_en) { |
| regulator_disable(rmi4_data->regulator); |
| regulator_put(rmi4_data->regulator); |
| } |
| |
| #if defined(CONFIG_MMI_PANEL_NOTIFICATIONS) |
| mmi_panel_unregister_notifier(&rmi4_data->panel_nb); |
| #elif defined(CONFIG_FB) |
| fb_unregister_client(&rmi4_data->panel_nb); |
| #endif |
| synaptics_rmi4_cleanup(rmi4_data); |
| kfree(rmi4_data); |
| |
| return 0; |
| } |
| |
| static void synaptics_rmi4_sensor_multi_touch( |
| struct synaptics_rmi4_data *rmi4_data, unsigned char function) |
| { |
| int retval; |
| |
| switch (function) { |
| case SYNAPTICS_RMI4_F12: |
| /* Store multitouch config registers */ |
| hob_data.f12_c20_0 = f12_c20_0; |
| hob_data.f12_c23_0 = f12_c23_0; |
| hob_data.f12_c23_1 = f12_c23_1; |
| |
| if (!hob_data.f12_c20_0.x_suppression) |
| hob_data.f12_c20_0.x_suppression = X_MT_SUPPRESSION; |
| |
| if (!hob_data.f12_c20_0.y_suppression) |
| hob_data.f12_c20_0.y_suppression = Y_MT_SUPPRESSION; |
| break; |
| case SYNAPTICS_RMI4_F01: |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_ctrl_base_addr + 5, |
| &hob_data.f01_c9, |
| sizeof(hob_data.f01_c9)); |
| if (retval < 0) |
| pr_err("error storing recalibration interval\n"); |
| break; |
| } |
| } |
| |
| /** |
| * synaptics_rmi4_sensor_one_touch() |
| * |
| * Called on suspend and resume. |
| * |
| * This function reconfigures finger data acquisition. |
| */ |
| static void synaptics_rmi4_sensor_one_touch( |
| struct synaptics_rmi4_data *rmi4_data, bool enable) |
| { |
| int retval; |
| unsigned char recalibration; |
| if (enable) { |
| f12_c20_0.x_suppression = X_1T_SUPPRESSION; |
| f12_c20_0.y_suppression = Y_1T_SUPPRESSION; |
| f12_c23_0.data[0] = TYPE_FINGER | TYPE_STYLUS; |
| f12_c23_1.max_num_reported_objects = 1; |
| recalibration = ONE_TOUCH_RECALIBRATION; |
| } else { |
| f12_c20_0 = hob_data.f12_c20_0; |
| f12_c23_0 = hob_data.f12_c23_0; |
| f12_c23_1 = hob_data.f12_c23_1; |
| recalibration = hob_data.f01_c9; |
| } |
| |
| synaptics_rmi4_write_packet_reg(rmi4_data, &f12_ctrl_regs, 20); |
| synaptics_rmi4_write_packet_reg(rmi4_data, &f12_ctrl_regs, 23); |
| retval = synaptics_rmi4_i2c_write(rmi4_data, |
| rmi4_data->f01_ctrl_base_addr + 5, |
| &recalibration, |
| sizeof(recalibration)); |
| if (retval < 0) |
| pr_err("error setting recalibration interval\n"); |
| } |
| |
| /** |
| * synaptics_rmi4_sensor_sleep() |
| * |
| * Called by synaptics_dsx_sensor_state(). |
| * |
| * This function stops finger data acquisition and puts the sensor to sleep. |
| */ |
| static void synaptics_rmi4_sensor_sleep(struct synaptics_rmi4_data *rmi4_data) |
| { |
| int retval; |
| unsigned char device_ctrl; |
| unsigned char clear_mask = MASK_2BIT; |
| unsigned char set_mask = SENSOR_SLEEP; |
| |
| retval = synaptics_rmi4_i2c_read(rmi4_data, |
| rmi4_data->f01_ctrl_base_addr, |
| &device_ctrl, |
| sizeof(device_ctrl)); |
| if (retval < 0) { |
| dev_err(&(rmi4_data->input_dev->dev), |
| "%s: Failed to enter sleep mode\n", |
| __func__); |
| rmi4_data->sensor_sleep = false; |
| return; |
| } |
| |
| if (rmi4_data->normal_mode >= 0) { |
| clear_mask = MASK_3BIT; |
| set_mask |= NO_SLEEP_OFF; |
| } |
| |
| /* store ctrl register value to avoid being */ |
| /* have to read its value when waking ic up */ |
| rmi4_data->f01_ctrl_register_0 = device_ctrl; |
| |
| device_ctrl = (device_ctrl & ~clear_mask); |
| device_ctrl = (device_ctrl | set_mask); |
| |
| dev_dbg(&(rmi4_data->input_dev->dev), |
| "%s: Sleep mode 0x%x\n", __func__, device_ctrl); |
| |
| retval = synaptics_rmi4_i2c_write(rmi4_data, |
| rmi4_data->f01_ctrl_base_addr, |
| &device_ctrl, |
| sizeof(device_ctrl)); |
| if (retval < 0) { |
| dev_err(&(rmi4_data->input_dev->dev), |
| "%s: Failed to enter sleep mode\n", |
| __func__); |
| rmi4_data->sensor_sleep = false; |
| return; |
| } else { |
| rmi4_data->sensor_sleep = true; |
| } |
| |
| return; |
| } |
| |
| /** |
| * synaptics_rmi4_sensor_wake() |
| * |
| * Called by synaptics_dsx_sensor_state(). |
| * |
| * This function wakes the sensor from sleep. |
| */ |
| static void synaptics_rmi4_sensor_wake(struct synaptics_rmi4_data *rmi4_data) |
| { |
| int retval; |
| unsigned char device_ctrl; |
| unsigned char clear_mask = MASK_3BIT; |
| unsigned char set_mask = NORMAL_OPERATION; |
| |
| /* use ctrl register value stored when ic is put in sleep */ |
| device_ctrl = rmi4_data->f01_ctrl_register_0; |
| |
| if (rmi4_data->normal_mode < 0) |
| clear_mask = MASK_2BIT; |
| else if (rmi4_data->normal_mode == 0) |
| set_mask |= NO_SLEEP_ON; |
| |
| device_ctrl = (device_ctrl & ~clear_mask); |
| device_ctrl = (device_ctrl | set_mask); |
| |
| dev_dbg(&(rmi4_data->input_dev->dev), |
| "%s: Wake up to mode 0x%x\n", __func__, device_ctrl); |
| |
| retval = synaptics_rmi4_i2c_write(rmi4_data, |
| rmi4_data->f01_ctrl_base_addr, |
| &device_ctrl, |
| sizeof(device_ctrl)); |
| if (retval < 0) { |
| dev_err(&(rmi4_data->input_dev->dev), |
| "%s: Failed to wake from sleep mode\n", |
| __func__); |
| rmi4_data->sensor_sleep = true; |
| return; |
| } else { |
| rmi4_data->sensor_sleep = false; |
| } |
| |
| return; |
| } |
| |
| #if defined(CONFIG_FB) && !defined(CONFIG_MMI_PANEL_NOTIFICATIONS) |
| static int synaptics_dsx_panel_cb(struct notifier_block *nb, |
| unsigned long event, void *data) |
| { |
| struct fb_event *evdata = data; |
| int *blank; |
| int value = -1; |
| struct synaptics_rmi4_data *rmi4_data = |
| container_of(nb, struct synaptics_rmi4_data, panel_nb); |
| |
| if (evdata && evdata->data && event == FB_EVENT_BLANK) { |
| blank = evdata->data; |
| if (*blank == FB_BLANK_UNBLANK) { |
| synaptics_rmi4_resume(&(rmi4_data->input_dev->dev)); |
| value = 0; /* clear flag */ |
| } else if (*blank == FB_BLANK_POWERDOWN) { |
| synaptics_rmi4_suspend(&(rmi4_data->input_dev->dev)); |
| value = 1; /* set flag */ |
| } |
| } |
| |
| if (rmi4_data->purge_enabled && value != -1) { |
| atomic_set(&rmi4_data->panel_off_flag, value); |
| pr_debug("touches purge is %s\n", value ? "ON" : "OFF"); |
| } |
| |
| return 0; |
| } |
| #endif |
| |
| /** |
| * synaptics_rmi4_suspend() |
| * |
| * Called by the kernel during the suspend phase when the system |
| * enters suspend. |
| * |
| * This function stops finger data acquisition and puts the sensor to |
| * sleep, disables the interrupt, and turns off the power to the sensor. |
| */ |
| static int synaptics_rmi4_suspend(struct device *dev) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| const struct synaptics_dsx_platform_data *platform_data = |
| rmi4_data->board; |
| |
| synaptics_dsx_sensor_state(rmi4_data, STATE_SUSPEND); |
| rmi4_data->poweron = false; |
| |
| if (!rmi4_data->touch_stopped) { |
| if (platform_data->regulator_en) { |
| regulator_disable(rmi4_data->regulator); |
| pr_debug("touch-vdd regulator is %s\n", |
| regulator_is_enabled(rmi4_data->regulator) ? |
| "on" : "off"); |
| } |
| |
| gpio_free(platform_data->reset_gpio); |
| |
| rmi4_data->touch_stopped = true; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * synaptics_rmi4_resume() |
| * |
| * Called by the kernel during the resume phase when the system |
| * wakes up from suspend. |
| * |
| * This function turns on the power to the sensor, wakes the sensor |
| * from sleep, enables the interrupt, and starts finger data |
| * acquisition. |
| */ |
| static int synaptics_rmi4_resume(struct device *dev) |
| { |
| struct synaptics_rmi4_data *rmi4_data = dev_get_drvdata(dev); |
| |
| if (rmi4_data->touch_stopped) { |
| int retval; |
| bool wait4idle = false; |
| const struct synaptics_dsx_platform_data *platform_data = |
| rmi4_data->board; |
| if (platform_data->regulator_en) { |
| regulator_enable(rmi4_data->regulator); |
| pr_debug("touch-vdd regulator is %s\n", |
| regulator_is_enabled(rmi4_data->regulator) ? |
| "on" : "off"); |
| } |
| |
| retval = gpio_get_value(platform_data->reset_gpio); |
| pr_debug("reset gpio state: %d\n", retval); |
| if (retval == 0) |
| wait4idle = true; |
| |
| if (gpio_request(platform_data->reset_gpio, |
| RESET_GPIO_NAME) < 0) |
| pr_err("failed to request reset gpio\n"); |
| |
| rmi4_data->touch_stopped = false; |
| /* |
| * Decouple device reset and sending touch release, since |
| * on resume resetting ic can be optional, while sending |
| * release event is not |
| */ |
| synaptics_dsx_on_resume(rmi4_data); |
| |
| if (rmi4_data->reset_on_resume) |
| synaptics_rmi4_reset_device(rmi4_data, NULL); |
| else if (wait4idle) { |
| retval = synaptics_dsx_ic_reset(rmi4_data, false); |
| pr_debug("waited for idle %dms\n", retval); |
| } |
| } |
| |
| synaptics_dsx_sensor_ready_state(rmi4_data, false); |
| rmi4_data->poweron = true; |
| |
| return 0; |
| } |
| |
| static const struct dev_pm_ops synaptics_rmi4_dev_pm_ops = { |
| .suspend = synaptics_rmi4_suspend, |
| .resume = synaptics_rmi4_resume, |
| }; |
| |
| #ifdef CONFIG_OF |
| static const struct of_device_id synaptics_rmi4_match_tbl[] = { |
| { .compatible = "synaptics," DRIVER_NAME }, |
| { }, |
| }; |
| MODULE_DEVICE_TABLE(of, synaptics_rmi4_match_tbl); |
| #endif |
| |
| static const struct i2c_device_id synaptics_rmi4_id_table[] = { |
| {DRIVER_NAME, 0}, |
| {}, |
| }; |
| MODULE_DEVICE_TABLE(i2c, synaptics_rmi4_id_table); |
| |
| static struct i2c_driver synaptics_rmi4_driver = { |
| .driver = { |
| .name = DRIVER_NAME, |
| .owner = THIS_MODULE, |
| #if !defined(CONFIG_FB) && defined(CONFIG_PM) |
| .pm = &synaptics_rmi4_dev_pm_ops, |
| #endif |
| }, |
| .probe = synaptics_rmi4_probe, |
| .remove = __devexit_p(synaptics_rmi4_remove), |
| .id_table = synaptics_rmi4_id_table, |
| }; |
| |
| /** |
| * synaptics_rmi4_init() |
| * |
| * Called by the kernel during do_initcalls (if built-in) |
| * or when the driver is loaded (if a module). |
| * |
| * This function registers the driver to the I2C subsystem. |
| * |
| */ |
| static int __init synaptics_rmi4_init(void) |
| { |
| return i2c_add_driver(&synaptics_rmi4_driver); |
| } |
| |
| /** |
| * synaptics_rmi4_exit() |
| * |
| * Called by the kernel when the driver is unloaded. |
| * |
| * This funtion unregisters the driver from the I2C subsystem. |
| * |
| */ |
| static void __exit synaptics_rmi4_exit(void) |
| { |
| i2c_del_driver(&synaptics_rmi4_driver); |
| } |
| |
| module_init(synaptics_rmi4_init); |
| module_exit(synaptics_rmi4_exit); |
| |
| MODULE_AUTHOR("Synaptics, Inc."); |
| MODULE_DESCRIPTION("Synaptics DSX I2C Touch Driver"); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_VERSION(SYNAPTICS_DSX_DRIVER_VERSION); |