Blame view

drivers/input/input-polldev.c 6.19 KB
0dcd80736   Dmitry Torokhov   Input: add skelet...
1
2
3
4
5
6
7
8
9
  /*
   * Generic implementation of a polled input device
  
   * Copyright (c) 2007 Dmitry Torokhov
   *
   * This program is free software; you can redistribute it and/or modify it
   * under the terms of the GNU General Public License version 2 as published by
   * the Free Software Foundation.
   */
da0c49011   Joe Perches   Input: use pr_fmt...
10
  #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
0dcd80736   Dmitry Torokhov   Input: add skelet...
11
  #include <linux/jiffies.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
12
  #include <linux/slab.h>
0dcd80736   Dmitry Torokhov   Input: add skelet...
13
  #include <linux/mutex.h>
e490ebdc3   Dmitry Torokhov   Input: input-poll...
14
  #include <linux/workqueue.h>
d2d8442d0   Paul Gortmaker   drivers/input: Ad...
15
  #include <linux/module.h>
0dcd80736   Dmitry Torokhov   Input: add skelet...
16
  #include <linux/input-polldev.h>
36bd52a49   Eric Piel   Input: input-poll...
17
18
19
20
  MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>");
  MODULE_DESCRIPTION("Generic implementation of a polled input device");
  MODULE_LICENSE("GPL v2");
  MODULE_VERSION("0.1");
dad725d08   Samu Onkalo   Input: input-poll...
21
  static void input_polldev_queue_work(struct input_polled_dev *dev)
0dcd80736   Dmitry Torokhov   Input: add skelet...
22
  {
374766bc2   Stephen Hemminger   Input: implement ...
23
  	unsigned long delay;
0dcd80736   Dmitry Torokhov   Input: add skelet...
24

374766bc2   Stephen Hemminger   Input: implement ...
25
26
27
  	delay = msecs_to_jiffies(dev->poll_interval);
  	if (delay >= HZ)
  		delay = round_jiffies_relative(delay);
e490ebdc3   Dmitry Torokhov   Input: input-poll...
28
  	queue_delayed_work(system_freezable_wq, &dev->work, delay);
0dcd80736   Dmitry Torokhov   Input: add skelet...
29
  }
dad725d08   Samu Onkalo   Input: input-poll...
30
31
32
33
34
35
36
37
  static void input_polled_device_work(struct work_struct *work)
  {
  	struct input_polled_dev *dev =
  		container_of(work, struct input_polled_dev, work.work);
  
  	dev->poll(dev);
  	input_polldev_queue_work(dev);
  }
0dcd80736   Dmitry Torokhov   Input: add skelet...
38
39
  static int input_open_polled_device(struct input_dev *input)
  {
3797fec17   Dmitry Torokhov   Input: remove pri...
40
  	struct input_polled_dev *dev = input_get_drvdata(input);
0dcd80736   Dmitry Torokhov   Input: add skelet...
41

b0aba1e66   Samu Onkalo   Input: add open a...
42
43
  	if (dev->open)
  		dev->open(dev);
0dcd80736   Dmitry Torokhov   Input: add skelet...
44

11bb4cc7c   Samu Onkalo   Input: polled dev...
45
  	/* Only start polling if polling is enabled */
5e3e4eb1b   Dmitry Torokhov   Input: polldev - ...
46
47
48
49
  	if (dev->poll_interval > 0) {
  		dev->poll(dev);
  		input_polldev_queue_work(dev);
  	}
0dcd80736   Dmitry Torokhov   Input: add skelet...
50
51
52
53
54
55
  
  	return 0;
  }
  
  static void input_close_polled_device(struct input_dev *input)
  {
3797fec17   Dmitry Torokhov   Input: remove pri...
56
  	struct input_polled_dev *dev = input_get_drvdata(input);
0dcd80736   Dmitry Torokhov   Input: add skelet...
57

374766bc2   Stephen Hemminger   Input: implement ...
58
  	cancel_delayed_work_sync(&dev->work);
b0aba1e66   Samu Onkalo   Input: add open a...
59
60
61
  
  	if (dev->close)
  		dev->close(dev);
0dcd80736   Dmitry Torokhov   Input: add skelet...
62
  }
