Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
ab8500-ponkey.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) ST-Ericsson SA 2010
3  *
4  * License Terms: GNU General Public License v2
5  * Author: Sundar Iyer <[email protected]> for ST-Ericsson
6  *
7  * AB8500 Power-On Key handler
8  */
9 
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/platform_device.h>
13 #include <linux/input.h>
14 #include <linux/interrupt.h>
16 #include <linux/of.h>
17 #include <linux/slab.h>
18 
26 struct ab8500_ponkey {
27  struct input_dev *idev;
28  struct ab8500 *ab8500;
29  int irq_dbf;
30  int irq_dbr;
31 };
32 
33 /* AB8500 gives us an interrupt when ONKEY is held */
34 static irqreturn_t ab8500_ponkey_handler(int irq, void *data)
35 {
36  struct ab8500_ponkey *ponkey = data;
37 
38  if (irq == ponkey->irq_dbf)
39  input_report_key(ponkey->idev, KEY_POWER, true);
40  else if (irq == ponkey->irq_dbr)
41  input_report_key(ponkey->idev, KEY_POWER, false);
42 
43  input_sync(ponkey->idev);
44 
45  return IRQ_HANDLED;
46 }
47 
48 static int __devinit ab8500_ponkey_probe(struct platform_device *pdev)
49 {
50  struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent);
51  struct ab8500_ponkey *ponkey;
52  struct input_dev *input;
53  int irq_dbf, irq_dbr;
54  int error;
55 
56  irq_dbf = platform_get_irq_byname(pdev, "ONKEY_DBF");
57  if (irq_dbf < 0) {
58  dev_err(&pdev->dev, "No IRQ for ONKEY_DBF, error=%d\n", irq_dbf);
59  return irq_dbf;
60  }
61 
62  irq_dbr = platform_get_irq_byname(pdev, "ONKEY_DBR");
63  if (irq_dbr < 0) {
64  dev_err(&pdev->dev, "No IRQ for ONKEY_DBR, error=%d\n", irq_dbr);
65  return irq_dbr;
66  }
67 
68  ponkey = kzalloc(sizeof(struct ab8500_ponkey), GFP_KERNEL);
69  input = input_allocate_device();
70  if (!ponkey || !input) {
71  error = -ENOMEM;
72  goto err_free_mem;
73  }
74 
75  ponkey->idev = input;
76  ponkey->ab8500 = ab8500;
77  ponkey->irq_dbf = irq_dbf;
78  ponkey->irq_dbr = irq_dbr;
79 
80  input->name = "AB8500 POn(PowerOn) Key";
81  input->dev.parent = &pdev->dev;
82 
83  input_set_capability(input, EV_KEY, KEY_POWER);
84 
85  error = request_any_context_irq(ponkey->irq_dbf, ab8500_ponkey_handler,
86  0, "ab8500-ponkey-dbf", ponkey);
87  if (error < 0) {
88  dev_err(ab8500->dev, "Failed to request dbf IRQ#%d: %d\n",
89  ponkey->irq_dbf, error);
90  goto err_free_mem;
91  }
92 
93  error = request_any_context_irq(ponkey->irq_dbr, ab8500_ponkey_handler,
94  0, "ab8500-ponkey-dbr", ponkey);
95  if (error < 0) {
96  dev_err(ab8500->dev, "Failed to request dbr IRQ#%d: %d\n",
97  ponkey->irq_dbr, error);
98  goto err_free_dbf_irq;
99  }
100 
101  error = input_register_device(ponkey->idev);
102  if (error) {
103  dev_err(ab8500->dev, "Can't register input device: %d\n", error);
104  goto err_free_dbr_irq;
105  }
106 
107  platform_set_drvdata(pdev, ponkey);
108  return 0;
109 
110 err_free_dbr_irq:
111  free_irq(ponkey->irq_dbr, ponkey);
112 err_free_dbf_irq:
113  free_irq(ponkey->irq_dbf, ponkey);
114 err_free_mem:
115  input_free_device(input);
116  kfree(ponkey);
117 
118  return error;
119 }
120 
121 static int __devexit ab8500_ponkey_remove(struct platform_device *pdev)
122 {
123  struct ab8500_ponkey *ponkey = platform_get_drvdata(pdev);
124 
125  free_irq(ponkey->irq_dbf, ponkey);
126  free_irq(ponkey->irq_dbr, ponkey);
127  input_unregister_device(ponkey->idev);
128  kfree(ponkey);
129 
130  platform_set_drvdata(pdev, NULL);
131 
132  return 0;
133 }
134 
135 #ifdef CONFIG_OF
136 static const struct of_device_id ab8500_ponkey_match[] = {
137  { .compatible = "stericsson,ab8500-ponkey", },
138  {}
139 };
140 #endif
141 
142 static struct platform_driver ab8500_ponkey_driver = {
143  .driver = {
144  .name = "ab8500-poweron-key",
145  .owner = THIS_MODULE,
146  .of_match_table = of_match_ptr(ab8500_ponkey_match),
147  },
148  .probe = ab8500_ponkey_probe,
149  .remove = __devexit_p(ab8500_ponkey_remove),
150 };
151 module_platform_driver(ab8500_ponkey_driver);
152 
153 MODULE_LICENSE("GPL v2");
154 MODULE_AUTHOR("Sundar Iyer <[email protected]>");
155 MODULE_DESCRIPTION("ST-Ericsson AB8500 Power-ON(Pon) Key driver");