6b1072a789
- Use separated patches - Use new panel driver (with backlight support) - Battery fixes - Fix compass (AK8975) (not tested, only probing works, but sometimes doesn't - says "Unexpected device" - need to investigate that) - Touchkey is working + LED - Keyboard backlight + HALL for slideout detection
127 lines
3.5 KiB
Diff
127 lines
3.5 KiB
Diff
From bc7a628192bb519681a3c93bc1e1ed3f79c358da Mon Sep 17 00:00:00 2001
|
|
From: Beomho Seo <beomho.seo@samsung.com>
|
|
Date: Mon, 12 Aug 2013 22:04:13 +0900
|
|
Subject: [PATCH 27/34] Input: mcs_touchkey: Add parse DT function from device
|
|
tree
|
|
|
|
Add parse DT function for support mcs touchkey driver
|
|
|
|
Signed-off-by: Beomho Seo <beomho.seo@samsung.com>
|
|
---
|
|
drivers/input/keyboard/mcs_touchkey.c | 75 +++++++++++++++++++++++++--
|
|
1 file changed, 71 insertions(+), 4 deletions(-)
|
|
|
|
diff --git a/drivers/input/keyboard/mcs_touchkey.c b/drivers/input/keyboard/mcs_touchkey.c
|
|
index be56d4f262a7..2c9d7f63b562 100644
|
|
--- a/drivers/input/keyboard/mcs_touchkey.c
|
|
+++ b/drivers/input/keyboard/mcs_touchkey.c
|
|
@@ -19,6 +19,8 @@
|
|
#include <linux/slab.h>
|
|
#include <linux/platform_data/mcs.h>
|
|
#include <linux/pm.h>
|
|
+#include <linux/of_platform.h>
|
|
+#include <linux/of_gpio.h>
|
|
|
|
/* MCS5000 Touchkey */
|
|
#define MCS5000_TOUCHKEY_STATUS 0x04
|
|
@@ -96,6 +98,61 @@ static irqreturn_t mcs_touchkey_interrupt(int irq, void *dev_id)
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
+#ifdef CONFIG_OF
|
|
+static struct mcs_platform_data *mcs_touchkey_parse_dt(struct device *dev)
|
|
+{
|
|
+ struct mcs_platform_data *pdata;
|
|
+ struct device_node *np = dev->of_node;
|
|
+ u32 *keymap;
|
|
+ unsigned int len;
|
|
+ int i = 0;
|
|
+ const __be32 *prop;
|
|
+
|
|
+ pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
|
|
+ if (!pdata) {
|
|
+ dev_err(dev, "Failed to allocate platform data\n");
|
|
+ return ERR_PTR(-ENOMEM);
|
|
+ }
|
|
+
|
|
+ prop = of_get_property(np, "linux,code", &len);
|
|
+ if (!prop) {
|
|
+ dev_err(dev, "Failed to get code\n");
|
|
+ return ERR_PTR(-EINVAL);
|
|
+ }
|
|
+
|
|
+ if (len % sizeof(u32)) {
|
|
+ dev_err(dev, "Malformed keycode property\n");
|
|
+ return ERR_PTR(-EINVAL);
|
|
+ }
|
|
+
|
|
+ pdata->keymap_size = len / sizeof(u32);
|
|
+ keymap = devm_kzalloc(dev, sizeof(*keymap) * pdata->keymap_size, GFP_KERNEL);
|
|
+
|
|
+ if (of_property_read_u32(np, "key_maxval", &pdata->key_maxval)) {
|
|
+ dev_err(dev, "Failed to get key max value data\n");
|
|
+ return ERR_PTR(-EINVAL);
|
|
+ }
|
|
+
|
|
+ if (pdata->keymap_size > pdata->key_maxval) {
|
|
+ dev_err(dev, "Key map size overflow\n");
|
|
+ return ERR_PTR(-EINVAL);
|
|
+ }
|
|
+
|
|
+ for (i = 0; i < pdata->keymap_size; i++) {
|
|
+ u32 code = be32_to_cpup(prop + i);
|
|
+ keymap[i] = MCS_KEY_MAP(i, code);
|
|
+ }
|
|
+ pdata->keymap = keymap;
|
|
+ return pdata;
|
|
+}
|
|
+#else
|
|
+static inline struct mcs_platform_data *mcs_touchkey_parse_dt
|
|
+ (struct device *dev)
|
|
+{
|
|
+ return NULL;
|
|
+}
|
|
+#endif
|
|
+
|
|
static int mcs_touchkey_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
@@ -107,10 +164,14 @@ static int mcs_touchkey_probe(struct i2c_client *client,
|
|
int error;
|
|
int i;
|
|
|
|
- pdata = dev_get_platdata(&client->dev);
|
|
- if (!pdata) {
|
|
- dev_err(&client->dev, "no platform data defined\n");
|
|
- return -EINVAL;
|
|
+ if (&client->dev.of_node)
|
|
+ pdata = mcs_touchkey_parse_dt(&client->dev);
|
|
+ else
|
|
+ pdata = dev_get_platdata(&client->dev);
|
|
+
|
|
+ if (IS_ERR(pdata)) {
|
|
+ dev_err(&client->dev, "Failed to get platform data\n");
|
|
+ return PTR_ERR(pdata);
|
|
}
|
|
|
|
data = kzalloc(sizeof(struct mcs_touchkey_data) +
|
|
@@ -262,10 +323,16 @@ static const struct i2c_device_id mcs_touchkey_id[] = {
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, mcs_touchkey_id);
|
|
|
|
+static struct of_device_id mcs_touchkey_dt_match[] = {
|
|
+ { .compatible = "mcs5000_touchkey", },
|
|
+ { .compatible = "mcs5080_touchkey", },
|
|
+};
|
|
+
|
|
static struct i2c_driver mcs_touchkey_driver = {
|
|
.driver = {
|
|
.name = "mcs_touchkey",
|
|
.pm = &mcs_touchkey_pm_ops,
|
|
+ .of_match_table = of_match_ptr(mcs_touchkey_dt_match),
|
|
},
|
|
.probe = mcs_touchkey_probe,
|
|
.remove = mcs_touchkey_remove,
|
|
--
|
|
2.20.1
|
|
|