]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/media/rc/fintek-cir.c
[media] rc: Postpone ISR registration
[mirror_ubuntu-bionic-kernel.git] / drivers / media / rc / fintek-cir.c
CommitLineData
9bdc79ea
JW
1/*
2 * Driver for Feature Integration Technology Inc. (aka Fintek) LPC CIR
3 *
4 * Copyright (C) 2011 Jarod Wilson <jarod@redhat.com>
5 *
6 * Special thanks to Fintek for providing hardware and spec sheets.
7 * This driver is based upon the nuvoton, ite and ene drivers for
8 * similar hardware.
9 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License as
12 * published by the Free Software Foundation; either version 2 of the
13 * License, or (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful, but
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 * General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
23 * USA
24 */
25
26#include <linux/kernel.h>
27#include <linux/module.h>
28#include <linux/pnp.h>
29#include <linux/io.h>
30#include <linux/interrupt.h>
31#include <linux/sched.h>
32#include <linux/slab.h>
33#include <media/rc-core.h>
34#include <linux/pci_ids.h>
35
36#include "fintek-cir.h"
37
38/* write val to config reg */
39static inline void fintek_cr_write(struct fintek_dev *fintek, u8 val, u8 reg)
40{
41 fit_dbg("%s: reg 0x%02x, val 0x%02x (ip/dp: %02x/%02x)",
42 __func__, reg, val, fintek->cr_ip, fintek->cr_dp);
43 outb(reg, fintek->cr_ip);
44 outb(val, fintek->cr_dp);
45}
46
47/* read val from config reg */
48static inline u8 fintek_cr_read(struct fintek_dev *fintek, u8 reg)
49{
50 u8 val;
51
52 outb(reg, fintek->cr_ip);
53 val = inb(fintek->cr_dp);
54
55 fit_dbg("%s: reg 0x%02x, val 0x%02x (ip/dp: %02x/%02x)",
56 __func__, reg, val, fintek->cr_ip, fintek->cr_dp);
57 return val;
58}
59
60/* update config register bit without changing other bits */
61static inline void fintek_set_reg_bit(struct fintek_dev *fintek, u8 val, u8 reg)
62{
63 u8 tmp = fintek_cr_read(fintek, reg) | val;
64 fintek_cr_write(fintek, tmp, reg);
65}
66
67/* clear config register bit without changing other bits */
68static inline void fintek_clear_reg_bit(struct fintek_dev *fintek, u8 val, u8 reg)
69{
70 u8 tmp = fintek_cr_read(fintek, reg) & ~val;
71 fintek_cr_write(fintek, tmp, reg);
72}
73
74/* enter config mode */
75static inline void fintek_config_mode_enable(struct fintek_dev *fintek)
76{
77 /* Enabling Config Mode explicitly requires writing 2x */
78 outb(CONFIG_REG_ENABLE, fintek->cr_ip);
79 outb(CONFIG_REG_ENABLE, fintek->cr_ip);
80}
81
82/* exit config mode */
83static inline void fintek_config_mode_disable(struct fintek_dev *fintek)
84{
85 outb(CONFIG_REG_DISABLE, fintek->cr_ip);
86}
87
88/*
89 * When you want to address a specific logical device, write its logical
90 * device number to GCR_LOGICAL_DEV_NO
91 */
92static inline void fintek_select_logical_dev(struct fintek_dev *fintek, u8 ldev)
93{
94 fintek_cr_write(fintek, ldev, GCR_LOGICAL_DEV_NO);
95}
96
97/* write val to cir config register */
98static inline void fintek_cir_reg_write(struct fintek_dev *fintek, u8 val, u8 offset)
99{
100 outb(val, fintek->cir_addr + offset);
101}
102
103/* read val from cir config register */
104static u8 fintek_cir_reg_read(struct fintek_dev *fintek, u8 offset)
105{
106 u8 val;
107
108 val = inb(fintek->cir_addr + offset);
109
110 return val;
111}
112
113#define pr_reg(text, ...) \
114 printk(KERN_INFO KBUILD_MODNAME ": " text, ## __VA_ARGS__)
115
116/* dump current cir register contents */
117static void cir_dump_regs(struct fintek_dev *fintek)
118{
119 fintek_config_mode_enable(fintek);
83ec8225 120 fintek_select_logical_dev(fintek, fintek->logical_dev_cir);
9bdc79ea
JW
121
122 pr_reg("%s: Dump CIR logical device registers:\n", FINTEK_DRIVER_NAME);
123 pr_reg(" * CR CIR BASE ADDR: 0x%x\n",
124 (fintek_cr_read(fintek, CIR_CR_BASE_ADDR_HI) << 8) |
125 fintek_cr_read(fintek, CIR_CR_BASE_ADDR_LO));
126 pr_reg(" * CR CIR IRQ NUM: 0x%x\n",
127 fintek_cr_read(fintek, CIR_CR_IRQ_SEL));
128
129 fintek_config_mode_disable(fintek);
130
131 pr_reg("%s: Dump CIR registers:\n", FINTEK_DRIVER_NAME);
132 pr_reg(" * STATUS: 0x%x\n", fintek_cir_reg_read(fintek, CIR_STATUS));
133 pr_reg(" * CONTROL: 0x%x\n", fintek_cir_reg_read(fintek, CIR_CONTROL));
134 pr_reg(" * RX_DATA: 0x%x\n", fintek_cir_reg_read(fintek, CIR_RX_DATA));
135 pr_reg(" * TX_CONTROL: 0x%x\n", fintek_cir_reg_read(fintek, CIR_TX_CONTROL));
136 pr_reg(" * TX_DATA: 0x%x\n", fintek_cir_reg_read(fintek, CIR_TX_DATA));
137}
138
139/* detect hardware features */
140static int fintek_hw_detect(struct fintek_dev *fintek)
141{
142 unsigned long flags;
143 u8 chip_major, chip_minor;
144 u8 vendor_major, vendor_minor;
145 u8 portsel, ir_class;
83ec8225 146 u16 vendor, chip;
9bdc79ea
JW
147 int ret = 0;
148
149 fintek_config_mode_enable(fintek);
150
151 /* Check if we're using config port 0x4e or 0x2e */
152 portsel = fintek_cr_read(fintek, GCR_CONFIG_PORT_SEL);
153 if (portsel == 0xff) {
154 fit_pr(KERN_INFO, "first portsel read was bunk, trying alt");
155 fintek_config_mode_disable(fintek);
156 fintek->cr_ip = CR_INDEX_PORT2;
157 fintek->cr_dp = CR_DATA_PORT2;
158 fintek_config_mode_enable(fintek);
159 portsel = fintek_cr_read(fintek, GCR_CONFIG_PORT_SEL);
160 }
161 fit_dbg("portsel reg: 0x%02x", portsel);
162
163 ir_class = fintek_cir_reg_read(fintek, CIR_CR_CLASS);
164 fit_dbg("ir_class reg: 0x%02x", ir_class);
165
166 switch (ir_class) {
167 case CLASS_RX_2TX:
168 case CLASS_RX_1TX:
169 fintek->hw_tx_capable = true;
170 break;
171 case CLASS_RX_ONLY:
172 default:
173 fintek->hw_tx_capable = false;
174 break;
175 }
176
177 chip_major = fintek_cr_read(fintek, GCR_CHIP_ID_HI);
178 chip_minor = fintek_cr_read(fintek, GCR_CHIP_ID_LO);
83ec8225 179 chip = chip_major << 8 | chip_minor;
9bdc79ea
JW
180
181 vendor_major = fintek_cr_read(fintek, GCR_VENDOR_ID_HI);
182 vendor_minor = fintek_cr_read(fintek, GCR_VENDOR_ID_LO);
183 vendor = vendor_major << 8 | vendor_minor;
184
185 if (vendor != VENDOR_ID_FINTEK)
186 fit_pr(KERN_WARNING, "Unknown vendor ID: 0x%04x", vendor);
187 else
188 fit_dbg("Read Fintek vendor ID from chip");
189
190 fintek_config_mode_disable(fintek);
191
192 spin_lock_irqsave(&fintek->fintek_lock, flags);
193 fintek->chip_major = chip_major;
194 fintek->chip_minor = chip_minor;
195 fintek->chip_vendor = vendor;
83ec8225
MCC
196
197 /*
198 * Newer reviews of this chipset uses port 8 instead of 5
199 */
200 if ((chip != 0x0408) || (chip != 0x0804))
201 fintek->logical_dev_cir = LOGICAL_DEV_CIR_REV2;
202 else
203 fintek->logical_dev_cir = LOGICAL_DEV_CIR_REV1;
204
9bdc79ea
JW
205 spin_unlock_irqrestore(&fintek->fintek_lock, flags);
206
207 return ret;
208}
209
210static void fintek_cir_ldev_init(struct fintek_dev *fintek)
211{
212 /* Select CIR logical device and enable */
83ec8225 213 fintek_select_logical_dev(fintek, fintek->logical_dev_cir);
9bdc79ea
JW
214 fintek_cr_write(fintek, LOGICAL_DEV_ENABLE, CIR_CR_DEV_EN);
215
216 /* Write allocated CIR address and IRQ information to hardware */
217 fintek_cr_write(fintek, fintek->cir_addr >> 8, CIR_CR_BASE_ADDR_HI);
218 fintek_cr_write(fintek, fintek->cir_addr & 0xff, CIR_CR_BASE_ADDR_LO);
219
220 fintek_cr_write(fintek, fintek->cir_irq, CIR_CR_IRQ_SEL);
221
222 fit_dbg("CIR initialized, base io address: 0x%lx, irq: %d (len: %d)",
223 fintek->cir_addr, fintek->cir_irq, fintek->cir_port_len);
224}
225
226/* enable CIR interrupts */
227static void fintek_enable_cir_irq(struct fintek_dev *fintek)
228{
229 fintek_cir_reg_write(fintek, CIR_STATUS_IRQ_EN, CIR_STATUS);
230}
231
232static void fintek_cir_regs_init(struct fintek_dev *fintek)
233{
234 /* clear any and all stray interrupts */
235 fintek_cir_reg_write(fintek, CIR_STATUS_IRQ_MASK, CIR_STATUS);
236
237 /* and finally, enable interrupts */
238 fintek_enable_cir_irq(fintek);
239}
240
241static void fintek_enable_wake(struct fintek_dev *fintek)
242{
243 fintek_config_mode_enable(fintek);
244 fintek_select_logical_dev(fintek, LOGICAL_DEV_ACPI);
245
246 /* Allow CIR PME's to wake system */
247 fintek_set_reg_bit(fintek, ACPI_WAKE_EN_CIR_BIT, LDEV_ACPI_WAKE_EN_REG);
248 /* Enable CIR PME's */
249 fintek_set_reg_bit(fintek, ACPI_PME_CIR_BIT, LDEV_ACPI_PME_EN_REG);
250 /* Clear CIR PME status register */
251 fintek_set_reg_bit(fintek, ACPI_PME_CIR_BIT, LDEV_ACPI_PME_CLR_REG);
252 /* Save state */
253 fintek_set_reg_bit(fintek, ACPI_STATE_CIR_BIT, LDEV_ACPI_STATE_REG);
254
255 fintek_config_mode_disable(fintek);
256}
257
258static int fintek_cmdsize(u8 cmd, u8 subcmd)
259{
260 int datasize = 0;
261
262 switch (cmd) {
263 case BUF_COMMAND_NULL:
264 if (subcmd == BUF_HW_CMD_HEADER)
265 datasize = 1;
266 break;
267 case BUF_HW_CMD_HEADER:
268 if (subcmd == BUF_CMD_G_REVISION)
269 datasize = 2;
270 break;
271 case BUF_COMMAND_HEADER:
272 switch (subcmd) {
273 case BUF_CMD_S_CARRIER:
274 case BUF_CMD_S_TIMEOUT:
275 case BUF_RSP_PULSE_COUNT:
276 datasize = 2;
277 break;
278 case BUF_CMD_SIG_END:
279 case BUF_CMD_S_TXMASK:
280 case BUF_CMD_S_RXSENSOR:
281 datasize = 1;
282 break;
283 }
284 }
285
286 return datasize;
287}
288
289/* process ir data stored in driver buffer */
290static void fintek_process_rx_ir_data(struct fintek_dev *fintek)
291{
292 DEFINE_IR_RAW_EVENT(rawir);
293 u8 sample;
294 int i;
295
296 for (i = 0; i < fintek->pkts; i++) {
297 sample = fintek->buf[i];
298 switch (fintek->parser_state) {
299 case CMD_HEADER:
300 fintek->cmd = sample;
301 if ((fintek->cmd == BUF_COMMAND_HEADER) ||
302 ((fintek->cmd & BUF_COMMAND_MASK) !=
303 BUF_PULSE_BIT)) {
304 fintek->parser_state = SUBCMD;
305 continue;
306 }
307 fintek->rem = (fintek->cmd & BUF_LEN_MASK);
308 fit_dbg("%s: rem: 0x%02x", __func__, fintek->rem);
309 if (fintek->rem)
310 fintek->parser_state = PARSE_IRDATA;
311 else
312 ir_raw_event_reset(fintek->rdev);
313 break;
314 case SUBCMD:
315 fintek->rem = fintek_cmdsize(fintek->cmd, sample);
316 fintek->parser_state = CMD_DATA;
317 break;
318 case CMD_DATA:
319 fintek->rem--;
320 break;
321 case PARSE_IRDATA:
322 fintek->rem--;
323 init_ir_raw_event(&rawir);
324 rawir.pulse = ((sample & BUF_PULSE_BIT) != 0);
325 rawir.duration = US_TO_NS((sample & BUF_SAMPLE_MASK)
326 * CIR_SAMPLE_PERIOD);
327
328 fit_dbg("Storing %s with duration %d",
329 rawir.pulse ? "pulse" : "space",
330 rawir.duration);
331 ir_raw_event_store_with_filter(fintek->rdev, &rawir);
332 break;
333 }
334
335 if ((fintek->parser_state != CMD_HEADER) && !fintek->rem)
336 fintek->parser_state = CMD_HEADER;
337 }
338
339 fintek->pkts = 0;
340
341 fit_dbg("Calling ir_raw_event_handle");
342 ir_raw_event_handle(fintek->rdev);
343}
344
345/* copy data from hardware rx register into driver buffer */
346static void fintek_get_rx_ir_data(struct fintek_dev *fintek, u8 rx_irqs)
347{
348 unsigned long flags;
349 u8 sample, status;
350
351 spin_lock_irqsave(&fintek->fintek_lock, flags);
352
353 /*
354 * We must read data from CIR_RX_DATA until the hardware IR buffer
355 * is empty and clears the RX_TIMEOUT and/or RX_RECEIVE flags in
356 * the CIR_STATUS register
357 */
358 do {
359 sample = fintek_cir_reg_read(fintek, CIR_RX_DATA);
360 fit_dbg("%s: sample: 0x%02x", __func__, sample);
361
362 fintek->buf[fintek->pkts] = sample;
363 fintek->pkts++;
364
365 status = fintek_cir_reg_read(fintek, CIR_STATUS);
366 if (!(status & CIR_STATUS_IRQ_EN))
367 break;
368 } while (status & rx_irqs);
369
370 fintek_process_rx_ir_data(fintek);
371
372 spin_unlock_irqrestore(&fintek->fintek_lock, flags);
373}
374
375static void fintek_cir_log_irqs(u8 status)
376{
377 fit_pr(KERN_INFO, "IRQ 0x%02x:%s%s%s%s%s", status,
378 status & CIR_STATUS_IRQ_EN ? " IRQEN" : "",
379 status & CIR_STATUS_TX_FINISH ? " TXF" : "",
380 status & CIR_STATUS_TX_UNDERRUN ? " TXU" : "",
381 status & CIR_STATUS_RX_TIMEOUT ? " RXTO" : "",
382 status & CIR_STATUS_RX_RECEIVE ? " RXOK" : "");
383}
384
385/* interrupt service routine for incoming and outgoing CIR data */
386static irqreturn_t fintek_cir_isr(int irq, void *data)
387{
388 struct fintek_dev *fintek = data;
389 u8 status, rx_irqs;
390
391 fit_dbg_verbose("%s firing", __func__);
392
393 fintek_config_mode_enable(fintek);
83ec8225 394 fintek_select_logical_dev(fintek, fintek->logical_dev_cir);
9bdc79ea
JW
395 fintek_config_mode_disable(fintek);
396
397 /*
398 * Get IR Status register contents. Write 1 to ack/clear
399 *
400 * bit: reg name - description
401 * 3: TX_FINISH - TX is finished
402 * 2: TX_UNDERRUN - TX underrun
403 * 1: RX_TIMEOUT - RX data timeout
404 * 0: RX_RECEIVE - RX data received
405 */
406 status = fintek_cir_reg_read(fintek, CIR_STATUS);
407 if (!(status & CIR_STATUS_IRQ_MASK) || status == 0xff) {
408 fit_dbg_verbose("%s exiting, IRSTS 0x%02x", __func__, status);
409 fintek_cir_reg_write(fintek, CIR_STATUS_IRQ_MASK, CIR_STATUS);
410 return IRQ_RETVAL(IRQ_NONE);
411 }
412
413 if (debug)
414 fintek_cir_log_irqs(status);
415
416 rx_irqs = status & (CIR_STATUS_RX_RECEIVE | CIR_STATUS_RX_TIMEOUT);
417 if (rx_irqs)
418 fintek_get_rx_ir_data(fintek, rx_irqs);
419
420 /* ack/clear all irq flags we've got */
421 fintek_cir_reg_write(fintek, status, CIR_STATUS);
422
423 fit_dbg_verbose("%s done", __func__);
424 return IRQ_RETVAL(IRQ_HANDLED);
425}
426
427static void fintek_enable_cir(struct fintek_dev *fintek)
428{
429 /* set IRQ enabled */
430 fintek_cir_reg_write(fintek, CIR_STATUS_IRQ_EN, CIR_STATUS);
431
432 fintek_config_mode_enable(fintek);
433
434 /* enable the CIR logical device */
83ec8225 435 fintek_select_logical_dev(fintek, fintek->logical_dev_cir);
9bdc79ea
JW
436 fintek_cr_write(fintek, LOGICAL_DEV_ENABLE, CIR_CR_DEV_EN);
437
438 fintek_config_mode_disable(fintek);
439
440 /* clear all pending interrupts */
441 fintek_cir_reg_write(fintek, CIR_STATUS_IRQ_MASK, CIR_STATUS);
442
443 /* enable interrupts */
444 fintek_enable_cir_irq(fintek);
445}
446
447static void fintek_disable_cir(struct fintek_dev *fintek)
448{
449 fintek_config_mode_enable(fintek);
450
451 /* disable the CIR logical device */
83ec8225 452 fintek_select_logical_dev(fintek, fintek->logical_dev_cir);
9bdc79ea
JW
453 fintek_cr_write(fintek, LOGICAL_DEV_DISABLE, CIR_CR_DEV_EN);
454
455 fintek_config_mode_disable(fintek);
456}
457
458static int fintek_open(struct rc_dev *dev)
459{
460 struct fintek_dev *fintek = dev->priv;
461 unsigned long flags;
462
463 spin_lock_irqsave(&fintek->fintek_lock, flags);
464 fintek_enable_cir(fintek);
465 spin_unlock_irqrestore(&fintek->fintek_lock, flags);
466
467 return 0;
468}
469
470static void fintek_close(struct rc_dev *dev)
471{
472 struct fintek_dev *fintek = dev->priv;
473 unsigned long flags;
474
475 spin_lock_irqsave(&fintek->fintek_lock, flags);
476 fintek_disable_cir(fintek);
477 spin_unlock_irqrestore(&fintek->fintek_lock, flags);
478}
479
480/* Allocate memory, probe hardware, and initialize everything */
481static int fintek_probe(struct pnp_dev *pdev, const struct pnp_device_id *dev_id)
482{
483 struct fintek_dev *fintek;
484 struct rc_dev *rdev;
485 int ret = -ENOMEM;
486
487 fintek = kzalloc(sizeof(struct fintek_dev), GFP_KERNEL);
488 if (!fintek)
489 return ret;
490
491 /* input device for IR remote (and tx) */
492 rdev = rc_allocate_device();
493 if (!rdev)
494 goto failure;
495
496 ret = -ENODEV;
497 /* validate pnp resources */
498 if (!pnp_port_valid(pdev, 0)) {
499 dev_err(&pdev->dev, "IR PNP Port not valid!\n");
500 goto failure;
501 }
502
503 if (!pnp_irq_valid(pdev, 0)) {
504 dev_err(&pdev->dev, "IR PNP IRQ not valid!\n");
505 goto failure;
506 }
507
508 fintek->cir_addr = pnp_port_start(pdev, 0);
509 fintek->cir_irq = pnp_irq(pdev, 0);
510 fintek->cir_port_len = pnp_port_len(pdev, 0);
511
512 fintek->cr_ip = CR_INDEX_PORT;
513 fintek->cr_dp = CR_DATA_PORT;
514
515 spin_lock_init(&fintek->fintek_lock);
516
9bdc79ea
JW
517 pnp_set_drvdata(pdev, fintek);
518 fintek->pdev = pdev;
519
520 ret = fintek_hw_detect(fintek);
521 if (ret)
522 goto failure;
523
524 /* Initialize CIR & CIR Wake Logical Devices */
525 fintek_config_mode_enable(fintek);
526 fintek_cir_ldev_init(fintek);
527 fintek_config_mode_disable(fintek);
528
529 /* Initialize CIR & CIR Wake Config Registers */
530 fintek_cir_regs_init(fintek);
531
532 /* Set up the rc device */
533 rdev->priv = fintek;
534 rdev->driver_type = RC_DRIVER_IR_RAW;
535 rdev->allowed_protos = RC_TYPE_ALL;
536 rdev->open = fintek_open;
537 rdev->close = fintek_close;
538 rdev->input_name = FINTEK_DESCRIPTION;
539 rdev->input_phys = "fintek/cir0";
540 rdev->input_id.bustype = BUS_HOST;
541 rdev->input_id.vendor = VENDOR_ID_FINTEK;
542 rdev->input_id.product = fintek->chip_major;
543 rdev->input_id.version = fintek->chip_minor;
544 rdev->dev.parent = &pdev->dev;
545 rdev->driver_name = FINTEK_DRIVER_NAME;
546 rdev->map_name = RC_MAP_RC6_MCE;
547 rdev->timeout = US_TO_NS(1000);
548 /* rx resolution is hardwired to 50us atm, 1, 25, 100 also possible */
549 rdev->rx_resolution = US_TO_NS(CIR_SAMPLE_PERIOD);
550
9ef449c6
LH
551 ret = -EBUSY;
552 /* now claim resources */
553 if (!request_region(fintek->cir_addr,
554 fintek->cir_port_len, FINTEK_DRIVER_NAME))
555 goto failure;
556
557 if (request_irq(fintek->cir_irq, fintek_cir_isr, IRQF_SHARED,
558 FINTEK_DRIVER_NAME, (void *)fintek))
559 goto failure;
560
9bdc79ea
JW
561 ret = rc_register_device(rdev);
562 if (ret)
563 goto failure;
564
565 device_init_wakeup(&pdev->dev, true);
566 fintek->rdev = rdev;
567 fit_pr(KERN_NOTICE, "driver has been successfully loaded\n");
568 if (debug)
569 cir_dump_regs(fintek);
570
571 return 0;
572
573failure:
574 if (fintek->cir_irq)
575 free_irq(fintek->cir_irq, fintek);
576 if (fintek->cir_addr)
577 release_region(fintek->cir_addr, fintek->cir_port_len);
578
579 rc_free_device(rdev);
580 kfree(fintek);
581
582 return ret;
583}
584
585static void __devexit fintek_remove(struct pnp_dev *pdev)
586{
587 struct fintek_dev *fintek = pnp_get_drvdata(pdev);
588 unsigned long flags;
589
590 spin_lock_irqsave(&fintek->fintek_lock, flags);
591 /* disable CIR */
592 fintek_disable_cir(fintek);
593 fintek_cir_reg_write(fintek, CIR_STATUS_IRQ_MASK, CIR_STATUS);
594 /* enable CIR Wake (for IR power-on) */
595 fintek_enable_wake(fintek);
596 spin_unlock_irqrestore(&fintek->fintek_lock, flags);
597
598 /* free resources */
599 free_irq(fintek->cir_irq, fintek);
600 release_region(fintek->cir_addr, fintek->cir_port_len);
601
602 rc_unregister_device(fintek->rdev);
603
604 kfree(fintek);
605}
606
607static int fintek_suspend(struct pnp_dev *pdev, pm_message_t state)
608{
609 struct fintek_dev *fintek = pnp_get_drvdata(pdev);
0ae90252 610 unsigned long flags;
9bdc79ea
JW
611
612 fit_dbg("%s called", __func__);
613
0ae90252
JW
614 spin_lock_irqsave(&fintek->fintek_lock, flags);
615
9bdc79ea
JW
616 /* disable all CIR interrupts */
617 fintek_cir_reg_write(fintek, CIR_STATUS_IRQ_MASK, CIR_STATUS);
618
0ae90252
JW
619 spin_unlock_irqrestore(&fintek->fintek_lock, flags);
620
9bdc79ea
JW
621 fintek_config_mode_enable(fintek);
622
623 /* disable cir logical dev */
83ec8225 624 fintek_select_logical_dev(fintek, fintek->logical_dev_cir);
9bdc79ea
JW
625 fintek_cr_write(fintek, LOGICAL_DEV_DISABLE, CIR_CR_DEV_EN);
626
627 fintek_config_mode_disable(fintek);
628
629 /* make sure wake is enabled */
630 fintek_enable_wake(fintek);
631
632 return 0;
633}
634
635static int fintek_resume(struct pnp_dev *pdev)
636{
637 int ret = 0;
638 struct fintek_dev *fintek = pnp_get_drvdata(pdev);
639
640 fit_dbg("%s called", __func__);
641
642 /* open interrupt */
643 fintek_enable_cir_irq(fintek);
644
645 /* Enable CIR logical device */
646 fintek_config_mode_enable(fintek);
83ec8225 647 fintek_select_logical_dev(fintek, fintek->logical_dev_cir);
9bdc79ea
JW
648 fintek_cr_write(fintek, LOGICAL_DEV_ENABLE, CIR_CR_DEV_EN);
649
650 fintek_config_mode_disable(fintek);
651
652 fintek_cir_regs_init(fintek);
653
654 return ret;
655}
656
657static void fintek_shutdown(struct pnp_dev *pdev)
658{
659 struct fintek_dev *fintek = pnp_get_drvdata(pdev);
660 fintek_enable_wake(fintek);
661}
662
663static const struct pnp_device_id fintek_ids[] = {
664 { "FIT0002", 0 }, /* CIR */
665 { "", 0 },
666};
667
668static struct pnp_driver fintek_driver = {
669 .name = FINTEK_DRIVER_NAME,
670 .id_table = fintek_ids,
671 .flags = PNP_DRIVER_RES_DO_NOT_CHANGE,
672 .probe = fintek_probe,
673 .remove = __devexit_p(fintek_remove),
674 .suspend = fintek_suspend,
675 .resume = fintek_resume,
676 .shutdown = fintek_shutdown,
677};
678
679int fintek_init(void)
680{
681 return pnp_register_driver(&fintek_driver);
682}
683
684void fintek_exit(void)
685{
686 pnp_unregister_driver(&fintek_driver);
687}
688
689module_param(debug, int, S_IRUGO | S_IWUSR);
690MODULE_PARM_DESC(debug, "Enable debugging output");
691
692MODULE_DEVICE_TABLE(pnp, fintek_ids);
693MODULE_DESCRIPTION(FINTEK_DESCRIPTION " driver");
694
695MODULE_AUTHOR("Jarod Wilson <jarod@redhat.com>");
696MODULE_LICENSE("GPL");
697
698module_init(fintek_init);
699module_exit(fintek_exit);