From mboxrd@z Thu Jan 1 00:00:00 1970 From: dmitry.torokhov@gmail.com (Dmitry Torokhov) Date: Wed, 9 Dec 2009 19:21:49 -0800 Subject: [PATCH v2 08/09] input: enable touch on 88pm860x In-Reply-To: <771cded00912090517l5665e02fj35e90d02932e545a@mail.gmail.com> References: <771cded00912090517l5665e02fj35e90d02932e545a@mail.gmail.com> Message-ID: <20091210032149.GH10138@core.coreip.homeip.net> To: linux-arm-kernel@lists.infradead.org List-Id: linux-arm-kernel.lists.infradead.org Hi Haojian, On Wed, Dec 09, 2009 at 08:17:20AM -0500, Haojian Zhuang wrote: > + > + if (pen_down) { > + if ((x != 0) && (z1 != 0) && (touch->res_x != 0)) { > + rt = z2 / z1 - 1; > + rt = (rt * touch->res_x * x) >> ACCURATE_BIT; > + dev_dbg(chip->dev, "z1:%d, z2:%d, rt:%d\n", > + z1, z2, rt); > + } > + input_report_abs(touch->idev, ABS_X, x); > + input_report_abs(touch->idev, ABS_Y, y); > + input_report_abs(touch->idev, ABS_PRESSURE, rt); > + input_report_key(touch->idev, BTN_TOUCH, 1); > + } else { > + input_report_abs(touch->idev, ABS_PRESSURE, 0); > + input_report_key(touch->idev, BTN_TOUCH, 0); > + } > + input_sync(touch->idev); > + pm860x_unmask_irq(chip, irq); > + > + if (pen_down) > + dev_dbg(chip->dev, "pen down at [%d, %d].\n", x, y); > + else > + dev_dbg(chip->dev, "pen release\n"); You already do conditon check up a few lines, just fold this one into it. Compiler might do it for you but why can;t we help it? > +out: > + return IRQ_HANDLED; > +} > + > +static int pm860x_touch_open(struct input_dev *dev) > +{ > + struct pm860x_touch *touch = input_get_drvdata(dev); > + struct pm860x_chip *chip = touch->chip; > + int data, ret; > + > + data = MEAS_PD_EN | MEAS_TSIX_EN | MEAS_TSIY_EN > + | MEAS_TSIZ1_EN | MEAS_TSIZ2_EN; > + ret = pm860x_set_bits(touch->i2c, MEAS_EN3, data, data); > + if (ret < 0) > + goto out; > + pm860x_unmask_irq(chip, touch->irq); > + return 0; > +out: > + return ret; > +} > + > +static void pm860x_touch_close(struct input_dev *dev) > +{ > + struct pm860x_touch *touch = input_get_drvdata(dev); > + struct pm860x_chip *chip = touch->chip; > + int data; > + > + data = MEAS_PD_EN | MEAS_TSIX_EN | MEAS_TSIY_EN > + | MEAS_TSIZ1_EN | MEAS_TSIZ2_EN; > + pm860x_set_bits(touch->i2c, MEAS_EN3, data, 0); > + pm860x_mask_irq(chip, touch->irq); > +} > + > +static int __devinit pm860x_touch_probe(struct platform_device *pdev) > +{ > + struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent); > + struct pm860x_platform_data *pm860x_pdata; > + struct pm860x_touch_pdata *pdata; > + struct pm860x_touch *touch; > + int irq, ret; > + > + irq = platform_get_irq(pdev, 0); > + if (irq < 0) { > + dev_err(&pdev->dev, "No IRQ resource!\n"); > + return -EINVAL; > + } > + > + if (pdev->dev.parent->platform_data) { > + pm860x_pdata = pdev->dev.parent->platform_data; > + pdata = pm860x_pdata->touch; > + } else > + pdata = NULL; > + > + if (pdata == NULL) { > + dev_err(&pdev->dev, "platform data isn't assigned to " > + "touch\n"); > + return -EINVAL; > + } This should be written as: ... struct pm860x_platform_data *pm860x_pdata = pdev->dev.parent->platform_data; ... if (pm860x_pdata) { pdata = pm860x_pdata->touch; if (!pdata) { dev_err(&pdev->dev, "touchscreen platform data is missing\n"); return -EINVAL; } } > + > + touch = kzalloc(sizeof(struct pm860x_touch), GFP_KERNEL); > + if (touch == NULL) > + return -ENOMEM; > + dev_set_drvdata(&pdev->dev, touch); > + > + touch->idev = input_allocate_device(); > + if (touch->idev == NULL) { > + dev_err(&pdev->dev, "Failed to allocate input device!\n"); > + ret = -ENOMEM; > + goto out; > + } > + > + touch->idev->name = "88pm860x-touch"; > + touch->idev->phys = "88pm860x/input0"; > + touch->idev->id.bustype = BUS_I2C; > + touch->idev->dev.parent = &pdev->dev; > + touch->idev->open = pm860x_touch_open; > + touch->idev->close = pm860x_touch_close; > + touch->chip = chip; > + touch->i2c = (chip->id == CHIP_PM8607) ? chip->client \ > + : chip->companion; No need to escape newlines. > + touch->irq = irq; > + touch->res_x = pdata->res_x; > + input_set_drvdata(touch->idev, touch); > + > + ret = pm860x_request_irq(chip, irq, pm860x_touch_handler, touch); > + if (ret < 0) > + goto out_irq; > + > + __set_bit(EV_ABS, touch->idev->evbit); > + __set_bit(ABS_X, touch->idev->absbit); > + __set_bit(ABS_Y, touch->idev->absbit); > + __set_bit(ABS_PRESSURE, touch->idev->absbit); > + __set_bit(EV_SYN, touch->idev->evbit); > + __set_bit(EV_KEY, touch->idev->evbit); > + __set_bit(BTN_TOUCH, touch->idev->keybit); > + > + input_set_abs_params(touch->idev, ABS_X, 0, 1 << ACCURATE_BIT, 0, 0); > + input_set_abs_params(touch->idev, ABS_Y, 0, 1 << ACCURATE_BIT, 0, 0); > + input_set_abs_params(touch->idev, ABS_PRESSURE, 0, 1 << ACCURATE_BIT, > + 0, 0); > + > + ret = input_register_device(touch->idev); > + if (ret < 0) { > + dev_err(chip->dev, "Failed to register touch!\n"); > + goto out_rg; > + } > + > + platform_set_drvdata(pdev, touch); > + return 0; > +out_rg: > + pm860x_free_irq(chip, irq); > +out_irq: > + input_free_device(touch->idev); > +out: > + kfree(touch); > + return ret; > +} > + > +static int __devexit pm860x_touch_remove(struct platform_device *pdev) > +{ > + struct pm860x_touch *touch = platform_get_drvdata(pdev); > + > + input_unregister_device(touch->idev); > + pm860x_free_irq(touch->chip, touch->irq); You need to kfree(touch) and platform_set_drvdata(pdev, NULL) would also be prudent. > + return 0; > +} > + > +static struct platform_driver pm860x_touch_driver = { > + .driver = { > + .name = "88pm860x-touch", > + .owner = THIS_MODULE, > + }, > + .probe = pm860x_touch_probe, > + .remove = __devexit_p(pm860x_touch_remove), > +}; > + > +static int __init pm860x_touch_init(void) > +{ > + return platform_driver_register(&pm860x_touch_driver); > +} > +module_init(pm860x_touch_init); > + > +static void __exit pm860x_touch_exit(void) > +{ > + platform_driver_unregister(&pm860x_touch_driver); > +} > +module_exit(pm860x_touch_exit); > + > +MODULE_DESCRIPTION("Touchscreen driver for Marvell Semiconductor 88PM860x"); > +MODULE_AUTHOR("Haojian Zhuang "); > +MODULE_LICENSE("GPL"); > +MODULE_ALIAS("platform:88pm860x-touch"); > + > diff --git a/drivers/input/touchscreen/Kconfig > b/drivers/input/touchscreen/Kconfig > index 8cc453c..f4e6fd2 100644 > --- a/drivers/input/touchscreen/Kconfig > +++ b/drivers/input/touchscreen/Kconfig > @@ -530,4 +530,16 @@ config TOUCHSCREEN_PCAP > > To compile this driver as a module, choose M here: the > module will be called pcap_ts. > + > +config TOUCHSCREEN_88PM860X > + tristate "Marvell 88PM860x touchscreen" > + depends on MFD_88PM860X > + help > + Say Y here if you have a 88PM860x PMIC and want to enable > + support for the built-in touchscreen. > + > + If unsure, say N. > + > + To compile this driver as a module, choose M here: the > + module will be called 88pm860x-ts. Could you stick it somewhere in the middle of Kconfig file - it will reduce chance of issues with merging. I assume you want to merge the driver with the rest of the patches through MFD tree? Other than that - looks good. -- Dmitry