Hi Tony, On Mon, Dec 13, 2010 at 02:09:28PM +0900, chinyeow.sim.xt@xxxxxxxxxxx wrote: > This patch set introduces for Sitronix ST1232 touchscreen controller > driver. This is an integrated capacitive touchscreen with LCD module > which can detect two fingers's touch X/Y coordinate. > > Signed-off-by: Tony SIM <chinyeow.sim.xt@xxxxxxxxxxx> > --- > drivers/input/touchscreen/Kconfig | 11 + > drivers/input/touchscreen/Makefile | 1 + > drivers/input/touchscreen/st1232.c | 377 ++++++++++++++++++++++++++++++++++++ > 3 files changed, 389 insertions(+), 0 deletions(-) > create mode 100644 drivers/input/touchscreen/st1232.c > > diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig > index 06ea8da..3ca7700 100644 > --- a/drivers/input/touchscreen/Kconfig > +++ b/drivers/input/touchscreen/Kconfig > @@ -681,4 +681,15 @@ config TOUCHSCREEN_STMPE > To compile this driver as a module, choose M here: the > module will be called stmpe-ts. > > +config TOUCHSCREEN_ST1232 > + tristate "Sitronix ST1232 touchscreen controllers" > + depends on I2C > + help > + Say Y here if you want to support Sitronix ST1232 > + touchscreen controller. > + > + If unsure, say N. > + > + To compile this driver as a module, choose M here: the > + module will be called st1232_ts. > endif > diff --git a/drivers/input/touchscreen/Makefile b/drivers/input/touchscreen/Makefile > index 7cc1b4f..718bcc8 100644 > --- a/drivers/input/touchscreen/Makefile > +++ b/drivers/input/touchscreen/Makefile > @@ -39,6 +39,7 @@ obj-$(CONFIG_TOUCHSCREEN_PCAP) += pcap_ts.o > obj-$(CONFIG_TOUCHSCREEN_PENMOUNT) += penmount.o > obj-$(CONFIG_TOUCHSCREEN_QT602240) += qt602240_ts.o > obj-$(CONFIG_TOUCHSCREEN_S3C2410) += s3c2410_ts.o > +obj-$(CONFIG_TOUCHSCREEN_ST1232) += st1232.o > obj-$(CONFIG_TOUCHSCREEN_STMPE) += stmpe-ts.o > obj-$(CONFIG_TOUCHSCREEN_TNETV107X) += tnetv107x-ts.o > obj-$(CONFIG_TOUCHSCREEN_TOUCHIT213) += touchit213.o > diff --git a/drivers/input/touchscreen/st1232.c b/drivers/input/touchscreen/st1232.c > new file mode 100644 > index 0000000..bfa24ee > --- /dev/null > +++ b/drivers/input/touchscreen/st1232.c > @@ -0,0 +1,377 @@ > +/* drivers/input/touchscreen/st1232.c No filenames in sources please - easier to move/rename if needed. > + * > + * Copyright (C) 2010 Renesas Solutions Corp. > + * Tony SIM <chinyeow.sim.xt@xxxxxxxxxxx> > + * > + * Using code from: > + * - android.git.kernel.org: projects/kernel/common.git: synaptics_i2c_rmi.c > + * Copyright (C) 2007 Google, Inc. > + * > + * This software is licensed under the terms of the GNU General Public > + * License version 2, as published by the Free Software Foundation, and > + * may be copied, distributed, and modified under those terms. > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + * > + */ > + > +#include <linux/delay.h> > +#include <linux/earlysuspend.h> > +#include <linux/hrtimer.h> > +#include <linux/i2c.h> > +#include <linux/input.h> > +#include <linux/interrupt.h> > +#include <linux/io.h> > +#include <linux/kernel.h> > +#include <linux/module.h> > +#include <linux/platform_device.h> > +#include <linux/slab.h> > + > +#define ST1232_TS_NAME "st1232-ts" > + > +#define XY0 0 > +#define XY1 1 > +#define MAX_FINGERS 2 > + > +#define MIN_X 0 > +#define MIN_Y 0 > +#define MAX_X 800 > +#define MAX_Y 480 > +#define MAX_AREA 0x7ff > + > +struct st1232_ts_data { > + uint16_t addr; > + struct i2c_client *client; > + struct input_dev *input_dev; > + int use_irq; I really do not think we need to support the devices in polling mode: the drain on the battery would be too much to use it in production. > + struct hrtimer timer; I guess without polling timer is not needed either. > + struct work_struct work; > + struct workqueue_struct *workq; > + uint8_t pre_fingers_num; > + uint8_t pre_is_valid[MAX_FINGERS]; > +#ifdef CONFIG_HAS_EARLYSUSPEND > + struct early_suspend early_suspend; > +#endif > +}; > + > +#ifdef CONFIG_HAS_EARLYSUSPEND > +static void st1232_ts_early_suspend(struct early_suspend *h); > +static void st1232_ts_late_resume(struct early_suspend *h); > +#endif There is no EARLYSUSPEND infrastructuire in mainline, please drop. > + > +static void st1232_ts_work_func(struct work_struct *work) > +{ > + int ret; > + struct i2c_msg msg[2]; > + uint8_t start_reg; > + uint8_t buf[8]; > + struct st1232_ts_data *ts = > + container_of(work, struct st1232_ts_data, work); > + uint16_t x[MAX_FINGERS], y[MAX_FINGERS]; > + uint8_t fingers_num, is_valid[MAX_FINGERS]; > + > + /* read touchscreen data from ST1232 */ > + msg[0].addr = ts->client->addr; > + msg[0].flags = 0; > + msg[0].len = 1; > + msg[0].buf = &start_reg; > + start_reg = 0x10; > + > + msg[1].addr = ts->client->addr; > + msg[1].flags = I2C_M_RD; > + msg[1].len = sizeof(buf); > + msg[1].buf = buf; > + > + ret = i2c_transfer(ts->client->adapter, msg, 2); > + if (ret < 0) > + goto done; > + > + /* get valid bit */ > + is_valid[XY0] = buf[2] >> 7; > + is_valid[XY1] = buf[5] >> 7; > + > + /* get xy coordinate */ > + if (is_valid[XY0]) { > + x[XY0] = ((buf[2] & 0x0070) << 4) | buf[3]; > + y[XY0] = ((buf[2] & 0x0007) << 8) | buf[4]; > + } > + > + if (is_valid[XY1]) { > + x[XY1] = ((buf[5] & 0x0070) << 4) | buf[6]; > + y[XY1] = ((buf[5] & 0x0007) << 8) | buf[7]; > + } > + > + /* report single touch */ > + if (ts->pre_is_valid[XY0] || is_valid[XY0]) { > + input_report_key(ts->input_dev, BTN_TOUCH, is_valid[XY0]); > + if (is_valid[XY0]) { > + input_report_abs(ts->input_dev, ABS_X, x[XY0]); > + input_report_abs(ts->input_dev, ABS_Y, y[XY0]); > + } > + } > + > + if (ts->pre_is_valid[XY1] || is_valid[XY1]) { > + input_report_key(ts->input_dev, BTN_2, is_valid[XY1]); > + if (is_valid[XY1]) { > + input_report_abs(ts->input_dev, ABS_HAT0X, x[XY1]); > + input_report_abs(ts->input_dev, ABS_HAT0Y, y[XY1]); > + } > + } > + > + /* multi touch protocol */ > + fingers_num = is_valid[XY0] + is_valid[XY1]; > + > + if (fingers_num > 0) { MT protocol should be used by MT-capable devices regardless of number of fingers currently present on the surface. Also consider using his new MT library to easy deriving ST events from MT events (look in drivers/input/input-mt.c in my tree on kernel.org). > + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, MAX_AREA); If the device does not report touch size you should not invent the data, simply drop ABS_MT_TOUCH_MAJOR events. > + input_report_abs(ts->input_dev, ABS_MT_POSITION_X, > + is_valid[XY0] ? x[XY0] : x[XY1]); > + input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, > + is_valid[XY0] ? y[XY0] : y[XY1]); > + input_mt_sync(ts->input_dev); > + > + if (fingers_num == MAX_FINGERS) { > + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, > + MAX_AREA); > + input_report_abs(ts->input_dev, ABS_MT_POSITION_X, > + x[XY1]); > + input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, > + y[XY1]); > + input_mt_sync(ts->input_dev); > + } > + } else if ((ts->pre_fingers_num == 1) && (fingers_num == 0)) { > + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, 0); > + input_mt_sync(ts->input_dev); > + } > + > + /* EV_SYN */ > + input_sync(ts->input_dev); > + > + ts->pre_fingers_num = fingers_num; > + ts->pre_is_valid[XY0] = is_valid[XY0]; > + ts->pre_is_valid[XY1] = is_valid[XY1]; > + > +done: > + if (ts->use_irq) > + enable_irq(ts->client->irq); > + > + return; > +} > + > +static enum hrtimer_restart st1232_ts_timer_func(struct hrtimer *timer) > +{ > + struct st1232_ts_data *ts = > + container_of(timer, struct st1232_ts_data, timer); > + > + pr_debug("st1232_ts_timer_func¥n"); > + queue_work(ts->workq, &ts->work); > + hrtimer_start(&ts->timer, ktime_set(0, 12500000), HRTIMER_MODE_REL); > + return HRTIMER_NORESTART; > +} > + > +static irqreturn_t st1232_ts_irq_handler(int irq, void *dev_id) > +{ > + struct st1232_ts_data *ts = dev_id; > + > + pr_debug("st1232_ts_irq_handler¥n"); I see yen symbol here. > + disable_irq_nosync(ts->client->irq); > + queue_work(ts->workq, &ts->work); If you get rid of polling mode and switch to threaded IRQ you'll be able to get rid of workqueue and the driver will be very simple. > + return IRQ_HANDLED; > +} > + > +static int st1232_ts_probe( > + struct i2c_client *client, const struct i2c_device_id *id) __devinit > +{ > + struct st1232_ts_data *ts; > + int ret; > + > + if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { > + dev_err(&client->dev, "need I2C_FUNC_I2C¥n"); Hmm, yen symbol instead of period and back slash again... > + return -EIO; > + } > + > + ts = kzalloc(sizeof(struct st1232_ts_data), GFP_KERNEL); > + if (!ts) { > + ret = -ENOMEM; > + goto err_alloc_data_failed; > + } > + INIT_WORK(&ts->work, st1232_ts_work_func); > + ts->client = client; > + i2c_set_clientdata(client, ts); > + > + ts->input_dev = input_allocate_device(); > + if (!ts->input_dev) { > + ret = -ENOMEM; > + dev_err(&client->dev, "Failed to allocate input device¥n"); > + goto err_input_dev_alloc_failed; > + } > + ts->input_dev->name = "st1232-touchscreen"; > + > + ts->workq = create_singlethread_workqueue("st1232_workq"); > + if (!ts->workq) > + return -ENOMEM; > + > + set_bit(EV_SYN, ts->input_dev->evbit); > + set_bit(EV_KEY, ts->input_dev->evbit); > + set_bit(BTN_TOUCH, ts->input_dev->keybit); > + set_bit(BTN_2, ts->input_dev->keybit); > + set_bit(EV_ABS, ts->input_dev->evbit); > + > + input_set_capability(ts->input_dev, EV_KEY, BTN_TOUCH); > + input_set_capability(ts->input_dev, EV_KEY, BTN_2); > + > + input_set_abs_params(ts->input_dev, ABS_X, MIN_X, MAX_X, 0, 0); > + input_set_abs_params(ts->input_dev, ABS_Y, MIN_Y, MAX_Y, 0, 0); > + input_set_abs_params(ts->input_dev, ABS_HAT0X, MIN_X, MAX_X, 0, 0); > + input_set_abs_params(ts->input_dev, ABS_HAT0Y, MIN_Y, MAX_Y, 0, 0); Hmm, It looks this driver tries to use BTN_2, ABS_HAT0X, BAS_HAT0Y for reporting 2nd touch. This is not suited for mainline kernel, please drop and use proper MT events. > + > + input_set_abs_params(ts->input_dev, ABS_MT_POSITION_X, > + MIN_X, MAX_X, 0, 0); > + input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y, > + MIN_Y, MAX_Y, 0, 0); > + input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR, > + 0, MAX_AREA, 0, 0); > + > + ret = input_register_device(ts->input_dev); > + if (ret) { > + dev_err(&client->dev, "Unable to register %s input device¥n", > + ts->input_dev->name); > + goto err_input_register_device_failed; > + } > + if (client->irq) { > + ret = request_irq(client->irq, st1232_ts_irq_handler, 0, > + client->name, ts); > + if (ret) > + dev_err(&client->dev, "request_irq failed¥n"); > + else > + ts->use_irq = 1; > + } > + > + if (!ts->use_irq) { > + hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); > + ts->timer.function = st1232_ts_timer_func; > + hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL); > + } > +#ifdef CONFIG_HAS_EARLYSUSPEND > + ts->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN + 1; > + ts->early_suspend.suspend = st1232_ts_early_suspend; > + ts->early_suspend.resume = st1232_ts_late_resume; > + register_early_suspend(&ts->early_suspend); > +#endif > + > + dev_info(&client->dev, "Start touchscreen %s in %s mode¥n", > + ts->input_dev->name, ts->use_irq ? "interrupt" : "polling"); > + > + return 0; > + > +err_input_register_device_failed: > + input_free_device(ts->input_dev); > +err_input_dev_alloc_failed: > + kfree(ts); > +err_alloc_data_failed: > + return ret; > +} > + > +static int st1232_ts_remove(struct i2c_client *client) __devexit > +{ > + struct st1232_ts_data *ts = i2c_get_clientdata(client); > + > +#ifdef CONFIG_HAS_EARLYSUSPEND > + unregister_early_suspend(&ts->early_suspend); > +#endif > + > + if (ts->use_irq) > + free_irq(client->irq, ts); > + else > + hrtimer_cancel(&ts->timer); > + > + if (ts->workq) > + destroy_workqueue(ts->workq); > + > + input_unregister_device(ts->input_dev); > + > + kfree(ts); > + return 0; > +} > + > +static int st1232_ts_suspend(struct i2c_client *client, pm_message_t mesg) > +{ > + int ret; > + struct st1232_ts_data *ts = i2c_get_clientdata(client); > + > + if (ts->use_irq) > + disable_irq(client->irq); > + else > + hrtimer_cancel(&ts->timer); > + > + ret = cancel_work_sync(&ts->work); > + if (ret && ts->use_irq) > + enable_irq(client->irq); > + > + return 0; > +} > + > +static int st1232_ts_resume(struct i2c_client *client) > +{ > + struct st1232_ts_data *ts = i2c_get_clientdata(client); > + > + if (ts->use_irq) > + enable_irq(client->irq); > + else > + hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL); > + > + return 0; > +} Please convert these to dev_pm_ops. > + > +#ifdef CONFIG_HAS_EARLYSUSPEND > +static void st1232_ts_early_suspend(struct early_suspend *h) > +{ > + struct st1232_ts_data *ts; > + ts = container_of(h, struct st1232_ts_data, early_suspend); > + st1232_ts_suspend(ts->client, PMSG_SUSPEND); > +} > + > +static void st1232_ts_late_resume(struct early_suspend *h) > +{ > + struct st1232_ts_data *ts; > + ts = container_of(h, struct st1232_ts_data, early_suspend); > + st1232_ts_resume(ts->client); > +} > +#endif > + > +static const struct i2c_device_id st1232_ts_id[] = { > + { ST1232_TS_NAME, 0 }, > + { } > +}; Please add MODULE_DEVICE_TABLE(i2c, st1232_ts_id); > + > +static struct i2c_driver st1232_ts_driver = { > + .probe = st1232_ts_probe, > + .remove = st1232_ts_remove, > +#ifndef CONFIG_HAS_EARLYSUSPEND > + .suspend = st1232_ts_suspend, > + .resume = st1232_ts_resume, > +#endif > + .id_table = st1232_ts_id, > + .driver = { > + .name = ST1232_TS_NAME, > + }, > +}; > + > +static int __devinit st1232_ts_init(void) > +{ > + return i2c_add_driver(&st1232_ts_driver); > +} > + > +static void __exit st1232_ts_exit(void) > +{ > + i2c_del_driver(&st1232_ts_driver); > +} > + > +module_init(st1232_ts_init); > +module_exit(st1232_ts_exit); > + > +MODULE_AUTHOR("Tony SIM <chinyeow.sim.xt@xxxxxxxxxxx>"); > +MODULE_DESCRIPTION("SITRONIX ST1232 Touchscreen Controller Driver"); > +MODULE_LICENSE("GPL"); > -- > 1.7.2.3 > Thanks. -- Dmitry -- To unsubscribe from this list: send the line "unsubscribe linux-input" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html