Commit | Line | Data |
---|---|---|
fb5bbee0 TC |
1 | /* |
2 | * Altera University Program PS2 controller driver | |
3 | * | |
4 | * Copyright (C) 2008 Thomas Chou <thomas@wytron.com.tw> | |
5 | * | |
6 | * Based on sa1111ps2.c, which is: | |
7 | * Copyright (C) 2002 Russell King | |
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 version 2 as | |
11 | * published by the Free Software Foundation. | |
12 | */ | |
13 | ||
14 | #include <linux/module.h> | |
fb5bbee0 TC |
15 | #include <linux/input.h> |
16 | #include <linux/serio.h> | |
17 | #include <linux/interrupt.h> | |
18 | #include <linux/platform_device.h> | |
19 | #include <linux/io.h> | |
5a0e3ad6 | 20 | #include <linux/slab.h> |
0bfd95a2 | 21 | #include <linux/of.h> |
fb5bbee0 TC |
22 | |
23 | #define DRV_NAME "altera_ps2" | |
24 | ||
25 | struct ps2if { | |
26 | struct serio *io; | |
fb5bbee0 | 27 | void __iomem *base; |
fb5bbee0 TC |
28 | }; |
29 | ||
30 | /* | |
31 | * Read all bytes waiting in the PS2 port. There should be | |
32 | * at the most one, but we loop for safety. | |
33 | */ | |
34 | static irqreturn_t altera_ps2_rxint(int irq, void *dev_id) | |
35 | { | |
36 | struct ps2if *ps2if = dev_id; | |
37 | unsigned int status; | |
5f77fc45 | 38 | irqreturn_t handled = IRQ_NONE; |
fb5bbee0 TC |
39 | |
40 | while ((status = readl(ps2if->base)) & 0xffff0000) { | |
41 | serio_interrupt(ps2if->io, status & 0xff, 0); | |
42 | handled = IRQ_HANDLED; | |
43 | } | |
44 | ||
45 | return handled; | |
46 | } | |
47 | ||
48 | /* | |
49 | * Write a byte to the PS2 port. | |
50 | */ | |
51 | static int altera_ps2_write(struct serio *io, unsigned char val) | |
52 | { | |
53 | struct ps2if *ps2if = io->port_data; | |
54 | ||
55 | writel(val, ps2if->base); | |
56 | return 0; | |
57 | } | |
58 | ||
59 | static int altera_ps2_open(struct serio *io) | |
60 | { | |
61 | struct ps2if *ps2if = io->port_data; | |
62 | ||
63 | /* clear fifo */ | |
64 | while (readl(ps2if->base) & 0xffff0000) | |
65 | /* empty */; | |
66 | ||
67 | writel(1, ps2if->base + 4); /* enable rx irq */ | |
68 | return 0; | |
69 | } | |
70 | ||
71 | static void altera_ps2_close(struct serio *io) | |
72 | { | |
73 | struct ps2if *ps2if = io->port_data; | |
74 | ||
d0269b84 | 75 | writel(0, ps2if->base + 4); /* disable rx irq */ |
fb5bbee0 TC |
76 | } |
77 | ||
78 | /* | |
79 | * Add one device to this driver. | |
80 | */ | |
5298cc4c | 81 | static int altera_ps2_probe(struct platform_device *pdev) |
fb5bbee0 TC |
82 | { |
83 | struct ps2if *ps2if; | |
a823c267 | 84 | struct resource *res; |
fb5bbee0 | 85 | struct serio *serio; |
909275bc | 86 | int error, irq; |
fb5bbee0 | 87 | |
a823c267 TK |
88 | ps2if = devm_kzalloc(&pdev->dev, sizeof(struct ps2if), GFP_KERNEL); |
89 | if (!ps2if) | |
90 | return -ENOMEM; | |
91 | ||
92 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
93 | ps2if->base = devm_ioremap_resource(&pdev->dev, res); | |
94 | if (IS_ERR(ps2if->base)) | |
95 | return PTR_ERR(ps2if->base); | |
96 | ||
97 | irq = platform_get_irq(pdev, 0); | |
98 | if (irq < 0) | |
99 | return -ENXIO; | |
100 | ||
101 | error = devm_request_irq(&pdev->dev, irq, altera_ps2_rxint, 0, | |
102 | pdev->name, ps2if); | |
103 | if (error) { | |
104 | dev_err(&pdev->dev, "could not request IRQ %d\n", irq); | |
105 | return error; | |
fb5bbee0 TC |
106 | } |
107 | ||
a823c267 TK |
108 | serio = kzalloc(sizeof(struct serio), GFP_KERNEL); |
109 | if (!serio) | |
110 | return -ENOMEM; | |
111 | ||
fb5bbee0 TC |
112 | serio->id.type = SERIO_8042; |
113 | serio->write = altera_ps2_write; | |
114 | serio->open = altera_ps2_open; | |
115 | serio->close = altera_ps2_close; | |
116 | strlcpy(serio->name, dev_name(&pdev->dev), sizeof(serio->name)); | |
117 | strlcpy(serio->phys, dev_name(&pdev->dev), sizeof(serio->phys)); | |
118 | serio->port_data = ps2if; | |
119 | serio->dev.parent = &pdev->dev; | |
120 | ps2if->io = serio; | |
121 | ||
a823c267 | 122 | dev_info(&pdev->dev, "base %p, irq %d\n", ps2if->base, irq); |
fb5bbee0 TC |
123 | |
124 | serio_register_port(ps2if->io); | |
125 | platform_set_drvdata(pdev, ps2if); | |
126 | ||
127 | return 0; | |
fb5bbee0 TC |
128 | } |
129 | ||
130 | /* | |
131 | * Remove one device from this driver. | |
132 | */ | |
e2619cf7 | 133 | static int altera_ps2_remove(struct platform_device *pdev) |
fb5bbee0 TC |
134 | { |
135 | struct ps2if *ps2if = platform_get_drvdata(pdev); | |
136 | ||
fb5bbee0 | 137 | serio_unregister_port(ps2if->io); |
fb5bbee0 TC |
138 | |
139 | return 0; | |
140 | } | |
141 | ||
0bfd95a2 WG |
142 | #ifdef CONFIG_OF |
143 | static const struct of_device_id altera_ps2_match[] = { | |
144 | { .compatible = "ALTR,ps2-1.0", }, | |
13960b47 | 145 | { .compatible = "altr,ps2-1.0", }, |
0bfd95a2 WG |
146 | {}, |
147 | }; | |
148 | MODULE_DEVICE_TABLE(of, altera_ps2_match); | |
0bfd95a2 WG |
149 | #endif /* CONFIG_OF */ |
150 | ||
fb5bbee0 TC |
151 | /* |
152 | * Our device driver structure | |
153 | */ | |
154 | static struct platform_driver altera_ps2_driver = { | |
155 | .probe = altera_ps2_probe, | |
1cb0aa88 | 156 | .remove = altera_ps2_remove, |
fb5bbee0 TC |
157 | .driver = { |
158 | .name = DRV_NAME, | |
14b5842e | 159 | .of_match_table = of_match_ptr(altera_ps2_match), |
fb5bbee0 TC |
160 | }, |
161 | }; | |
24d2469a | 162 | module_platform_driver(altera_ps2_driver); |
fb5bbee0 TC |
163 | |
164 | MODULE_DESCRIPTION("Altera University Program PS2 controller driver"); | |
165 | MODULE_AUTHOR("Thomas Chou <thomas@wytron.com.tw>"); | |
166 | MODULE_LICENSE("GPL"); | |
167 | MODULE_ALIAS("platform:" DRV_NAME); |