提交 a5dde0c7 编写于 作者: S Stephen Boyd 提交者: Dmitry Torokhov

Input: pmic8xxx-keypad - migrate to regmap APIs

Use the regmap APIs for this driver instead of custom pm8xxx
APIs. This breaks this driver's dependency on the pm8xxx APIs and
allows us to easily port it to other bus protocols in the future.
Signed-off-by: NStephen Boyd <sboyd@codeaurora.org>
Signed-off-by: NDmitry Torokhov <dmitry.torokhov@gmail.com>
上级 c7f6ee26
...@@ -19,8 +19,8 @@ ...@@ -19,8 +19,8 @@
#include <linux/bitops.h> #include <linux/bitops.h>
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/mutex.h> #include <linux/mutex.h>
#include <linux/regmap.h>
#include <linux/mfd/pm8xxx/core.h>
#include <linux/input/pmic8xxx-keypad.h> #include <linux/input/pmic8xxx-keypad.h>
#define PM8XXX_MAX_ROWS 18 #define PM8XXX_MAX_ROWS 18
...@@ -86,6 +86,7 @@ ...@@ -86,6 +86,7 @@
* struct pmic8xxx_kp - internal keypad data structure * struct pmic8xxx_kp - internal keypad data structure
* @pdata - keypad platform data pointer * @pdata - keypad platform data pointer
* @input - input device pointer for keypad * @input - input device pointer for keypad
* @regmap - regmap handle
* @key_sense_irq - key press/release irq number * @key_sense_irq - key press/release irq number
* @key_stuck_irq - key stuck notification irq number * @key_stuck_irq - key stuck notification irq number
* @keycodes - array to hold the key codes * @keycodes - array to hold the key codes
...@@ -97,6 +98,7 @@ ...@@ -97,6 +98,7 @@
struct pmic8xxx_kp { struct pmic8xxx_kp {
const struct pm8xxx_keypad_platform_data *pdata; const struct pm8xxx_keypad_platform_data *pdata;
struct input_dev *input; struct input_dev *input;
struct regmap *regmap;
int key_sense_irq; int key_sense_irq;
int key_stuck_irq; int key_stuck_irq;
...@@ -109,33 +111,6 @@ struct pmic8xxx_kp { ...@@ -109,33 +111,6 @@ struct pmic8xxx_kp {
u8 ctrl_reg; u8 ctrl_reg;
}; };
static int pmic8xxx_kp_write_u8(struct pmic8xxx_kp *kp,
u8 data, u16 reg)
{
int rc;
rc = pm8xxx_writeb(kp->dev->parent, reg, data);
return rc;
}
static int pmic8xxx_kp_read(struct pmic8xxx_kp *kp,
u8 *data, u16 reg, unsigned num_bytes)
{
int rc;
rc = pm8xxx_read_buf(kp->dev->parent, reg, data, num_bytes);
return rc;
}
static int pmic8xxx_kp_read_u8(struct pmic8xxx_kp *kp,
u8 *data, u16 reg)
{
int rc;
rc = pmic8xxx_kp_read(kp, data, reg, 1);
return rc;
}
static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col) static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col)
{ {
/* all keys pressed on that particular row? */ /* all keys pressed on that particular row? */
...@@ -160,9 +135,9 @@ static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col) ...@@ -160,9 +135,9 @@ static u8 pmic8xxx_col_state(struct pmic8xxx_kp *kp, u8 col)
static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp) static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp)
{ {
int rc; int rc;
u8 scan_val; unsigned int scan_val;
rc = pmic8xxx_kp_read_u8(kp, &scan_val, KEYP_SCAN); rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
if (rc < 0) { if (rc < 0) {
dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc); dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
return rc; return rc;
...@@ -170,7 +145,7 @@ static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp) ...@@ -170,7 +145,7 @@ static int pmic8xxx_chk_sync_read(struct pmic8xxx_kp *kp)
scan_val |= 0x1; scan_val |= 0x1;
rc = pmic8xxx_kp_write_u8(kp, scan_val, KEYP_SCAN); rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
if (rc < 0) { if (rc < 0) {
dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc); dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
return rc; return rc;
...@@ -186,26 +161,24 @@ static int pmic8xxx_kp_read_data(struct pmic8xxx_kp *kp, u16 *state, ...@@ -186,26 +161,24 @@ static int pmic8xxx_kp_read_data(struct pmic8xxx_kp *kp, u16 *state,
u16 data_reg, int read_rows) u16 data_reg, int read_rows)
{ {
int rc, row; int rc, row;
u8 new_data[PM8XXX_MAX_ROWS]; unsigned int val;
rc = pmic8xxx_kp_read(kp, new_data, data_reg, read_rows); for (row = 0; row < read_rows; row++) {
if (rc) rc = regmap_read(kp->regmap, data_reg, &val);
return rc; if (rc)
return rc;
for (row = 0; row < kp->pdata->num_rows; row++) { dev_dbg(kp->dev, "%d = %d\n", row, val);
dev_dbg(kp->dev, "new_data[%d] = %d\n", row, state[row] = pmic8xxx_col_state(kp, val);
new_data[row]);
state[row] = pmic8xxx_col_state(kp, new_data[row]);
} }
return rc; return 0;
} }
static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state, static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
u16 *old_state) u16 *old_state)
{ {
int rc, read_rows; int rc, read_rows;
u8 scan_val; unsigned int scan_val;
if (kp->pdata->num_rows < PM8XXX_MIN_ROWS) if (kp->pdata->num_rows < PM8XXX_MIN_ROWS)
read_rows = PM8XXX_MIN_ROWS; read_rows = PM8XXX_MIN_ROWS;
...@@ -235,14 +208,14 @@ static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state, ...@@ -235,14 +208,14 @@ static int pmic8xxx_kp_read_matrix(struct pmic8xxx_kp *kp, u16 *new_state,
/* 4 * 32KHz clocks */ /* 4 * 32KHz clocks */
udelay((4 * DIV_ROUND_UP(USEC_PER_SEC, KEYP_CLOCK_FREQ)) + 1); udelay((4 * DIV_ROUND_UP(USEC_PER_SEC, KEYP_CLOCK_FREQ)) + 1);
rc = pmic8xxx_kp_read_u8(kp, &scan_val, KEYP_SCAN); rc = regmap_read(kp->regmap, KEYP_SCAN, &scan_val);
if (rc < 0) { if (rc < 0) {
dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc); dev_err(kp->dev, "Error reading KEYP_SCAN reg, rc=%d\n", rc);
return rc; return rc;
} }
scan_val &= 0xFE; scan_val &= 0xFE;
rc = pmic8xxx_kp_write_u8(kp, scan_val, KEYP_SCAN); rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
if (rc < 0) if (rc < 0)
dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc); dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
...@@ -378,10 +351,10 @@ static irqreturn_t pmic8xxx_kp_stuck_irq(int irq, void *data) ...@@ -378,10 +351,10 @@ static irqreturn_t pmic8xxx_kp_stuck_irq(int irq, void *data)
static irqreturn_t pmic8xxx_kp_irq(int irq, void *data) static irqreturn_t pmic8xxx_kp_irq(int irq, void *data)
{ {
struct pmic8xxx_kp *kp = data; struct pmic8xxx_kp *kp = data;
u8 ctrl_val, events; unsigned int ctrl_val, events;
int rc; int rc;
rc = pmic8xxx_kp_read(kp, &ctrl_val, KEYP_CTRL, 1); rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
if (rc < 0) { if (rc < 0) {
dev_err(kp->dev, "failed to read keyp_ctrl register\n"); dev_err(kp->dev, "failed to read keyp_ctrl register\n");
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -420,7 +393,7 @@ static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp) ...@@ -420,7 +393,7 @@ static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp)
ctrl_val |= (bits << KEYP_CTRL_SCAN_ROWS_SHIFT); ctrl_val |= (bits << KEYP_CTRL_SCAN_ROWS_SHIFT);
rc = pmic8xxx_kp_write_u8(kp, ctrl_val, KEYP_CTRL); rc = regmap_write(kp->regmap, KEYP_CTRL, ctrl_val);
if (rc < 0) { if (rc < 0) {
dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc); dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
return rc; return rc;
...@@ -438,7 +411,7 @@ static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp) ...@@ -438,7 +411,7 @@ static int pmic8xxx_kpd_init(struct pmic8xxx_kp *kp)
scan_val |= (cycles << KEYP_SCAN_ROW_HOLD_SHIFT); scan_val |= (cycles << KEYP_SCAN_ROW_HOLD_SHIFT);
rc = pmic8xxx_kp_write_u8(kp, scan_val, KEYP_SCAN); rc = regmap_write(kp->regmap, KEYP_SCAN, scan_val);
if (rc) if (rc)
dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc); dev_err(kp->dev, "Error writing KEYP_SCAN reg, rc=%d\n", rc);
...@@ -452,7 +425,7 @@ static int pmic8xxx_kp_enable(struct pmic8xxx_kp *kp) ...@@ -452,7 +425,7 @@ static int pmic8xxx_kp_enable(struct pmic8xxx_kp *kp)
kp->ctrl_reg |= KEYP_CTRL_KEYP_EN; kp->ctrl_reg |= KEYP_CTRL_KEYP_EN;
rc = pmic8xxx_kp_write_u8(kp, kp->ctrl_reg, KEYP_CTRL); rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
if (rc < 0) if (rc < 0)
dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc); dev_err(kp->dev, "Error writing KEYP_CTRL reg, rc=%d\n", rc);
...@@ -465,7 +438,7 @@ static int pmic8xxx_kp_disable(struct pmic8xxx_kp *kp) ...@@ -465,7 +438,7 @@ static int pmic8xxx_kp_disable(struct pmic8xxx_kp *kp)
kp->ctrl_reg &= ~KEYP_CTRL_KEYP_EN; kp->ctrl_reg &= ~KEYP_CTRL_KEYP_EN;
rc = pmic8xxx_kp_write_u8(kp, kp->ctrl_reg, KEYP_CTRL); rc = regmap_write(kp->regmap, KEYP_CTRL, kp->ctrl_reg);
if (rc < 0) if (rc < 0)
return rc; return rc;
...@@ -503,7 +476,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -503,7 +476,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
const struct matrix_keymap_data *keymap_data; const struct matrix_keymap_data *keymap_data;
struct pmic8xxx_kp *kp; struct pmic8xxx_kp *kp;
int rc; int rc;
u8 ctrl_val; unsigned int ctrl_val;
if (!pdata || !pdata->num_cols || !pdata->num_rows || if (!pdata || !pdata->num_cols || !pdata->num_rows ||
pdata->num_cols > PM8XXX_MAX_COLS || pdata->num_cols > PM8XXX_MAX_COLS ||
...@@ -547,6 +520,10 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -547,6 +520,10 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
if (!kp) if (!kp)
return -ENOMEM; return -ENOMEM;
kp->regmap = dev_get_regmap(pdev->dev.parent, NULL);
if (!kp->regmap)
return -ENODEV;
platform_set_drvdata(pdev, kp); platform_set_drvdata(pdev, kp);
kp->pdata = pdata; kp->pdata = pdata;
...@@ -621,7 +598,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -621,7 +598,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
return rc; return rc;
} }
rc = pmic8xxx_kp_read_u8(kp, &ctrl_val, KEYP_CTRL); rc = regmap_read(kp->regmap, KEYP_CTRL, &ctrl_val);
if (rc < 0) { if (rc < 0) {
dev_err(&pdev->dev, "failed to read KEYP_CTRL register\n"); dev_err(&pdev->dev, "failed to read KEYP_CTRL register\n");
return rc; return rc;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册