diff options
author | Mauro Carvalho Chehab <mchehab@redhat.com> | 2012-08-14 10:49:09 -0400 |
---|---|---|
committer | Mauro Carvalho Chehab <mchehab@redhat.com> | 2012-08-15 15:35:54 -0400 |
commit | 68de959f773a1d49096835c411390bceff5d1549 (patch) | |
tree | 99f48fd448c97981b1793f426e28df0d54d880bf /drivers/media/pci/bt8xx/bttv-input.c | |
parent | 0aa77f6c2954896b132f8b6f2e9f063c52800913 (diff) |
[media] bt8xx: move analog TV part to be together with DTV one
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Diffstat (limited to 'drivers/media/pci/bt8xx/bttv-input.c')
-rw-r--r-- | drivers/media/pci/bt8xx/bttv-input.c | 589 |
1 files changed, 589 insertions, 0 deletions
diff --git a/drivers/media/pci/bt8xx/bttv-input.c b/drivers/media/pci/bt8xx/bttv-input.c new file mode 100644 index 000000000000..ef4c7cd41982 --- /dev/null +++ b/drivers/media/pci/bt8xx/bttv-input.c | |||
@@ -0,0 +1,589 @@ | |||
1 | /* | ||
2 | * | ||
3 | * Copyright (c) 2003 Gerd Knorr | ||
4 | * Copyright (c) 2003 Pavel Machek | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or modify | ||
7 | * it under the terms of the GNU General Public License as published by | ||
8 | * the Free Software Foundation; either version 2 of the License, or | ||
9 | * (at your option) any later version. | ||
10 | * | ||
11 | * This program is distributed in the hope that it will be useful, | ||
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | * GNU General Public License for more details. | ||
15 | * | ||
16 | * You should have received a copy of the GNU General Public License | ||
17 | * along with this program; if not, write to the Free Software | ||
18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
19 | */ | ||
20 | |||
21 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
22 | |||
23 | #include <linux/module.h> | ||
24 | #include <linux/init.h> | ||
25 | #include <linux/delay.h> | ||
26 | #include <linux/interrupt.h> | ||
27 | #include <linux/input.h> | ||
28 | #include <linux/slab.h> | ||
29 | |||
30 | #include "bttv.h" | ||
31 | #include "bttvp.h" | ||
32 | |||
33 | |||
34 | static int ir_debug; | ||
35 | module_param(ir_debug, int, 0644); | ||
36 | |||
37 | static int ir_rc5_remote_gap = 885; | ||
38 | module_param(ir_rc5_remote_gap, int, 0644); | ||
39 | |||
40 | #undef dprintk | ||
41 | #define dprintk(fmt, ...) \ | ||
42 | do { \ | ||
43 | if (ir_debug >= 1) \ | ||
44 | pr_info(fmt, ##__VA_ARGS__); \ | ||
45 | } while (0) | ||
46 | |||
47 | #define DEVNAME "bttv-input" | ||
48 | |||
49 | #define MODULE_NAME "bttv" | ||
50 | |||
51 | /* ---------------------------------------------------------------------- */ | ||
52 | |||
53 | static void ir_handle_key(struct bttv *btv) | ||
54 | { | ||
55 | struct bttv_ir *ir = btv->remote; | ||
56 | u32 gpio,data; | ||
57 | |||
58 | /* read gpio value */ | ||
59 | gpio = bttv_gpio_read(&btv->c); | ||
60 | if (ir->polling) { | ||
61 | if (ir->last_gpio == gpio) | ||
62 | return; | ||
63 | ir->last_gpio = gpio; | ||
64 | } | ||
65 | |||
66 | /* extract data */ | ||
67 | data = ir_extract_bits(gpio, ir->mask_keycode); | ||
68 | dprintk("irq gpio=0x%x code=%d | %s%s%s\n", | ||
69 | gpio, data, | ||
70 | ir->polling ? "poll" : "irq", | ||
71 | (gpio & ir->mask_keydown) ? " down" : "", | ||
72 | (gpio & ir->mask_keyup) ? " up" : ""); | ||
73 | |||
74 | if ((ir->mask_keydown && (gpio & ir->mask_keydown)) || | ||
75 | (ir->mask_keyup && !(gpio & ir->mask_keyup))) { | ||
76 | rc_keydown_notimeout(ir->dev, data, 0); | ||
77 | } else { | ||
78 | /* HACK: Probably, ir->mask_keydown is missing | ||
79 | for this board */ | ||
80 | if (btv->c.type == BTTV_BOARD_WINFAST2000) | ||
81 | rc_keydown_notimeout(ir->dev, data, 0); | ||
82 | |||
83 | rc_keyup(ir->dev); | ||
84 | } | ||
85 | } | ||
86 | |||
87 | static void ir_enltv_handle_key(struct bttv *btv) | ||
88 | { | ||
89 | struct bttv_ir *ir = btv->remote; | ||
90 | u32 gpio, data, keyup; | ||
91 | |||
92 | /* read gpio value */ | ||
93 | gpio = bttv_gpio_read(&btv->c); | ||
94 | |||
95 | /* extract data */ | ||
96 | data = ir_extract_bits(gpio, ir->mask_keycode); | ||
97 | |||
98 | /* Check if it is keyup */ | ||
99 | keyup = (gpio & ir->mask_keyup) ? 1 << 31 : 0; | ||
100 | |||
101 | if ((ir->last_gpio & 0x7f) != data) { | ||
102 | dprintk("gpio=0x%x code=%d | %s\n", | ||
103 | gpio, data, | ||
104 | (gpio & ir->mask_keyup) ? " up" : "up/down"); | ||
105 | |||
106 | rc_keydown_notimeout(ir->dev, data, 0); | ||
107 | if (keyup) | ||
108 | rc_keyup(ir->dev); | ||
109 | } else { | ||
110 | if ((ir->last_gpio & 1 << 31) == keyup) | ||
111 | return; | ||
112 | |||
113 | dprintk("(cnt) gpio=0x%x code=%d | %s\n", | ||
114 | gpio, data, | ||
115 | (gpio & ir->mask_keyup) ? " up" : "down"); | ||
116 | |||
117 | if (keyup) | ||
118 | rc_keyup(ir->dev); | ||
119 | else | ||
120 | rc_keydown_notimeout(ir->dev, data, 0); | ||
121 | } | ||
122 | |||
123 | ir->last_gpio = data | keyup; | ||
124 | } | ||
125 | |||
126 | static int bttv_rc5_irq(struct bttv *btv); | ||
127 | |||
128 | void bttv_input_irq(struct bttv *btv) | ||
129 | { | ||
130 | struct bttv_ir *ir = btv->remote; | ||
131 | |||
132 | if (ir->rc5_gpio) | ||
133 | bttv_rc5_irq(btv); | ||
134 | else if (!ir->polling) | ||
135 | ir_handle_key(btv); | ||
136 | } | ||
137 | |||
138 | static void bttv_input_timer(unsigned long data) | ||
139 | { | ||
140 | struct bttv *btv = (struct bttv*)data; | ||
141 | struct bttv_ir *ir = btv->remote; | ||
142 | |||
143 | if (btv->c.type == BTTV_BOARD_ENLTV_FM_2) | ||
144 | ir_enltv_handle_key(btv); | ||
145 | else | ||
146 | ir_handle_key(btv); | ||
147 | mod_timer(&ir->timer, jiffies + msecs_to_jiffies(ir->polling)); | ||
148 | } | ||
149 | |||
150 | /* | ||
151 | * FIXME: Nebula digi uses the legacy way to decode RC5, instead of relying | ||
152 | * on the rc-core way. As we need to be sure that both IRQ transitions are | ||
153 | * properly triggered, Better to touch it only with this hardware for | ||
154 | * testing. | ||
155 | */ | ||
156 | |||
157 | #define RC5_START(x) (((x) >> 12) & 3) | ||
158 | #define RC5_TOGGLE(x) (((x) >> 11) & 1) | ||
159 | #define RC5_ADDR(x) (((x) >> 6) & 31) | ||
160 | #define RC5_INSTR(x) ((x) & 63) | ||
161 | |||
162 | /* decode raw bit pattern to RC5 code */ | ||
163 | static u32 bttv_rc5_decode(unsigned int code) | ||
164 | { | ||
165 | unsigned int org_code = code; | ||
166 | unsigned int pair; | ||
167 | unsigned int rc5 = 0; | ||
168 | int i; | ||
169 | |||
170 | for (i = 0; i < 14; ++i) { | ||
171 | pair = code & 0x3; | ||
172 | code >>= 2; | ||
173 | |||
174 | rc5 <<= 1; | ||
175 | switch (pair) { | ||
176 | case 0: | ||
177 | case 2: | ||
178 | break; | ||
179 | case 1: | ||
180 | rc5 |= 1; | ||
181 | break; | ||
182 | case 3: | ||
183 | dprintk("rc5_decode(%x) bad code\n", | ||
184 | org_code); | ||
185 | return 0; | ||
186 | } | ||
187 | } | ||
188 | dprintk("code=%x, rc5=%x, start=%x, toggle=%x, address=%x, " | ||
189 | "instr=%x\n", rc5, org_code, RC5_START(rc5), | ||
190 | RC5_TOGGLE(rc5), RC5_ADDR(rc5), RC5_INSTR(rc5)); | ||
191 | return rc5; | ||
192 | } | ||
193 | |||
194 | static void bttv_rc5_timer_end(unsigned long data) | ||
195 | { | ||
196 | struct bttv_ir *ir = (struct bttv_ir *)data; | ||
197 | struct timeval tv; | ||
198 | u32 gap; | ||
199 | u32 rc5 = 0; | ||
200 | |||
201 | /* get time */ | ||
202 | do_gettimeofday(&tv); | ||
203 | |||
204 | /* avoid overflow with gap >1s */ | ||
205 | if (tv.tv_sec - ir->base_time.tv_sec > 1) { | ||
206 | gap = 200000; | ||
207 | } else { | ||
208 | gap = 1000000 * (tv.tv_sec - ir->base_time.tv_sec) + | ||
209 | tv.tv_usec - ir->base_time.tv_usec; | ||
210 | } | ||
211 | |||
212 | /* signal we're ready to start a new code */ | ||
213 | ir->active = false; | ||
214 | |||
215 | /* Allow some timer jitter (RC5 is ~24ms anyway so this is ok) */ | ||
216 | if (gap < 28000) { | ||
217 | dprintk("spurious timer_end\n"); | ||
218 | return; | ||
219 | } | ||
220 | |||
221 | if (ir->last_bit < 20) { | ||
222 | /* ignore spurious codes (caused by light/other remotes) */ | ||
223 | dprintk("short code: %x\n", ir->code); | ||
224 | } else { | ||
225 | ir->code = (ir->code << ir->shift_by) | 1; | ||
226 | rc5 = bttv_rc5_decode(ir->code); | ||
227 | |||
228 | /* two start bits? */ | ||
229 | if (RC5_START(rc5) != ir->start) { | ||
230 | pr_info(DEVNAME ":" | ||
231 | " rc5 start bits invalid: %u\n", RC5_START(rc5)); | ||
232 | |||
233 | /* right address? */ | ||
234 | } else if (RC5_ADDR(rc5) == ir->addr) { | ||
235 | u32 toggle = RC5_TOGGLE(rc5); | ||
236 | u32 instr = RC5_INSTR(rc5); | ||
237 | |||
238 | /* Good code */ | ||
239 | rc_keydown(ir->dev, instr, toggle); | ||
240 | dprintk("instruction %x, toggle %x\n", | ||
241 | instr, toggle); | ||
242 | } | ||
243 | } | ||
244 | } | ||
245 | |||
246 | static int bttv_rc5_irq(struct bttv *btv) | ||
247 | { | ||
248 | struct bttv_ir *ir = btv->remote; | ||
249 | struct timeval tv; | ||
250 | u32 gpio; | ||
251 | u32 gap; | ||
252 | unsigned long current_jiffies; | ||
253 | |||
254 | /* read gpio port */ | ||
255 | gpio = bttv_gpio_read(&btv->c); | ||
256 | |||
257 | /* get time of bit */ | ||
258 | current_jiffies = jiffies; | ||
259 | do_gettimeofday(&tv); | ||
260 | |||
261 | /* avoid overflow with gap >1s */ | ||
262 | if (tv.tv_sec - ir->base_time.tv_sec > 1) { | ||
263 | gap = 200000; | ||
264 | } else { | ||
265 | gap = 1000000 * (tv.tv_sec - ir->base_time.tv_sec) + | ||
266 | tv.tv_usec - ir->base_time.tv_usec; | ||
267 | } | ||
268 | |||
269 | dprintk("RC5 IRQ: gap %d us for %s\n", | ||
270 | gap, (gpio & 0x20) ? "mark" : "space"); | ||
271 | |||
272 | /* remote IRQ? */ | ||
273 | if (!(gpio & 0x20)) | ||
274 | return 0; | ||
275 | |||
276 | /* active code => add bit */ | ||
277 | if (ir->active) { | ||
278 | /* only if in the code (otherwise spurious IRQ or timer | ||
279 | late) */ | ||
280 | if (ir->last_bit < 28) { | ||
281 | ir->last_bit = (gap - ir_rc5_remote_gap / 2) / | ||
282 | ir_rc5_remote_gap; | ||
283 | ir->code |= 1 << ir->last_bit; | ||
284 | } | ||
285 | /* starting new code */ | ||
286 | } else { | ||
287 | ir->active = true; | ||
288 | ir->code = 0; | ||
289 | ir->base_time = tv; | ||
290 | ir->last_bit = 0; | ||
291 | |||
292 | mod_timer(&ir->timer, current_jiffies + msecs_to_jiffies(30)); | ||
293 | } | ||
294 | |||
295 | /* toggle GPIO pin 4 to reset the irq */ | ||
296 | bttv_gpio_write(&btv->c, gpio & ~(1 << 4)); | ||
297 | bttv_gpio_write(&btv->c, gpio | (1 << 4)); | ||
298 | return 1; | ||
299 | } | ||
300 | |||
301 | /* ---------------------------------------------------------------------- */ | ||
302 | |||
303 | static void bttv_ir_start(struct bttv *btv, struct bttv_ir *ir) | ||
304 | { | ||
305 | if (ir->polling) { | ||
306 | setup_timer(&ir->timer, bttv_input_timer, (unsigned long)btv); | ||
307 | ir->timer.expires = jiffies + msecs_to_jiffies(1000); | ||
308 | add_timer(&ir->timer); | ||
309 | } else if (ir->rc5_gpio) { | ||
310 | /* set timer_end for code completion */ | ||
311 | setup_timer(&ir->timer, bttv_rc5_timer_end, (unsigned long)ir); | ||
312 | ir->shift_by = 1; | ||
313 | ir->start = 3; | ||
314 | ir->addr = 0x0; | ||
315 | ir->rc5_remote_gap = ir_rc5_remote_gap; | ||
316 | } | ||
317 | } | ||
318 | |||
319 | static void bttv_ir_stop(struct bttv *btv) | ||
320 | { | ||
321 | if (btv->remote->polling) | ||
322 | del_timer_sync(&btv->remote->timer); | ||
323 | |||
324 | if (btv->remote->rc5_gpio) { | ||
325 | u32 gpio; | ||
326 | |||
327 | del_timer_sync(&btv->remote->timer); | ||
328 | |||
329 | gpio = bttv_gpio_read(&btv->c); | ||
330 | bttv_gpio_write(&btv->c, gpio & ~(1 << 4)); | ||
331 | } | ||
332 | } | ||
333 | |||
334 | /* | ||
335 | * Get_key functions used by I2C remotes | ||
336 | */ | ||
337 | |||
338 | static int get_key_pv951(struct IR_i2c *ir, u32 *ir_key, u32 *ir_raw) | ||
339 | { | ||
340 | unsigned char b; | ||
341 | |||
342 | /* poll IR chip */ | ||
343 | if (1 != i2c_master_recv(ir->c, &b, 1)) { | ||
344 | dprintk("read error\n"); | ||
345 | return -EIO; | ||
346 | } | ||
347 | |||
348 | /* ignore 0xaa */ | ||
349 | if (b==0xaa) | ||
350 | return 0; | ||
351 | dprintk("key %02x\n", b); | ||
352 | |||
353 | /* | ||
354 | * NOTE: | ||
355 | * lirc_i2c maps the pv951 code as: | ||
356 | * addr = 0x61D6 | ||
357 | * cmd = bit_reverse (b) | ||
358 | * So, it seems that this device uses NEC extended | ||
359 | * I decided to not fix the table, due to two reasons: | ||
360 | * 1) Without the actual device, this is only a guess; | ||
361 | * 2) As the addr is not reported via I2C, nor can be changed, | ||
362 | * the device is bound to the vendor-provided RC. | ||
363 | */ | ||
364 | |||
365 | *ir_key = b; | ||
366 | *ir_raw = b; | ||
367 | return 1; | ||
368 | } | ||
369 | |||
370 | /* Instantiate the I2C IR receiver device, if present */ | ||
371 | void __devinit init_bttv_i2c_ir(struct bttv *btv) | ||
372 | { | ||
373 | const unsigned short addr_list[] = { | ||
374 | 0x1a, 0x18, 0x64, 0x30, 0x71, | ||
375 | I2C_CLIENT_END | ||
376 | }; | ||
377 | struct i2c_board_info info; | ||
378 | |||
379 | if (0 != btv->i2c_rc) | ||
380 | return; | ||
381 | |||
382 | memset(&info, 0, sizeof(struct i2c_board_info)); | ||
383 | memset(&btv->init_data, 0, sizeof(btv->init_data)); | ||
384 | strlcpy(info.type, "ir_video", I2C_NAME_SIZE); | ||
385 | |||
386 | switch (btv->c.type) { | ||
387 | case BTTV_BOARD_PV951: | ||
388 | btv->init_data.name = "PV951"; | ||
389 | btv->init_data.get_key = get_key_pv951; | ||
390 | btv->init_data.ir_codes = RC_MAP_PV951; | ||
391 | info.addr = 0x4b; | ||
392 | break; | ||
393 | default: | ||
394 | /* | ||
395 | * The external IR receiver is at i2c address 0x34 (0x35 for | ||
396 | * reads). Future Hauppauge cards will have an internal | ||
397 | * receiver at 0x30 (0x31 for reads). In theory, both can be | ||
398 | * fitted, and Hauppauge suggest an external overrides an | ||
399 | * internal. | ||
400 | * That's why we probe 0x1a (~0x34) first. CB | ||
401 | */ | ||
402 | |||
403 | i2c_new_probed_device(&btv->c.i2c_adap, &info, addr_list, NULL); | ||
404 | return; | ||
405 | } | ||
406 | |||
407 | if (btv->init_data.name) | ||
408 | info.platform_data = &btv->init_data; | ||
409 | i2c_new_device(&btv->c.i2c_adap, &info); | ||
410 | |||
411 | return; | ||
412 | } | ||
413 | |||
414 | int __devexit fini_bttv_i2c(struct bttv *btv) | ||
415 | { | ||
416 | if (0 != btv->i2c_rc) | ||
417 | return 0; | ||
418 | |||
419 | return i2c_del_adapter(&btv->c.i2c_adap); | ||
420 | } | ||
421 | |||
422 | int bttv_input_init(struct bttv *btv) | ||
423 | { | ||
424 | struct bttv_ir *ir; | ||
425 | char *ir_codes = NULL; | ||
426 | struct rc_dev *rc; | ||
427 | int err = -ENOMEM; | ||
428 | |||
429 | if (!btv->has_remote) | ||
430 | return -ENODEV; | ||
431 | |||
432 | ir = kzalloc(sizeof(*ir),GFP_KERNEL); | ||
433 | rc = rc_allocate_device(); | ||
434 | if (!ir || !rc) | ||
435 | goto err_out_free; | ||
436 | |||
437 | /* detect & configure */ | ||
438 | switch (btv->c.type) { | ||
439 | case BTTV_BOARD_AVERMEDIA: | ||
440 | case BTTV_BOARD_AVPHONE98: | ||
441 | case BTTV_BOARD_AVERMEDIA98: | ||
442 | ir_codes = RC_MAP_AVERMEDIA; | ||
443 | ir->mask_keycode = 0xf88000; | ||
444 | ir->mask_keydown = 0x010000; | ||
445 | ir->polling = 50; // ms | ||
446 | break; | ||
447 | |||
448 | case BTTV_BOARD_AVDVBT_761: | ||
449 | case BTTV_BOARD_AVDVBT_771: | ||
450 | ir_codes = RC_MAP_AVERMEDIA_DVBT; | ||
451 | ir->mask_keycode = 0x0f00c0; | ||
452 | ir->mask_keydown = 0x000020; | ||
453 | ir->polling = 50; // ms | ||
454 | break; | ||
455 | |||
456 | case BTTV_BOARD_PXELVWPLTVPAK: | ||
457 | ir_codes = RC_MAP_PIXELVIEW; | ||
458 | ir->mask_keycode = 0x003e00; | ||
459 | ir->mask_keyup = 0x010000; | ||
460 | ir->polling = 50; // ms | ||
461 | break; | ||
462 | case BTTV_BOARD_PV_M4900: | ||
463 | case BTTV_BOARD_PV_BT878P_9B: | ||
464 | case BTTV_BOARD_PV_BT878P_PLUS: | ||
465 | ir_codes = RC_MAP_PIXELVIEW; | ||
466 | ir->mask_keycode = 0x001f00; | ||
467 | ir->mask_keyup = 0x008000; | ||
468 | ir->polling = 50; // ms | ||
469 | break; | ||
470 | |||
471 | case BTTV_BOARD_WINFAST2000: | ||
472 | ir_codes = RC_MAP_WINFAST; | ||
473 | ir->mask_keycode = 0x1f8; | ||
474 | break; | ||
475 | case BTTV_BOARD_MAGICTVIEW061: | ||
476 | case BTTV_BOARD_MAGICTVIEW063: | ||
477 | ir_codes = RC_MAP_WINFAST; | ||
478 | ir->mask_keycode = 0x0008e000; | ||
479 | ir->mask_keydown = 0x00200000; | ||
480 | break; | ||
481 | case BTTV_BOARD_APAC_VIEWCOMP: | ||
482 | ir_codes = RC_MAP_APAC_VIEWCOMP; | ||
483 | ir->mask_keycode = 0x001f00; | ||
484 | ir->mask_keyup = 0x008000; | ||
485 | ir->polling = 50; // ms | ||
486 | break; | ||
487 | case BTTV_BOARD_ASKEY_CPH03X: | ||
488 | case BTTV_BOARD_CONCEPTRONIC_CTVFMI2: | ||
489 | case BTTV_BOARD_CONTVFMI: | ||
490 | ir_codes = RC_MAP_PIXELVIEW; | ||
491 | ir->mask_keycode = 0x001F00; | ||
492 | ir->mask_keyup = 0x006000; | ||
493 | ir->polling = 50; // ms | ||
494 | break; | ||
495 | case BTTV_BOARD_NEBULA_DIGITV: | ||
496 | ir_codes = RC_MAP_NEBULA; | ||
497 | ir->rc5_gpio = true; | ||
498 | break; | ||
499 | case BTTV_BOARD_MACHTV_MAGICTV: | ||
500 | ir_codes = RC_MAP_APAC_VIEWCOMP; | ||
501 | ir->mask_keycode = 0x001F00; | ||
502 | ir->mask_keyup = 0x004000; | ||
503 | ir->polling = 50; /* ms */ | ||
504 | break; | ||
505 | case BTTV_BOARD_KOZUMI_KTV_01C: | ||
506 | ir_codes = RC_MAP_PCTV_SEDNA; | ||
507 | ir->mask_keycode = 0x001f00; | ||
508 | ir->mask_keyup = 0x006000; | ||
509 | ir->polling = 50; /* ms */ | ||
510 | break; | ||
511 | case BTTV_BOARD_ENLTV_FM_2: | ||
512 | ir_codes = RC_MAP_ENCORE_ENLTV2; | ||
513 | ir->mask_keycode = 0x00fd00; | ||
514 | ir->mask_keyup = 0x000080; | ||
515 | ir->polling = 1; /* ms */ | ||
516 | ir->last_gpio = ir_extract_bits(bttv_gpio_read(&btv->c), | ||
517 | ir->mask_keycode); | ||
518 | break; | ||
519 | } | ||
520 | if (NULL == ir_codes) { | ||
521 | dprintk("Ooops: IR config error [card=%d]\n", btv->c.type); | ||
522 | err = -ENODEV; | ||
523 | goto err_out_free; | ||
524 | } | ||
525 | |||
526 | if (ir->rc5_gpio) { | ||
527 | u32 gpio; | ||
528 | /* enable remote irq */ | ||
529 | bttv_gpio_inout(&btv->c, (1 << 4), 1 << 4); | ||
530 | gpio = bttv_gpio_read(&btv->c); | ||
531 | bttv_gpio_write(&btv->c, gpio & ~(1 << 4)); | ||
532 | bttv_gpio_write(&btv->c, gpio | (1 << 4)); | ||
533 | } else { | ||
534 | /* init hardware-specific stuff */ | ||
535 | bttv_gpio_inout(&btv->c, ir->mask_keycode | ir->mask_keydown, 0); | ||
536 | } | ||
537 | |||
538 | /* init input device */ | ||
539 | ir->dev = rc; | ||
540 | |||
541 | snprintf(ir->name, sizeof(ir->name), "bttv IR (card=%d)", | ||
542 | btv->c.type); | ||
543 | snprintf(ir->phys, sizeof(ir->phys), "pci-%s/ir0", | ||
544 | pci_name(btv->c.pci)); | ||
545 | |||
546 | rc->input_name = ir->name; | ||
547 | rc->input_phys = ir->phys; | ||
548 | rc->input_id.bustype = BUS_PCI; | ||
549 | rc->input_id.version = 1; | ||
550 | if (btv->c.pci->subsystem_vendor) { | ||
551 | rc->input_id.vendor = btv->c.pci->subsystem_vendor; | ||
552 | rc->input_id.product = btv->c.pci->subsystem_device; | ||
553 | } else { | ||
554 | rc->input_id.vendor = btv->c.pci->vendor; | ||
555 | rc->input_id.product = btv->c.pci->device; | ||
556 | } | ||
557 | rc->dev.parent = &btv->c.pci->dev; | ||
558 | rc->map_name = ir_codes; | ||
559 | rc->driver_name = MODULE_NAME; | ||
560 | |||
561 | btv->remote = ir; | ||
562 | bttv_ir_start(btv, ir); | ||
563 | |||
564 | /* all done */ | ||
565 | err = rc_register_device(rc); | ||
566 | if (err) | ||
567 | goto err_out_stop; | ||
568 | |||
569 | return 0; | ||
570 | |||
571 | err_out_stop: | ||
572 | bttv_ir_stop(btv); | ||
573 | btv->remote = NULL; | ||
574 | err_out_free: | ||
575 | rc_free_device(rc); | ||
576 | kfree(ir); | ||
577 | return err; | ||
578 | } | ||
579 | |||
580 | void bttv_input_fini(struct bttv *btv) | ||
581 | { | ||
582 | if (btv->remote == NULL) | ||
583 | return; | ||
584 | |||
585 | bttv_ir_stop(btv); | ||
586 | rc_unregister_device(btv->remote->dev); | ||
587 | kfree(btv->remote); | ||
588 | btv->remote = NULL; | ||
589 | } | ||