blob: a5abfd7a19f577d4e00bd4bbaf42f647641b9385 [file] [log] [blame]
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -08001/*
Mauro Carvalho Chehabf7abcd32005-11-08 21:38:25 -08002 handle em28xx IR remotes via linux kernel input layer.
3
4 Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it>
5 Markus Rechberger <mrechberger@gmail.com>
Mauro Carvalho Chehab2e7c6dc2006-04-03 07:53:40 -03006 Mauro Carvalho Chehab <mchehab@infradead.org>
Mauro Carvalho Chehabf7abcd32005-11-08 21:38:25 -08007 Sascha Sommer <saschasommer@freenet.de>
8
9 This program is free software; you can redistribute it and/or modify
10 it under the terms of the GNU General Public License as published by
11 the Free Software Foundation; either version 2 of the License, or
12 (at your option) any later version.
13
14 This program is distributed in the hope that it will be useful,
15 but WITHOUT ANY WARRANTY; without even the implied warranty of
16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 GNU General Public License for more details.
18
19 You should have received a copy of the GNU General Public License
20 along with this program; if not, write to the Free Software
21 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080022 */
23
24#include <linux/module.h>
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080025#include <linux/init.h>
26#include <linux/delay.h>
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080027#include <linux/interrupt.h>
28#include <linux/input.h>
29#include <linux/usb.h>
30
Mauro Carvalho Chehabf7abcd32005-11-08 21:38:25 -080031#include "em28xx.h"
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080032
Devin Heitmuellera9fc52b2008-06-28 08:57:06 -030033#define EM28XX_SNAPSHOT_KEY KEY_CAMERA
34#define EM28XX_SBUTTON_QUERY_INTERVAL 500
35#define EM28XX_R0C_USBSUSP_SNAPSHOT 0x20
36
Mauro Carvalho Chehabc8793b02008-01-13 15:42:17 -030037static unsigned int ir_debug;
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080038module_param(ir_debug, int, 0644);
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -030039MODULE_PARM_DESC(ir_debug, "enable debug messages [IR]");
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080040
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030041#define i2cdprintk(fmt, arg...) \
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -030042 if (ir_debug) { \
43 printk(KERN_DEBUG "%s/ir: " fmt, ir->c.name , ## arg); \
44 }
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080045
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030046#define dprintk(fmt, arg...) \
47 if (ir_debug) { \
48 printk(KERN_DEBUG "%s/ir: " fmt, ir->name , ## arg); \
49 }
50
51/**********************************************************
52 Polling structure used by em28xx IR's
53 **********************************************************/
54
Devin Heitmueller4b922532008-11-13 03:15:55 -030055struct em28xx_ir_poll_result {
56 unsigned int toggle_bit:1;
57 unsigned int read_count:7;
58 u8 rc_address;
59 u8 rc_data[4]; /* 1 byte on em2860/2880, 4 on em2874 */
60};
61
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030062struct em28xx_IR {
63 struct em28xx *dev;
64 struct input_dev *input;
65 struct ir_input_state ir;
66 char name[32];
67 char phys[32];
68
69 /* poll external decoder */
70 int polling;
Jean Delvaref263bac2009-03-07 07:43:01 -030071 struct delayed_work work;
Devin Heitmueller4b922532008-11-13 03:15:55 -030072 unsigned int last_toggle:1;
73 unsigned int last_readcount;
74 unsigned int repeat_interval;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030075
Devin Heitmueller4b922532008-11-13 03:15:55 -030076 int (*get_key)(struct em28xx_IR *, struct em28xx_ir_poll_result *);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030077};
78
79/**********************************************************
80 I2C IR based get keycodes - should be used with ir-kbd-i2c
81 **********************************************************/
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080082
Mauro Carvalho Chehabc8793b02008-01-13 15:42:17 -030083int em28xx_get_key_terratec(struct IR_i2c *ir, u32 *ir_key, u32 *ir_raw)
Markus Rechbergere43f14a2005-11-08 21:37:35 -080084{
85 unsigned char b;
86
87 /* poll IR chip */
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -030088 if (1 != i2c_master_recv(&ir->c, &b, 1)) {
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030089 i2cdprintk("read error\n");
Markus Rechbergere43f14a2005-11-08 21:37:35 -080090 return -EIO;
91 }
92
93 /* it seems that 0xFE indicates that a button is still hold
Mauro Carvalho Chehab4f9c05a2005-11-08 21:37:36 -080094 down, while 0xff indicates that no button is hold
95 down. 0xfe sequences are sometimes interrupted by 0xFF */
Markus Rechbergere43f14a2005-11-08 21:37:35 -080096
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030097 i2cdprintk("key %02x\n", b);
Markus Rechbergere43f14a2005-11-08 21:37:35 -080098
Mauro Carvalho Chehab4f9c05a2005-11-08 21:37:36 -080099 if (b == 0xff)
Markus Rechbergere43f14a2005-11-08 21:37:35 -0800100 return 0;
101
Mauro Carvalho Chehab4f9c05a2005-11-08 21:37:36 -0800102 if (b == 0xfe)
Markus Rechbergere43f14a2005-11-08 21:37:35 -0800103 /* keep old data */
104 return 1;
105
106 *ir_key = b;
107 *ir_raw = b;
108 return 1;
109}
110
Mauro Carvalho Chehabc8793b02008-01-13 15:42:17 -0300111int em28xx_get_key_em_haup(struct IR_i2c *ir, u32 *ir_key, u32 *ir_raw)
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800112{
113 unsigned char buf[2];
114 unsigned char code;
115
116 /* poll IR chip */
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300117 if (2 != i2c_master_recv(&ir->c, buf, 2))
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800118 return -EIO;
119
120 /* Does eliminate repeated parity code */
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300121 if (buf[1] == 0xff)
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800122 return 0;
123
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300124 ir->old = buf[1];
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800125
126 /* Rearranges bits to the right order */
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300127 code = ((buf[0]&0x01)<<5) | /* 0010 0000 */
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800128 ((buf[0]&0x02)<<3) | /* 0001 0000 */
129 ((buf[0]&0x04)<<1) | /* 0000 1000 */
130 ((buf[0]&0x08)>>1) | /* 0000 0100 */
131 ((buf[0]&0x10)>>3) | /* 0000 0010 */
132 ((buf[0]&0x20)>>5); /* 0000 0001 */
133
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300134 i2cdprintk("ir hauppauge (em2840): code=0x%02x (rcv=0x%02x)\n",
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300135 code, buf[0]);
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800136
137 /* return key */
138 *ir_key = code;
139 *ir_raw = code;
140 return 1;
141}
142
Mauro Carvalho Chehabc8793b02008-01-13 15:42:17 -0300143int em28xx_get_key_pinnacle_usb_grey(struct IR_i2c *ir, u32 *ir_key,
144 u32 *ir_raw)
Markus Rechberger366cc642006-01-15 21:04:27 -0200145{
146 unsigned char buf[3];
147
148 /* poll IR chip */
149
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300150 if (3 != i2c_master_recv(&ir->c, buf, 3)) {
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300151 i2cdprintk("read error\n");
Markus Rechberger366cc642006-01-15 21:04:27 -0200152 return -EIO;
153 }
154
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300155 i2cdprintk("key %02x\n", buf[2]&0x3f);
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300156 if (buf[0] != 0x00)
Markus Rechberger366cc642006-01-15 21:04:27 -0200157 return 0;
Markus Rechberger366cc642006-01-15 21:04:27 -0200158
159 *ir_key = buf[2]&0x3f;
160 *ir_raw = buf[2]&0x3f;
161
162 return 1;
163}
164
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300165/**********************************************************
166 Poll based get keycode functions
167 **********************************************************/
168
Devin Heitmueller4b922532008-11-13 03:15:55 -0300169/* This is for the em2860/em2880 */
170static int default_polling_getkey(struct em28xx_IR *ir,
171 struct em28xx_ir_poll_result *poll_result)
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300172{
173 struct em28xx *dev = ir->dev;
174 int rc;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300175 u8 msg[3] = { 0, 0, 0 };
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300176
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300177 /* Read key toggle, brand, and key code
178 on registers 0x45, 0x46 and 0x47
179 */
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300180 rc = dev->em28xx_read_reg_req_len(dev, 0, EM28XX_R45_IR,
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300181 msg, sizeof(msg));
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300182 if (rc < 0)
183 return rc;
184
Devin Heitmueller4b922532008-11-13 03:15:55 -0300185 /* Infrared toggle (Reg 0x45[7]) */
186 poll_result->toggle_bit = (msg[0] >> 7);
187
188 /* Infrared read count (Reg 0x45[6:0] */
189 poll_result->read_count = (msg[0] & 0x7f);
190
191 /* Remote Control Address (Reg 0x46) */
192 poll_result->rc_address = msg[1];
193
194 /* Remote Control Data (Reg 0x47) */
195 poll_result->rc_data[0] = msg[2];
196
197 return 0;
198}
199
200static int em2874_polling_getkey(struct em28xx_IR *ir,
201 struct em28xx_ir_poll_result *poll_result)
202{
203 struct em28xx *dev = ir->dev;
204 int rc;
205 u8 msg[5] = { 0, 0, 0, 0, 0 };
206
207 /* Read key toggle, brand, and key code
208 on registers 0x51-55
209 */
210 rc = dev->em28xx_read_reg_req_len(dev, 0, EM2874_R51_IR,
211 msg, sizeof(msg));
212 if (rc < 0)
213 return rc;
214
215 /* Infrared toggle (Reg 0x51[7]) */
216 poll_result->toggle_bit = (msg[0] >> 7);
217
218 /* Infrared read count (Reg 0x51[6:0] */
219 poll_result->read_count = (msg[0] & 0x7f);
220
221 /* Remote Control Address (Reg 0x52) */
222 poll_result->rc_address = msg[1];
223
224 /* Remote Control Data (Reg 0x53-55) */
225 poll_result->rc_data[0] = msg[2];
226 poll_result->rc_data[1] = msg[3];
227 poll_result->rc_data[2] = msg[4];
228
229 return 0;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300230}
231
232/**********************************************************
233 Polling code for em28xx
234 **********************************************************/
235
236static void em28xx_ir_handle_key(struct em28xx_IR *ir)
237{
Devin Heitmueller4b922532008-11-13 03:15:55 -0300238 int result;
239 int do_sendkey = 0;
240 struct em28xx_ir_poll_result poll_result;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300241
Devin Heitmueller4b922532008-11-13 03:15:55 -0300242 /* read the registers containing the IR status */
243 result = ir->get_key(ir, &poll_result);
244 if (result < 0) {
245 dprintk("ir->get_key() failed %d\n", result);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300246 return;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300247 }
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300248
Devin Heitmueller4b922532008-11-13 03:15:55 -0300249 dprintk("ir->get_key result tb=%02x rc=%02x lr=%02x data=%02x\n",
250 poll_result.toggle_bit, poll_result.read_count,
251 ir->last_readcount, poll_result.rc_data[0]);
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300252
Devin Heitmueller4b922532008-11-13 03:15:55 -0300253 if (ir->dev->chip_id == CHIP_ID_EM2874) {
254 /* The em2874 clears the readcount field every time the
255 register is read. The em2860/2880 datasheet says that it
256 is supposed to clear the readcount, but it doesn't. So with
257 the em2874, we are looking for a non-zero read count as
258 opposed to a readcount that is incrementing */
259 ir->last_readcount = 0;
260 }
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300261
Devin Heitmueller4b922532008-11-13 03:15:55 -0300262 if (poll_result.read_count == 0) {
263 /* The button has not been pressed since the last read */
264 } else if (ir->last_toggle != poll_result.toggle_bit) {
265 /* A button has been pressed */
266 dprintk("button has been pressed\n");
267 ir->last_toggle = poll_result.toggle_bit;
268 ir->repeat_interval = 0;
269 do_sendkey = 1;
270 } else if (poll_result.toggle_bit == ir->last_toggle &&
271 poll_result.read_count > 0 &&
272 poll_result.read_count != ir->last_readcount) {
273 /* The button is still being held down */
274 dprintk("button being held down\n");
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300275
Devin Heitmueller4b922532008-11-13 03:15:55 -0300276 /* Debouncer for first keypress */
277 if (ir->repeat_interval++ > 9) {
278 /* Start repeating after 1 second */
279 do_sendkey = 1;
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300280 }
Devin Heitmueller4b922532008-11-13 03:15:55 -0300281 }
282
283 if (do_sendkey) {
284 dprintk("sending keypress\n");
285 ir_input_keydown(ir->input, &ir->ir, poll_result.rc_data[0],
286 poll_result.rc_data[0]);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300287 ir_input_nokey(ir->input, &ir->ir);
288 }
Devin Heitmueller4b922532008-11-13 03:15:55 -0300289
290 ir->last_readcount = poll_result.read_count;
291 return;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300292}
293
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300294static void em28xx_ir_work(struct work_struct *work)
295{
Jean Delvaref263bac2009-03-07 07:43:01 -0300296 struct em28xx_IR *ir = container_of(work, struct em28xx_IR, work.work);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300297
298 em28xx_ir_handle_key(ir);
Jean Delvaref263bac2009-03-07 07:43:01 -0300299 schedule_delayed_work(&ir->work, msecs_to_jiffies(ir->polling));
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300300}
301
Mauro Carvalho Chehab26cdc762009-01-05 01:00:40 -0300302static void em28xx_ir_start(struct em28xx_IR *ir)
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300303{
Jean Delvaref263bac2009-03-07 07:43:01 -0300304 INIT_DELAYED_WORK(&ir->work, em28xx_ir_work);
305 schedule_delayed_work(&ir->work, 0);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300306}
307
308static void em28xx_ir_stop(struct em28xx_IR *ir)
309{
Jean Delvaref263bac2009-03-07 07:43:01 -0300310 cancel_delayed_work_sync(&ir->work);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300311}
312
313int em28xx_ir_init(struct em28xx *dev)
314{
315 struct em28xx_IR *ir;
316 struct input_dev *input_dev;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300317 u8 ir_config;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300318 int err = -ENOMEM;
319
Mauro Carvalho Chehab505b6d02008-11-25 09:39:50 -0300320 if (dev->board.ir_codes == NULL) {
Devin Heitmueller4b922532008-11-13 03:15:55 -0300321 /* No remote control support */
322 return 0;
323 }
324
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300325 ir = kzalloc(sizeof(*ir), GFP_KERNEL);
326 input_dev = input_allocate_device();
327 if (!ir || !input_dev)
328 goto err_out_free;
329
330 ir->input = input_dev;
331
Devin Heitmueller4b922532008-11-13 03:15:55 -0300332 /* Setup the proper handler based on the chip */
333 switch (dev->chip_id) {
334 case CHIP_ID_EM2860:
335 case CHIP_ID_EM2883:
336 ir->get_key = default_polling_getkey;
Mauro Carvalho Chehab91812fa2008-11-12 14:05:46 -0300337 break;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300338 case CHIP_ID_EM2874:
339 ir->get_key = em2874_polling_getkey;
340 /* For now we only support RC5, so enable it */
341 ir_config = EM2874_IR_RC5;
342 em28xx_write_regs(dev, EM2874_R50_IR_CONFIG, &ir_config, 1);
343 break;
344 default:
345 printk("Unrecognized em28xx chip id: IR not supported\n");
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300346 goto err_out_free;
347 }
348
Devin Heitmueller4b922532008-11-13 03:15:55 -0300349 /* This is how often we ask the chip for IR information */
350 ir->polling = 100; /* ms */
351
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300352 /* init input device */
353 snprintf(ir->name, sizeof(ir->name), "em28xx IR (%s)",
354 dev->name);
355
356 usb_make_path(dev->udev, ir->phys, sizeof(ir->phys));
357 strlcat(ir->phys, "/input0", sizeof(ir->phys));
358
Mauro Carvalho Chehab505b6d02008-11-25 09:39:50 -0300359 ir_input_init(input_dev, &ir->ir, IR_TYPE_OTHER, dev->board.ir_codes);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300360 input_dev->name = ir->name;
361 input_dev->phys = ir->phys;
362 input_dev->id.bustype = BUS_USB;
363 input_dev->id.version = 1;
364 input_dev->id.vendor = le16_to_cpu(dev->udev->descriptor.idVendor);
365 input_dev->id.product = le16_to_cpu(dev->udev->descriptor.idProduct);
366
367 input_dev->dev.parent = &dev->udev->dev;
368 /* record handles to ourself */
369 ir->dev = dev;
370 dev->ir = ir;
371
372 em28xx_ir_start(ir);
373
374 /* all done */
375 err = input_register_device(ir->input);
376 if (err)
377 goto err_out_stop;
378
379 return 0;
380 err_out_stop:
381 em28xx_ir_stop(ir);
382 dev->ir = NULL;
383 err_out_free:
384 input_free_device(input_dev);
385 kfree(ir);
386 return err;
387}
388
389int em28xx_ir_fini(struct em28xx *dev)
390{
391 struct em28xx_IR *ir = dev->ir;
392
393 /* skip detach on non attached boards */
394 if (!ir)
395 return 0;
396
397 em28xx_ir_stop(ir);
398 input_unregister_device(ir->input);
399 kfree(ir);
400
401 /* done */
402 dev->ir = NULL;
403 return 0;
404}
405
406/**********************************************************
407 Handle Webcam snapshot button
408 **********************************************************/
409
Devin Heitmuellera9fc52b2008-06-28 08:57:06 -0300410static void em28xx_query_sbutton(struct work_struct *work)
411{
412 /* Poll the register and see if the button is depressed */
413 struct em28xx *dev =
414 container_of(work, struct em28xx, sbutton_query_work.work);
415 int ret;
416
417 ret = em28xx_read_reg(dev, EM28XX_R0C_USBSUSP);
418
419 if (ret & EM28XX_R0C_USBSUSP_SNAPSHOT) {
420 u8 cleared;
421 /* Button is depressed, clear the register */
422 cleared = ((u8) ret) & ~EM28XX_R0C_USBSUSP_SNAPSHOT;
423 em28xx_write_regs(dev, EM28XX_R0C_USBSUSP, &cleared, 1);
424
425 /* Not emulate the keypress */
426 input_report_key(dev->sbutton_input_dev, EM28XX_SNAPSHOT_KEY,
427 1);
428 /* Now unpress the key */
429 input_report_key(dev->sbutton_input_dev, EM28XX_SNAPSHOT_KEY,
430 0);
431 }
432
433 /* Schedule next poll */
434 schedule_delayed_work(&dev->sbutton_query_work,
435 msecs_to_jiffies(EM28XX_SBUTTON_QUERY_INTERVAL));
436}
437
438void em28xx_register_snapshot_button(struct em28xx *dev)
439{
440 struct input_dev *input_dev;
441 int err;
442
443 em28xx_info("Registering snapshot button...\n");
444 input_dev = input_allocate_device();
445 if (!input_dev) {
446 em28xx_errdev("input_allocate_device failed\n");
447 return;
448 }
449
450 usb_make_path(dev->udev, dev->snapshot_button_path,
451 sizeof(dev->snapshot_button_path));
452 strlcat(dev->snapshot_button_path, "/sbutton",
453 sizeof(dev->snapshot_button_path));
454 INIT_DELAYED_WORK(&dev->sbutton_query_work, em28xx_query_sbutton);
455
456 input_dev->name = "em28xx snapshot button";
457 input_dev->phys = dev->snapshot_button_path;
458 input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
459 set_bit(EM28XX_SNAPSHOT_KEY, input_dev->keybit);
460 input_dev->keycodesize = 0;
461 input_dev->keycodemax = 0;
462 input_dev->id.bustype = BUS_USB;
463 input_dev->id.vendor = le16_to_cpu(dev->udev->descriptor.idVendor);
464 input_dev->id.product = le16_to_cpu(dev->udev->descriptor.idProduct);
465 input_dev->id.version = 1;
466 input_dev->dev.parent = &dev->udev->dev;
467
468 err = input_register_device(input_dev);
469 if (err) {
470 em28xx_errdev("input_register_device failed\n");
471 input_free_device(input_dev);
472 return;
473 }
474
475 dev->sbutton_input_dev = input_dev;
476 schedule_delayed_work(&dev->sbutton_query_work,
477 msecs_to_jiffies(EM28XX_SBUTTON_QUERY_INTERVAL));
478 return;
479
480}
481
482void em28xx_deregister_snapshot_button(struct em28xx *dev)
483{
484 if (dev->sbutton_input_dev != NULL) {
485 em28xx_info("Deregistering snapshot button\n");
486 cancel_rearming_delayed_work(&dev->sbutton_query_work);
487 input_unregister_device(dev->sbutton_input_dev);
488 dev->sbutton_input_dev = NULL;
489 }
490 return;
491}