654fbaa4bf0e32eded147a0895242fbdda1b3e8c
[profile/ivi/pulseaudio.git] / src / modules / module-mmkbd-evdev.c
1 /* $Id$ */
2
3 /***
4   This file is part of polypaudio.
5  
6   polypaudio is free software; you can redistribute it and/or modify
7   it under the terms of the GNU Lesser General Public License as published
8   by the Free Software Foundation; either version 2 of the License,
9   or (at your option) any later version.
10  
11   polypaudio is distributed in the hope that it will be useful, but
12   WITHOUT ANY WARRANTY; without even the implied warranty of
13   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14   General Public License for more details.
15  
16   You should have received a copy of the GNU Lesser General Public License
17   along with polypaudio; if not, write to the Free Software
18   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
19   USA.
20 ***/
21
22 #ifdef HAVE_CONFIG_H
23 #include <config.h>
24 #endif
25
26 #include <stdio.h>
27 #include <assert.h>
28 #include <unistd.h>
29 #include <string.h>
30 #include <stdlib.h>
31 #include <errno.h>
32 #include <fcntl.h>
33
34 #include <linux/input.h>
35
36 #include <polyp/xmalloc.h>
37
38 #include <polypcore/module.h>
39 #include <polypcore/log.h>
40 #include <polypcore/namereg.h>
41 #include <polypcore/sink.h>
42 #include <polypcore/modargs.h>
43 #include <polypcore/util.h>
44
45 #include "module-mmkbd-evdev-symdef.h"
46
47 PA_MODULE_AUTHOR("Lennart Poettering")
48 PA_MODULE_DESCRIPTION("Multimedia keyboard support via Linux evdev")
49 PA_MODULE_VERSION(PACKAGE_VERSION)
50 PA_MODULE_USAGE("device=<evdev device> sink=<sink name>")
51
52 #define DEFAULT_DEVICE "/dev/input/event0"
53
54 /*
55  * This isn't defined in older kernel headers and there is no way of
56  * detecting it.
57  */
58 struct _input_id {
59     __u16 bustype;
60     __u16 vendor;
61     __u16 product;
62     __u16 version;
63 };
64
65 static const char* const valid_modargs[] = {
66     "device",
67     "sink",
68     NULL,
69 };
70
71 struct userdata {
72     int fd;
73     pa_io_event *io;
74     char *sink_name;
75     pa_module *module;
76 };
77
78 static void io_callback(pa_mainloop_api *io, PA_GCC_UNUSED pa_io_event *e, PA_GCC_UNUSED int fd, pa_io_event_flags_t events, void*userdata) {
79     struct userdata *u = userdata;
80     assert(io);
81     assert(u);
82
83     if (events & (PA_IO_EVENT_HANGUP|PA_IO_EVENT_ERROR)) {
84         pa_log(__FILE__": lost connection to evdev device.");
85         goto fail;
86     }
87         
88     if (events & PA_IO_EVENT_INPUT) {
89         struct input_event ev;
90
91         if (pa_loop_read(u->fd, &ev, sizeof(ev)) <= 0) {
92             pa_log(__FILE__": failed to read from event device: %s", strerror(errno));
93             goto fail;
94         }
95
96         if (ev.type == EV_KEY && (ev.value == 1 || ev.value == 2)) {
97             enum { INVALID, UP, DOWN, MUTE_TOGGLE } volchange = INVALID;
98
99             pa_log_debug(__FILE__": key code=%u, value=%u", ev.code, ev.value);
100
101             switch (ev.code) {
102                 case KEY_VOLUMEDOWN:  volchange = DOWN; break;
103                 case KEY_VOLUMEUP:    volchange = UP; break;
104                 case KEY_MUTE:        volchange = MUTE_TOGGLE; break;
105             }
106
107             if (volchange != INVALID) {
108                 pa_sink *s;
109                 
110                 if (!(s = pa_namereg_get(u->module->core, u->sink_name, PA_NAMEREG_SINK, 1)))
111                     pa_log(__FILE__": failed to get sink '%s'", u->sink_name);
112                 else {
113                     int i;
114                     pa_cvolume cv = *pa_sink_get_volume(s, PA_MIXER_HARDWARE);
115                     
116 #define DELTA (PA_VOLUME_NORM/20)
117                     
118                     switch (volchange) {
119                         case UP:
120                             for (i = 0; i < cv.channels; i++) {
121                                 cv.values[i] += DELTA;
122
123                                 if (cv.values[i] > PA_VOLUME_NORM)
124                                     cv.values[i] = PA_VOLUME_NORM;
125                             }
126
127                             pa_sink_set_volume(s, PA_MIXER_HARDWARE, &cv);
128                             break;
129                             
130                         case DOWN:
131                             for (i = 0; i < cv.channels; i++) {
132                                 if (cv.values[i] >= DELTA)
133                                     cv.values[i] -= DELTA;
134                                 else
135                                     cv.values[i] = PA_VOLUME_MUTED;
136                             }
137                             
138                             pa_sink_set_volume(s, PA_MIXER_HARDWARE, &cv);
139                             break;
140                             
141                         case MUTE_TOGGLE:
142
143                             pa_sink_set_mute(s, PA_MIXER_HARDWARE, !pa_sink_get_mute(s, PA_MIXER_HARDWARE));
144                             break;
145
146                         case INVALID:
147                             ;
148                     }
149                 }
150             }
151         }
152     }
153
154     return;
155     
156 fail:
157     u->module->core->mainloop->io_free(u->io);
158     u->io = NULL;
159
160     pa_module_unload_request(u->module);
161 }
162
163 #define test_bit(bit, array) (array[bit/8] & (1<<(bit%8)))
164     
165 int pa__init(pa_core *c, pa_module*m) {
166     pa_modargs *ma = NULL;
167     struct userdata *u;
168     int version;
169     struct _input_id input_id;
170     char name[256];
171     uint8_t evtype_bitmask[EV_MAX/8 + 1];
172     assert(c && m);
173
174     if (!(ma = pa_modargs_new(m->argument, valid_modargs))) {
175         pa_log(__FILE__": Failed to parse module arguments");
176         goto fail;
177     }
178
179     m->userdata = u = pa_xmalloc(sizeof(struct userdata));
180     u->module = m;
181     u->io = NULL;
182     u->sink_name = pa_xstrdup(pa_modargs_get_value(ma, "sink", NULL));
183     u->fd = -1;
184
185     if ((u->fd = open(pa_modargs_get_value(ma, "device", DEFAULT_DEVICE), O_RDONLY)) < 0) {
186         pa_log(__FILE__": failed to open evdev device: %s", strerror(errno));
187         goto fail;
188     }
189
190     if (ioctl(u->fd, EVIOCGVERSION, &version) < 0) {
191         pa_log(__FILE__": EVIOCGVERSION failed: %s", strerror(errno));
192         goto fail;
193     }
194
195     pa_log_info(__FILE__": evdev driver version %i.%i.%i", version >> 16, (version >> 8) & 0xff, version & 0xff);
196
197     if(ioctl(u->fd, EVIOCGID, &input_id)) {
198         pa_log(__FILE__": EVIOCGID failed: %s", strerror(errno));
199         goto fail;
200     }
201
202     pa_log_info(__FILE__": evdev vendor 0x%04hx product 0x%04hx version 0x%04hx bustype %u",
203                 input_id.vendor, input_id.product, input_id.version, input_id.bustype);
204
205     memset(name, 0, sizeof(name));
206     if(ioctl(u->fd, EVIOCGNAME(sizeof(name)), name) < 0) {
207         pa_log(__FILE__": EVIOCGNAME failed: %s", strerror(errno));
208         goto fail;
209     }
210
211     pa_log_info(__FILE__": evdev device name: %s", name);
212
213     memset(evtype_bitmask, 0, sizeof(evtype_bitmask));
214     if (ioctl(u->fd, EVIOCGBIT(0, EV_MAX), evtype_bitmask) < 0) {
215         pa_log(__FILE__": EVIOCGBIT failed: %s", strerror(errno));
216         goto fail;
217     }
218
219     if (!test_bit(EV_KEY, evtype_bitmask)) {
220         pa_log(__FILE__": device has no keys.");
221         goto fail;
222     }
223
224     u->io = c->mainloop->io_new(c->mainloop, u->fd, PA_IO_EVENT_INPUT|PA_IO_EVENT_HANGUP, io_callback, u);
225
226     pa_modargs_free(ma);
227     
228     return 0;
229
230 fail:
231
232     if (ma)
233         pa_modargs_free(ma);
234
235     pa__done(c, m);
236     return -1;
237 }
238
239 void pa__done(pa_core *c, pa_module*m) {
240     struct userdata *u;
241     assert(c);
242     assert(m);
243
244     if (!(u = m->userdata))
245         return;
246
247     if (u->io)
248         m->core->mainloop->io_free(u->io);
249
250     if (u->fd >= 0)
251         close(u->fd);
252
253     pa_xfree(u->sink_name);
254     pa_xfree(u);
255 }