net/mlx5_en: Add missing check for memory allocation failure
[deliverable/linux.git] / drivers / input / misc / pcf50633-input.c
1 /* NXP PCF50633 Input Driver
2 *
3 * (C) 2006-2008 by Openmoko, Inc.
4 * Author: Balaji Rao <balajirrao@openmoko.org>
5 * All rights reserved.
6 *
7 * Broken down from monstrous PCF50633 driver mainly by
8 * Harald Welte, Andy Green and Werner Almesberger
9 *
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
14 *
15 */
16
17 #include <linux/kernel.h>
18 #include <linux/module.h>
19 #include <linux/device.h>
20 #include <linux/platform_device.h>
21 #include <linux/input.h>
22 #include <linux/slab.h>
23
24 #include <linux/mfd/pcf50633/core.h>
25
26 #define PCF50633_OOCSTAT_ONKEY 0x01
27 #define PCF50633_REG_OOCSTAT 0x12
28 #define PCF50633_REG_OOCMODE 0x10
29
30 struct pcf50633_input {
31 struct pcf50633 *pcf;
32 struct input_dev *input_dev;
33 };
34
35 static void
36 pcf50633_input_irq(int irq, void *data)
37 {
38 struct pcf50633_input *input;
39 int onkey_released;
40
41 input = data;
42
43 /* We report only one event depending on the key press status */
44 onkey_released = pcf50633_reg_read(input->pcf, PCF50633_REG_OOCSTAT)
45 & PCF50633_OOCSTAT_ONKEY;
46
47 if (irq == PCF50633_IRQ_ONKEYF && !onkey_released)
48 input_report_key(input->input_dev, KEY_POWER, 1);
49 else if (irq == PCF50633_IRQ_ONKEYR && onkey_released)
50 input_report_key(input->input_dev, KEY_POWER, 0);
51
52 input_sync(input->input_dev);
53 }
54
55 static int pcf50633_input_probe(struct platform_device *pdev)
56 {
57 struct pcf50633_input *input;
58 struct input_dev *input_dev;
59 int ret;
60
61
62 input = kzalloc(sizeof(*input), GFP_KERNEL);
63 if (!input)
64 return -ENOMEM;
65
66 input_dev = input_allocate_device();
67 if (!input_dev) {
68 kfree(input);
69 return -ENOMEM;
70 }
71
72 platform_set_drvdata(pdev, input);
73 input->pcf = dev_to_pcf50633(pdev->dev.parent);
74 input->input_dev = input_dev;
75
76 input_dev->name = "PCF50633 PMU events";
77 input_dev->id.bustype = BUS_I2C;
78 input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_PWR);
79 set_bit(KEY_POWER, input_dev->keybit);
80
81 ret = input_register_device(input_dev);
82 if (ret) {
83 input_free_device(input_dev);
84 kfree(input);
85 return ret;
86 }
87 pcf50633_register_irq(input->pcf, PCF50633_IRQ_ONKEYR,
88 pcf50633_input_irq, input);
89 pcf50633_register_irq(input->pcf, PCF50633_IRQ_ONKEYF,
90 pcf50633_input_irq, input);
91
92 return 0;
93 }
94
95 static int pcf50633_input_remove(struct platform_device *pdev)
96 {
97 struct pcf50633_input *input = platform_get_drvdata(pdev);
98
99 pcf50633_free_irq(input->pcf, PCF50633_IRQ_ONKEYR);
100 pcf50633_free_irq(input->pcf, PCF50633_IRQ_ONKEYF);
101
102 input_unregister_device(input->input_dev);
103 kfree(input);
104
105 return 0;
106 }
107
108 static struct platform_driver pcf50633_input_driver = {
109 .driver = {
110 .name = "pcf50633-input",
111 },
112 .probe = pcf50633_input_probe,
113 .remove = pcf50633_input_remove,
114 };
115 module_platform_driver(pcf50633_input_driver);
116
117 MODULE_AUTHOR("Balaji Rao <balajirrao@openmoko.org>");
118 MODULE_DESCRIPTION("PCF50633 input driver");
119 MODULE_LICENSE("GPL");
120 MODULE_ALIAS("platform:pcf50633-input");
This page took 0.049278 seconds and 5 git commands to generate.