Commit | Line | Data |
---|---|---|
422b552d JH |
1 | /* |
2 | * OpenCores Keyboard Controller Driver | |
3 | * http://www.opencores.org/project,keyboardcontroller | |
4 | * | |
5 | * Copyright 2007-2009 HV Sistemas S.L. | |
6 | * | |
7 | * Licensed under the GPL-2 or later. | |
8 | */ | |
9 | ||
10 | #include <linux/input.h> | |
11 | #include <linux/interrupt.h> | |
12 | #include <linux/io.h> | |
13 | #include <linux/ioport.h> | |
14 | #include <linux/kernel.h> | |
15 | #include <linux/module.h> | |
16 | #include <linux/platform_device.h> | |
5a0e3ad6 | 17 | #include <linux/slab.h> |
422b552d JH |
18 | |
19 | struct opencores_kbd { | |
20 | struct input_dev *input; | |
422b552d JH |
21 | void __iomem *addr; |
22 | int irq; | |
23 | unsigned short keycodes[128]; | |
24 | }; | |
25 | ||
26 | static irqreturn_t opencores_kbd_isr(int irq, void *dev_id) | |
27 | { | |
28 | struct opencores_kbd *opencores_kbd = dev_id; | |
29 | struct input_dev *input = opencores_kbd->input; | |
30 | unsigned char c; | |
31 | ||
32 | c = readb(opencores_kbd->addr); | |
33 | input_report_key(input, c & 0x7f, c & 0x80 ? 0 : 1); | |
34 | input_sync(input); | |
35 | ||
36 | return IRQ_HANDLED; | |
37 | } | |
38 | ||
5298cc4c | 39 | static int opencores_kbd_probe(struct platform_device *pdev) |
422b552d JH |
40 | { |
41 | struct input_dev *input; | |
42 | struct opencores_kbd *opencores_kbd; | |
43 | struct resource *res; | |
44 | int irq, i, error; | |
45 | ||
46 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
47 | if (!res) { | |
48 | dev_err(&pdev->dev, "missing board memory resource\n"); | |
49 | return -EINVAL; | |
50 | } | |
51 | ||
52 | irq = platform_get_irq(pdev, 0); | |
53 | if (irq < 0) { | |
54 | dev_err(&pdev->dev, "missing board IRQ resource\n"); | |
55 | return -EINVAL; | |
56 | } | |
57 | ||
848d4793 PG |
58 | opencores_kbd = devm_kzalloc(&pdev->dev, sizeof(*opencores_kbd), |
59 | GFP_KERNEL); | |
60 | if (!opencores_kbd) | |
61 | return -ENOMEM; | |
422b552d | 62 | |
848d4793 PG |
63 | input = devm_input_allocate_device(&pdev->dev); |
64 | if (!input) { | |
65 | dev_err(&pdev->dev, "failed to allocate input device\n"); | |
66 | return -ENOMEM; | |
422b552d JH |
67 | } |
68 | ||
69 | opencores_kbd->input = input; | |
848d4793 PG |
70 | |
71 | opencores_kbd->addr = devm_ioremap_resource(&pdev->dev, res); | |
72 | if (IS_ERR(opencores_kbd->addr)) | |
42b63e60 | 73 | return PTR_ERR(opencores_kbd->addr); |
422b552d JH |
74 | |
75 | input->name = pdev->name; | |
76 | input->phys = "opencores-kbd/input0"; | |
422b552d JH |
77 | |
78 | input_set_drvdata(input, opencores_kbd); | |
79 | ||
80 | input->id.bustype = BUS_HOST; | |
81 | input->id.vendor = 0x0001; | |
82 | input->id.product = 0x0001; | |
83 | input->id.version = 0x0100; | |
84 | ||
85 | input->keycode = opencores_kbd->keycodes; | |
86 | input->keycodesize = sizeof(opencores_kbd->keycodes[0]); | |
87 | input->keycodemax = ARRAY_SIZE(opencores_kbd->keycodes); | |
88 | ||
89 | __set_bit(EV_KEY, input->evbit); | |
90 | ||
91 | for (i = 0; i < ARRAY_SIZE(opencores_kbd->keycodes); i++) { | |
92 | /* | |
93 | * OpenCores controller happens to have scancodes match | |
94 | * our KEY_* definitions. | |
95 | */ | |
96 | opencores_kbd->keycodes[i] = i; | |
97 | __set_bit(opencores_kbd->keycodes[i], input->keybit); | |
98 | } | |
99 | __clear_bit(KEY_RESERVED, input->keybit); | |
100 | ||
848d4793 PG |
101 | error = devm_request_irq(&pdev->dev, irq, &opencores_kbd_isr, |
102 | IRQF_TRIGGER_RISING, | |
103 | pdev->name, opencores_kbd); | |
422b552d JH |
104 | if (error) { |
105 | dev_err(&pdev->dev, "unable to claim irq %d\n", irq); | |
848d4793 | 106 | return error; |
422b552d JH |
107 | } |
108 | ||
109 | error = input_register_device(input); | |
110 | if (error) { | |
111 | dev_err(&pdev->dev, "unable to register input device\n"); | |
848d4793 | 112 | return error; |
422b552d JH |
113 | } |
114 | ||
115 | platform_set_drvdata(pdev, opencores_kbd); | |
116 | ||
422b552d JH |
117 | return 0; |
118 | } | |
119 | ||
120 | static struct platform_driver opencores_kbd_device_driver = { | |
121 | .probe = opencores_kbd_probe, | |
422b552d JH |
122 | .driver = { |
123 | .name = "opencores-kbd", | |
124 | }, | |
125 | }; | |
5146c84f | 126 | module_platform_driver(opencores_kbd_device_driver); |
422b552d JH |
127 | |
128 | MODULE_LICENSE("GPL"); | |
129 | MODULE_AUTHOR("Javier Herrero <jherrero@hvsistemas.es>"); | |
130 | MODULE_DESCRIPTION("Keyboard driver for OpenCores Keyboard Controller"); |