@@ -364,6 +364,55 @@ static void imx_keypad_inhibit(struct imx_keypad *keypad)
writew(0xff00, keypad->mmio_base + KPCR);
}
+static int mxc_kpp_suspend(struct platform_device *pdev, pm_message_t state)
+{
+ struct imx_keypad *keypad = platform_get_drvdata(pdev);
+ unsigned short reg_val;
+
+ clk_disable(keypad->clk);
+
+ if (device_may_wakeup(&pdev->dev)) {
+ reg_val = readw(keypad->mmio_base + KPSR);
+ if ((reg_val & KBD_STAT_KDIE) == 0) {
+ /* If no depress interrupt enable the release interrupt */
+ reg_val |= KBD_STAT_KRIE;
+ writew(reg_val, keypad->mmio_base + KPSR);
+ }
+ enable_irq_wake(keypad->irq);
+ } else {
+ keypad->enabled = false;
+ synchronize_irq(keypad->irq);
+ disable_irq(keypad->irq);
+ }
+
+ return 0;
+}
+
+/*!
+ * This function brings the Keypad controller back from low-power state.
+ * If Keypad is enabled as a wake source(i.e. it can resume the system
+ * from suspend mode), the Keypad controller doesn't enter low-power state.
+ *
+ * @param pdev the device structure used to give information on Keypad
+ * to resume
+ *
+ * @return The function always returns 0.
+ */
+static int mxc_kpp_resume(struct platform_device *pdev)
+{
+ struct imx_keypad *keypad = platform_get_drvdata(pdev);
+
+ clk_enable(keypad->clk);
+ if (device_may_wakeup(&pdev->dev)) {
+ /* The irq routine already cleared KRIE if it was set */
+ } else {
+ keypad->enabled = true;
+ enable_irq(keypad->irq);
+ }
+
+ return 0;
+}
+
static void imx_keypad_close(struct input_dev *dev)
{
struct imx_keypad *keypad = input_get_drvdata(dev);
@@ -410,7 +459,8 @@ open_err:
static int __devinit imx_keypad_probe(struct platform_device *pdev)
{
- const struct matrix_keymap_data *keymap_data = pdev->dev.platform_data;
+ const struct matrix_keypad_platform_data *keypad_data = pdev->dev.platform_data;
+ const struct matrix_keymap_data *keymap_data = keypad_data->keymap_data;
struct imx_keypad *keypad;
struct input_dev *input_dev;
struct resource *res;
@@ -525,7 +575,7 @@ static int __devinit imx_keypad_probe(struct platform_device *pdev)
}
platform_set_drvdata(pdev, keypad);
- device_init_wakeup(&pdev->dev, 1);
+ device_init_wakeup(&pdev->dev, keypad_data->wakeup);
return 0;
@@ -574,6 +624,8 @@ static struct platform_driver imx_keypad_driver = {
},
.probe = imx_keypad_probe,
.remove = __devexit_p(imx_keypad_remove),
+ .suspend = mxc_kpp_suspend,
+ .resume = mxc_kpp_resume,
};
static int __init imx_keypad_init(void)