blob: 3f5cf02f31476d49fbf232f9e7496e4719de3e79 [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) { \
Jean Delvare1df8e982009-05-13 16:48:07 -030043 printk(KERN_DEBUG "%s/ir: " fmt, ir->name , ## arg); \
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -030044 }
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;
Mauro Carvalho Chehab02781552009-11-27 23:28:40 -030073 unsigned int full_code:1;
Devin Heitmueller4b922532008-11-13 03:15:55 -030074 unsigned int last_readcount;
75 unsigned int repeat_interval;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030076
Devin Heitmueller4b922532008-11-13 03:15:55 -030077 int (*get_key)(struct em28xx_IR *, struct em28xx_ir_poll_result *);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030078};
79
80/**********************************************************
81 I2C IR based get keycodes - should be used with ir-kbd-i2c
82 **********************************************************/
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -080083
Mauro Carvalho Chehabc8793b02008-01-13 15:42:17 -030084int em28xx_get_key_terratec(struct IR_i2c *ir, u32 *ir_key, u32 *ir_raw)
Markus Rechbergere43f14a2005-11-08 21:37:35 -080085{
86 unsigned char b;
87
88 /* poll IR chip */
Jean Delvarec668f322009-05-13 16:48:50 -030089 if (1 != i2c_master_recv(ir->c, &b, 1)) {
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030090 i2cdprintk("read error\n");
Markus Rechbergere43f14a2005-11-08 21:37:35 -080091 return -EIO;
92 }
93
94 /* it seems that 0xFE indicates that a button is still hold
Mauro Carvalho Chehab4f9c05a2005-11-08 21:37:36 -080095 down, while 0xff indicates that no button is hold
96 down. 0xfe sequences are sometimes interrupted by 0xFF */
Markus Rechbergere43f14a2005-11-08 21:37:35 -080097
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -030098 i2cdprintk("key %02x\n", b);
Markus Rechbergere43f14a2005-11-08 21:37:35 -080099
Mauro Carvalho Chehab4f9c05a2005-11-08 21:37:36 -0800100 if (b == 0xff)
Markus Rechbergere43f14a2005-11-08 21:37:35 -0800101 return 0;
102
Mauro Carvalho Chehab4f9c05a2005-11-08 21:37:36 -0800103 if (b == 0xfe)
Markus Rechbergere43f14a2005-11-08 21:37:35 -0800104 /* keep old data */
105 return 1;
106
107 *ir_key = b;
108 *ir_raw = b;
109 return 1;
110}
111
Mauro Carvalho Chehabc8793b02008-01-13 15:42:17 -0300112int em28xx_get_key_em_haup(struct IR_i2c *ir, u32 *ir_key, u32 *ir_raw)
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800113{
114 unsigned char buf[2];
115 unsigned char code;
116
117 /* poll IR chip */
Jean Delvarec668f322009-05-13 16:48:50 -0300118 if (2 != i2c_master_recv(ir->c, buf, 2))
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800119 return -EIO;
120
121 /* Does eliminate repeated parity code */
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300122 if (buf[1] == 0xff)
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800123 return 0;
124
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300125 ir->old = buf[1];
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800126
127 /* Rearranges bits to the right order */
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300128 code = ((buf[0]&0x01)<<5) | /* 0010 0000 */
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800129 ((buf[0]&0x02)<<3) | /* 0001 0000 */
130 ((buf[0]&0x04)<<1) | /* 0000 1000 */
131 ((buf[0]&0x08)>>1) | /* 0000 0100 */
132 ((buf[0]&0x10)>>3) | /* 0000 0010 */
133 ((buf[0]&0x20)>>5); /* 0000 0001 */
134
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300135 i2cdprintk("ir hauppauge (em2840): code=0x%02x (rcv=0x%02x)\n",
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300136 code, buf[0]);
Mauro Carvalho Chehabd5e52652005-11-08 21:37:32 -0800137
138 /* return key */
139 *ir_key = code;
140 *ir_raw = code;
141 return 1;
142}
143
Mauro Carvalho Chehabc8793b02008-01-13 15:42:17 -0300144int em28xx_get_key_pinnacle_usb_grey(struct IR_i2c *ir, u32 *ir_key,
145 u32 *ir_raw)
Markus Rechberger366cc642006-01-15 21:04:27 -0200146{
147 unsigned char buf[3];
148
149 /* poll IR chip */
150
Jean Delvarec668f322009-05-13 16:48:50 -0300151 if (3 != i2c_master_recv(ir->c, buf, 3)) {
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300152 i2cdprintk("read error\n");
Markus Rechberger366cc642006-01-15 21:04:27 -0200153 return -EIO;
154 }
155
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300156 i2cdprintk("key %02x\n", buf[2]&0x3f);
Douglas Schilling Landgraf6ea54d92008-04-17 21:41:10 -0300157 if (buf[0] != 0x00)
Markus Rechberger366cc642006-01-15 21:04:27 -0200158 return 0;
Markus Rechberger366cc642006-01-15 21:04:27 -0200159
160 *ir_key = buf[2]&0x3f;
161 *ir_raw = buf[2]&0x3f;
162
163 return 1;
164}
165
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300166/**********************************************************
167 Poll based get keycode functions
168 **********************************************************/
169
Devin Heitmueller4b922532008-11-13 03:15:55 -0300170/* This is for the em2860/em2880 */
171static int default_polling_getkey(struct em28xx_IR *ir,
172 struct em28xx_ir_poll_result *poll_result)
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300173{
174 struct em28xx *dev = ir->dev;
175 int rc;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300176 u8 msg[3] = { 0, 0, 0 };
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300177
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300178 /* Read key toggle, brand, and key code
179 on registers 0x45, 0x46 and 0x47
180 */
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300181 rc = dev->em28xx_read_reg_req_len(dev, 0, EM28XX_R45_IR,
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300182 msg, sizeof(msg));
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300183 if (rc < 0)
184 return rc;
185
Devin Heitmueller4b922532008-11-13 03:15:55 -0300186 /* Infrared toggle (Reg 0x45[7]) */
187 poll_result->toggle_bit = (msg[0] >> 7);
188
189 /* Infrared read count (Reg 0x45[6:0] */
190 poll_result->read_count = (msg[0] & 0x7f);
191
192 /* Remote Control Address (Reg 0x46) */
193 poll_result->rc_address = msg[1];
194
195 /* Remote Control Data (Reg 0x47) */
196 poll_result->rc_data[0] = msg[2];
197
198 return 0;
199}
200
201static int em2874_polling_getkey(struct em28xx_IR *ir,
202 struct em28xx_ir_poll_result *poll_result)
203{
204 struct em28xx *dev = ir->dev;
205 int rc;
206 u8 msg[5] = { 0, 0, 0, 0, 0 };
207
208 /* Read key toggle, brand, and key code
209 on registers 0x51-55
210 */
211 rc = dev->em28xx_read_reg_req_len(dev, 0, EM2874_R51_IR,
212 msg, sizeof(msg));
213 if (rc < 0)
214 return rc;
215
216 /* Infrared toggle (Reg 0x51[7]) */
217 poll_result->toggle_bit = (msg[0] >> 7);
218
219 /* Infrared read count (Reg 0x51[6:0] */
220 poll_result->read_count = (msg[0] & 0x7f);
221
222 /* Remote Control Address (Reg 0x52) */
223 poll_result->rc_address = msg[1];
224
225 /* Remote Control Data (Reg 0x53-55) */
226 poll_result->rc_data[0] = msg[2];
227 poll_result->rc_data[1] = msg[3];
228 poll_result->rc_data[2] = msg[4];
229
230 return 0;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300231}
232
233/**********************************************************
234 Polling code for em28xx
235 **********************************************************/
236
237static void em28xx_ir_handle_key(struct em28xx_IR *ir)
238{
Devin Heitmueller4b922532008-11-13 03:15:55 -0300239 int result;
240 int do_sendkey = 0;
241 struct em28xx_ir_poll_result poll_result;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300242
Devin Heitmueller4b922532008-11-13 03:15:55 -0300243 /* read the registers containing the IR status */
244 result = ir->get_key(ir, &poll_result);
245 if (result < 0) {
246 dprintk("ir->get_key() failed %d\n", result);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300247 return;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300248 }
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300249
Mauro Carvalho Chehab02781552009-11-27 23:28:40 -0300250 dprintk("ir->get_key result tb=%02x rc=%02x lr=%02x data=%02x%02x\n",
Devin Heitmueller4b922532008-11-13 03:15:55 -0300251 poll_result.toggle_bit, poll_result.read_count,
Mauro Carvalho Chehab02781552009-11-27 23:28:40 -0300252 ir->last_readcount, poll_result.rc_address,
253 poll_result.rc_data[0]);
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300254
Devin Heitmueller4b922532008-11-13 03:15:55 -0300255 if (ir->dev->chip_id == CHIP_ID_EM2874) {
256 /* The em2874 clears the readcount field every time the
257 register is read. The em2860/2880 datasheet says that it
258 is supposed to clear the readcount, but it doesn't. So with
259 the em2874, we are looking for a non-zero read count as
260 opposed to a readcount that is incrementing */
261 ir->last_readcount = 0;
262 }
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300263
Devin Heitmueller4b922532008-11-13 03:15:55 -0300264 if (poll_result.read_count == 0) {
265 /* The button has not been pressed since the last read */
266 } else if (ir->last_toggle != poll_result.toggle_bit) {
267 /* A button has been pressed */
268 dprintk("button has been pressed\n");
269 ir->last_toggle = poll_result.toggle_bit;
270 ir->repeat_interval = 0;
271 do_sendkey = 1;
272 } else if (poll_result.toggle_bit == ir->last_toggle &&
273 poll_result.read_count > 0 &&
274 poll_result.read_count != ir->last_readcount) {
275 /* The button is still being held down */
276 dprintk("button being held down\n");
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300277
Devin Heitmueller4b922532008-11-13 03:15:55 -0300278 /* Debouncer for first keypress */
279 if (ir->repeat_interval++ > 9) {
280 /* Start repeating after 1 second */
281 do_sendkey = 1;
Mauro Carvalho Chehab0a6b8a82008-11-12 18:46:01 -0300282 }
Devin Heitmueller4b922532008-11-13 03:15:55 -0300283 }
284
285 if (do_sendkey) {
286 dprintk("sending keypress\n");
Mauro Carvalho Chehab02781552009-11-27 23:28:40 -0300287
288 if (ir->full_code)
289 ir_input_keydown(ir->input, &ir->ir,
290 poll_result.rc_address << 8 |
291 poll_result.rc_data[0]);
292 else
293 ir_input_keydown(ir->input, &ir->ir,
294 poll_result.rc_data[0]);
295
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300296 ir_input_nokey(ir->input, &ir->ir);
297 }
Devin Heitmueller4b922532008-11-13 03:15:55 -0300298
299 ir->last_readcount = poll_result.read_count;
300 return;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300301}
302
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300303static void em28xx_ir_work(struct work_struct *work)
304{
Jean Delvaref263bac2009-03-07 07:43:01 -0300305 struct em28xx_IR *ir = container_of(work, struct em28xx_IR, work.work);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300306
307 em28xx_ir_handle_key(ir);
Jean Delvaref263bac2009-03-07 07:43:01 -0300308 schedule_delayed_work(&ir->work, msecs_to_jiffies(ir->polling));
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300309}
310
Mauro Carvalho Chehab26cdc762009-01-05 01:00:40 -0300311static void em28xx_ir_start(struct em28xx_IR *ir)
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300312{
Jean Delvaref263bac2009-03-07 07:43:01 -0300313 INIT_DELAYED_WORK(&ir->work, em28xx_ir_work);
314 schedule_delayed_work(&ir->work, 0);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300315}
316
317static void em28xx_ir_stop(struct em28xx_IR *ir)
318{
Jean Delvaref263bac2009-03-07 07:43:01 -0300319 cancel_delayed_work_sync(&ir->work);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300320}
321
322int em28xx_ir_init(struct em28xx *dev)
323{
324 struct em28xx_IR *ir;
325 struct input_dev *input_dev;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300326 u8 ir_config;
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300327 int err = -ENOMEM;
328
Mauro Carvalho Chehab505b6d02008-11-25 09:39:50 -0300329 if (dev->board.ir_codes == NULL) {
Devin Heitmueller4b922532008-11-13 03:15:55 -0300330 /* No remote control support */
331 return 0;
332 }
333
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300334 ir = kzalloc(sizeof(*ir), GFP_KERNEL);
335 input_dev = input_allocate_device();
336 if (!ir || !input_dev)
337 goto err_out_free;
338
339 ir->input = input_dev;
Mauro Carvalho Chehab1bad4292009-12-05 08:27:49 -0300340 ir_config = EM2874_IR_RC5;
341
342 /* Adjust xclk based o IR table for RC5/NEC tables */
343 if (dev->board.ir_codes->ir_type == IR_TYPE_RC5) {
344 dev->board.xclk |= EM28XX_XCLK_IR_RC5_MODE;
345 ir->full_code = 1;
346 } else if (dev->board.ir_codes->ir_type == IR_TYPE_NEC) {
347 dev->board.xclk &= ~EM28XX_XCLK_IR_RC5_MODE;
348 ir_config = EM2874_IR_NEC;
349 ir->full_code = 1;
350 }
351 em28xx_write_reg_bits(dev, EM28XX_R0F_XCLK, dev->board.xclk,
352 EM28XX_XCLK_IR_RC5_MODE);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300353
Devin Heitmueller4b922532008-11-13 03:15:55 -0300354 /* Setup the proper handler based on the chip */
355 switch (dev->chip_id) {
356 case CHIP_ID_EM2860:
357 case CHIP_ID_EM2883:
358 ir->get_key = default_polling_getkey;
Mauro Carvalho Chehab91812fa2008-11-12 14:05:46 -0300359 break;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300360 case CHIP_ID_EM2874:
361 ir->get_key = em2874_polling_getkey;
Devin Heitmueller4b922532008-11-13 03:15:55 -0300362 em28xx_write_regs(dev, EM2874_R50_IR_CONFIG, &ir_config, 1);
363 break;
364 default:
365 printk("Unrecognized em28xx chip id: IR not supported\n");
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300366 goto err_out_free;
367 }
368
Devin Heitmueller4b922532008-11-13 03:15:55 -0300369 /* This is how often we ask the chip for IR information */
370 ir->polling = 100; /* ms */
371
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300372 /* init input device */
373 snprintf(ir->name, sizeof(ir->name), "em28xx IR (%s)",
374 dev->name);
375
376 usb_make_path(dev->udev, ir->phys, sizeof(ir->phys));
377 strlcat(ir->phys, "/input0", sizeof(ir->phys));
378
Mauro Carvalho Chehab055cd552009-11-29 08:19:59 -0300379 err = ir_input_init(input_dev, &ir->ir, IR_TYPE_OTHER,
380 dev->board.ir_codes);
381 if (err < 0)
382 goto err_out_free;
383
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300384 input_dev->name = ir->name;
385 input_dev->phys = ir->phys;
386 input_dev->id.bustype = BUS_USB;
387 input_dev->id.version = 1;
388 input_dev->id.vendor = le16_to_cpu(dev->udev->descriptor.idVendor);
389 input_dev->id.product = le16_to_cpu(dev->udev->descriptor.idProduct);
390
391 input_dev->dev.parent = &dev->udev->dev;
392 /* record handles to ourself */
393 ir->dev = dev;
394 dev->ir = ir;
395
396 em28xx_ir_start(ir);
397
398 /* all done */
399 err = input_register_device(ir->input);
400 if (err)
401 goto err_out_stop;
402
403 return 0;
404 err_out_stop:
405 em28xx_ir_stop(ir);
406 dev->ir = NULL;
407 err_out_free:
Mauro Carvalho Chehab055cd552009-11-29 08:19:59 -0300408 ir_input_free(input_dev);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300409 input_free_device(input_dev);
410 kfree(ir);
411 return err;
412}
413
414int em28xx_ir_fini(struct em28xx *dev)
415{
416 struct em28xx_IR *ir = dev->ir;
417
418 /* skip detach on non attached boards */
419 if (!ir)
420 return 0;
421
422 em28xx_ir_stop(ir);
Mauro Carvalho Chehab055cd552009-11-29 08:19:59 -0300423 ir_input_free(ir->input);
Mauro Carvalho Chehaba924a492008-11-12 08:41:29 -0300424 input_unregister_device(ir->input);
425 kfree(ir);
426
427 /* done */
428 dev->ir = NULL;
429 return 0;
430}
431
432/**********************************************************
433 Handle Webcam snapshot button
434 **********************************************************/
435
Devin Heitmuellera9fc52b2008-06-28 08:57:06 -0300436static void em28xx_query_sbutton(struct work_struct *work)
437{
438 /* Poll the register and see if the button is depressed */
439 struct em28xx *dev =
440 container_of(work, struct em28xx, sbutton_query_work.work);
441 int ret;
442
443 ret = em28xx_read_reg(dev, EM28XX_R0C_USBSUSP);
444
445 if (ret & EM28XX_R0C_USBSUSP_SNAPSHOT) {
446 u8 cleared;
447 /* Button is depressed, clear the register */
448 cleared = ((u8) ret) & ~EM28XX_R0C_USBSUSP_SNAPSHOT;
449 em28xx_write_regs(dev, EM28XX_R0C_USBSUSP, &cleared, 1);
450
451 /* Not emulate the keypress */
452 input_report_key(dev->sbutton_input_dev, EM28XX_SNAPSHOT_KEY,
453 1);
454 /* Now unpress the key */
455 input_report_key(dev->sbutton_input_dev, EM28XX_SNAPSHOT_KEY,
456 0);
457 }
458
459 /* Schedule next poll */
460 schedule_delayed_work(&dev->sbutton_query_work,
461 msecs_to_jiffies(EM28XX_SBUTTON_QUERY_INTERVAL));
462}
463
464void em28xx_register_snapshot_button(struct em28xx *dev)
465{
466 struct input_dev *input_dev;
467 int err;
468
469 em28xx_info("Registering snapshot button...\n");
470 input_dev = input_allocate_device();
471 if (!input_dev) {
472 em28xx_errdev("input_allocate_device failed\n");
473 return;
474 }
475
476 usb_make_path(dev->udev, dev->snapshot_button_path,
477 sizeof(dev->snapshot_button_path));
478 strlcat(dev->snapshot_button_path, "/sbutton",
479 sizeof(dev->snapshot_button_path));
480 INIT_DELAYED_WORK(&dev->sbutton_query_work, em28xx_query_sbutton);
481
482 input_dev->name = "em28xx snapshot button";
483 input_dev->phys = dev->snapshot_button_path;
484 input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
485 set_bit(EM28XX_SNAPSHOT_KEY, input_dev->keybit);
486 input_dev->keycodesize = 0;
487 input_dev->keycodemax = 0;
488 input_dev->id.bustype = BUS_USB;
489 input_dev->id.vendor = le16_to_cpu(dev->udev->descriptor.idVendor);
490 input_dev->id.product = le16_to_cpu(dev->udev->descriptor.idProduct);
491 input_dev->id.version = 1;
492 input_dev->dev.parent = &dev->udev->dev;
493
494 err = input_register_device(input_dev);
495 if (err) {
496 em28xx_errdev("input_register_device failed\n");
497 input_free_device(input_dev);
498 return;
499 }
500
501 dev->sbutton_input_dev = input_dev;
502 schedule_delayed_work(&dev->sbutton_query_work,
503 msecs_to_jiffies(EM28XX_SBUTTON_QUERY_INTERVAL));
504 return;
505
506}
507
508void em28xx_deregister_snapshot_button(struct em28xx *dev)
509{
510 if (dev->sbutton_input_dev != NULL) {
511 em28xx_info("Deregistering snapshot button\n");
512 cancel_rearming_delayed_work(&dev->sbutton_query_work);
513 input_unregister_device(dev->sbutton_input_dev);
514 dev->sbutton_input_dev = NULL;
515 }
516 return;
517}