dad725d08   Samu Onkalo   Input: input-poll...
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
  /* SYSFS interface */
  
  static ssize_t input_polldev_get_poll(struct device *dev,
  				      struct device_attribute *attr, char *buf)
  {
  	struct input_polled_dev *polldev = dev_get_drvdata(dev);
  
  	return sprintf(buf, "%d
  ", polldev->poll_interval);
  }
  
  static ssize_t input_polldev_set_poll(struct device *dev,
  				struct device_attribute *attr, const char *buf,
  				size_t count)
  {
  	struct input_polled_dev *polldev = dev_get_drvdata(dev);
  	struct input_dev *input = polldev->input;
  	unsigned long interval;
  
  	if (strict_strtoul(buf, 0, &interval))
  		return -EINVAL;
  
  	if (interval < polldev->poll_interval_min)
  		return -EINVAL;
  
  	if (interval > polldev->poll_interval_max)
  		return -EINVAL;
  
  	mutex_lock(&input->mutex);
  
  	polldev->poll_interval = interval;
  
  	if (input->users) {
  		cancel_delayed_work_sync(&polldev->work);
  		if (polldev->poll_interval > 0)
  			input_polldev_queue_work(polldev);
  	}
  
  	mutex_unlock(&input->mutex);
  
  	return count;
  }
  
  static DEVICE_ATTR(poll, S_IRUGO | S_IWUSR, input_polldev_get_poll,
  					    input_polldev_set_poll);
  
  
  static ssize_t input_polldev_get_max(struct device *dev,
  				     struct device_attribute *attr, char *buf)
  {
  	struct input_polled_dev *polldev = dev_get_drvdata(dev);
  
  	return sprintf(buf, "%d
  ", polldev->poll_interval_max);
  }
  
  static DEVICE_ATTR(max, S_IRUGO, input_polldev_get_max, NULL);
  
  static ssize_t input_polldev_get_min(struct device *dev,
  				     struct device_attribute *attr, char *buf)
  {
  	struct input_polled_dev *polldev = dev_get_drvdata(dev);
  
  	return sprintf(buf, "%d
  ", polldev->poll_interval_min);
  }
  
  static DEVICE_ATTR(min, S_IRUGO, input_polldev_get_min, NULL);
  
  static struct attribute *sysfs_attrs[] = {
  	&dev_attr_poll.attr,
  	&dev_attr_max.attr,
  	&dev_attr_min.attr,
  	NULL
  };
  
  static struct attribute_group input_polldev_attribute_group = {
  	.attrs = sysfs_attrs
  };
0dcd80736   Dmitry Torokhov   Input: add skelet...
142
  /**
2546bcc2d   Dmitry Torokhov   Input: input-poll...
143
   * input_allocate_polled_device - allocate memory for polled device
0dcd80736   Dmitry Torokhov   Input: add skelet...
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
   *
   * The function allocates memory for a polled device and also
   * for an input device associated with this polled device.
   */
  struct input_polled_dev *input_allocate_polled_device(void)
  {
  	struct input_polled_dev *dev;
  
  	dev = kzalloc(sizeof(struct input_polled_dev), GFP_KERNEL);
  	if (!dev)
  		return NULL;
  
  	dev->input = input_allocate_device();
  	if (!dev->input) {
  		kfree(dev);
  		return NULL;
  	}
  
  	return dev;
  }
  EXPORT_SYMBOL(input_allocate_polled_device);
  
  /**
   * input_free_polled_device - free memory allocated for polled device
   * @dev: device to free
   *
   * The function frees memory allocated for polling device and drops
36203c4f3   Dmitry Torokhov   Input: add generi...
171
   * reference to the associated input device.
0dcd80736   Dmitry Torokhov   Input: add skelet...
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
   */
  void input_free_polled_device(struct input_polled_dev *dev)
  {
  	if (dev) {
  		input_free_device(dev->input);
  		kfree(dev);
  	}
  }
  EXPORT_SYMBOL(input_free_polled_device);
  
  /**
   * input_register_polled_device - register polled device
   * @dev: device to register
   *
   * The function registers previously initialized polled input device
   * with input layer. The device should be allocated with call to
   * input_allocate_polled_device(). Callers should also set up poll()
   * method and set up capabilities (id, name, phys, bits) of the
2546bcc2d   Dmitry Torokhov   Input: input-poll...
190
   * corresponding input_dev structure.
0dcd80736   Dmitry Torokhov   Input: add skelet...
191
192
193
194
   */
  int input_register_polled_device(struct input_polled_dev *dev)
  {
  	struct input_dev *input = dev->input;
dad725d08   Samu Onkalo   Input: input-poll...
195
  	int error;
0dcd80736   Dmitry Torokhov   Input: add skelet...
196

3797fec17   Dmitry Torokhov   Input: remove pri...
197
  	input_set_drvdata(input, dev);
0dcd80736   Dmitry Torokhov   Input: add skelet...
198
199
200
  	INIT_DELAYED_WORK(&dev->work, input_polled_device_work);
  	if (!dev->poll_interval)
  		dev->poll_interval = 500;
dad725d08   Samu Onkalo   Input: input-poll...
201
202
  	if (!dev->poll_interval_max)
  		dev->poll_interval_max = dev->poll_interval;
0dcd80736   Dmitry Torokhov   Input: add skelet...
203
204
  	input->open = input_open_polled_device;
  	input->close = input_close_polled_device;
dad725d08   Samu Onkalo   Input: input-poll...
205
206
207
208
209
210
211
212
213
214
  	error = input_register_device(input);
  	if (error)
  		return error;
  
  	error = sysfs_create_group(&input->dev.kobj,
  				   &input_polldev_attribute_group);
  	if (error) {
  		input_unregister_device(input);
  		return error;
  	}
36203c4f3   Dmitry Torokhov   Input: add generi...
215
216
217
218
219
220
221
222
  	/*
  	 * Take extra reference to the underlying input device so
  	 * that it survives call to input_unregister_polled_device()
  	 * and is deleted only after input_free_polled_device()
  	 * has been invoked. This is needed to ease task of freeing
  	 * sparse keymaps.
  	 */
  	input_get_device(input);
dad725d08   Samu Onkalo   Input: input-poll...
223
  	return 0;
0dcd80736   Dmitry Torokhov   Input: add skelet...
224
225
226
227
228
229
230
231
232
233
  }
  EXPORT_SYMBOL(input_register_polled_device);
  
  /**
   * input_unregister_polled_device - unregister polled device
   * @dev: device to unregister
   *
   * The function unregisters previously registered polled input
   * device from input layer. Polling is stopped and device is
   * ready to be freed with call to input_free_polled_device().
0dcd80736   Dmitry Torokhov   Input: add skelet...
234
235
236
   */
  void input_unregister_polled_device(struct input_polled_dev *dev)
  {
dad725d08   Samu Onkalo   Input: input-poll...
237
238
  	sysfs_remove_group(&dev->input->dev.kobj,
  			   &input_polldev_attribute_group);
0dcd80736   Dmitry Torokhov   Input: add skelet...
239
  	input_unregister_device(dev->input);
0dcd80736   Dmitry Torokhov   Input: add skelet...
240
241
  }
  EXPORT_SYMBOL(input_unregister_polled_device);