1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * SGI IOC3 PS/2 controller driver for linux |
4 | * |
5 | * Copyright (C) 2019 Thomas Bogendoerfer <tbogendoerfer@suse.de> |
6 | * |
7 | * Based on code Copyright (C) 2005 Stanislaw Skowronek <skylark@unaligned.org> |
8 | * Copyright (C) 2009 Johannes Dickgreber <tanzy@gmx.de> |
9 | */ |
10 | |
11 | #include <linux/delay.h> |
12 | #include <linux/init.h> |
13 | #include <linux/io.h> |
14 | #include <linux/serio.h> |
15 | #include <linux/module.h> |
16 | #include <linux/platform_device.h> |
17 | |
18 | #include <asm/sn/ioc3.h> |
19 | |
20 | struct ioc3kbd_data { |
21 | struct ioc3_serioregs __iomem *regs; |
22 | struct serio *kbd, *aux; |
23 | bool kbd_exists, aux_exists; |
24 | int irq; |
25 | }; |
26 | |
27 | static int ioc3kbd_wait(struct ioc3_serioregs __iomem *regs, u32 mask) |
28 | { |
29 | unsigned long timeout = 0; |
30 | |
31 | while ((readl(addr: ®s->km_csr) & mask) && (timeout < 250)) { |
32 | udelay(50); |
33 | timeout++; |
34 | } |
35 | return (timeout >= 250) ? -ETIMEDOUT : 0; |
36 | } |
37 | |
38 | static int ioc3kbd_write(struct serio *dev, u8 val) |
39 | { |
40 | struct ioc3kbd_data *d = dev->port_data; |
41 | int ret; |
42 | |
43 | ret = ioc3kbd_wait(regs: d->regs, mask: KM_CSR_K_WRT_PEND); |
44 | if (ret) |
45 | return ret; |
46 | |
47 | writel(val, addr: &d->regs->k_wd); |
48 | |
49 | return 0; |
50 | } |
51 | |
52 | static int ioc3kbd_start(struct serio *dev) |
53 | { |
54 | struct ioc3kbd_data *d = dev->port_data; |
55 | |
56 | d->kbd_exists = true; |
57 | return 0; |
58 | } |
59 | |
60 | static void ioc3kbd_stop(struct serio *dev) |
61 | { |
62 | struct ioc3kbd_data *d = dev->port_data; |
63 | |
64 | d->kbd_exists = false; |
65 | } |
66 | |
67 | static int ioc3aux_write(struct serio *dev, u8 val) |
68 | { |
69 | struct ioc3kbd_data *d = dev->port_data; |
70 | int ret; |
71 | |
72 | ret = ioc3kbd_wait(regs: d->regs, mask: KM_CSR_M_WRT_PEND); |
73 | if (ret) |
74 | return ret; |
75 | |
76 | writel(val, addr: &d->regs->m_wd); |
77 | |
78 | return 0; |
79 | } |
80 | |
81 | static int ioc3aux_start(struct serio *dev) |
82 | { |
83 | struct ioc3kbd_data *d = dev->port_data; |
84 | |
85 | d->aux_exists = true; |
86 | return 0; |
87 | } |
88 | |
89 | static void ioc3aux_stop(struct serio *dev) |
90 | { |
91 | struct ioc3kbd_data *d = dev->port_data; |
92 | |
93 | d->aux_exists = false; |
94 | } |
95 | |
96 | static void ioc3kbd_process_data(struct serio *dev, u32 data) |
97 | { |
98 | if (data & KM_RD_VALID_0) |
99 | serio_interrupt(dev, (data >> KM_RD_DATA_0_SHIFT) & 0xff, 0); |
100 | if (data & KM_RD_VALID_1) |
101 | serio_interrupt(dev, (data >> KM_RD_DATA_1_SHIFT) & 0xff, 0); |
102 | if (data & KM_RD_VALID_2) |
103 | serio_interrupt(dev, (data >> KM_RD_DATA_2_SHIFT) & 0xff, 0); |
104 | } |
105 | |
106 | static irqreturn_t ioc3kbd_intr(int itq, void *dev_id) |
107 | { |
108 | struct ioc3kbd_data *d = dev_id; |
109 | u32 data_k, data_m; |
110 | |
111 | data_k = readl(addr: &d->regs->k_rd); |
112 | if (d->kbd_exists) |
113 | ioc3kbd_process_data(dev: d->kbd, data: data_k); |
114 | |
115 | data_m = readl(addr: &d->regs->m_rd); |
116 | if (d->aux_exists) |
117 | ioc3kbd_process_data(dev: d->aux, data: data_m); |
118 | |
119 | return IRQ_HANDLED; |
120 | } |
121 | |
122 | static int ioc3kbd_probe(struct platform_device *pdev) |
123 | { |
124 | struct ioc3_serioregs __iomem *regs; |
125 | struct device *dev = &pdev->dev; |
126 | struct ioc3kbd_data *d; |
127 | struct serio *sk, *sa; |
128 | int irq, ret; |
129 | |
130 | regs = devm_platform_ioremap_resource(pdev, index: 0); |
131 | if (IS_ERR(ptr: regs)) |
132 | return PTR_ERR(ptr: regs); |
133 | |
134 | irq = platform_get_irq(pdev, 0); |
135 | if (irq < 0) |
136 | return -ENXIO; |
137 | |
138 | d = devm_kzalloc(dev, size: sizeof(*d), GFP_KERNEL); |
139 | if (!d) |
140 | return -ENOMEM; |
141 | |
142 | sk = kzalloc(size: sizeof(*sk), GFP_KERNEL); |
143 | if (!sk) |
144 | return -ENOMEM; |
145 | |
146 | sa = kzalloc(size: sizeof(*sa), GFP_KERNEL); |
147 | if (!sa) { |
148 | kfree(objp: sk); |
149 | return -ENOMEM; |
150 | } |
151 | |
152 | sk->id.type = SERIO_8042; |
153 | sk->write = ioc3kbd_write; |
154 | sk->start = ioc3kbd_start; |
155 | sk->stop = ioc3kbd_stop; |
156 | snprintf(buf: sk->name, size: sizeof(sk->name), fmt: "IOC3 keyboard %d" , pdev->id); |
157 | snprintf(buf: sk->phys, size: sizeof(sk->phys), fmt: "ioc3/serio%dkbd" , pdev->id); |
158 | sk->port_data = d; |
159 | sk->dev.parent = dev; |
160 | |
161 | sa->id.type = SERIO_8042; |
162 | sa->write = ioc3aux_write; |
163 | sa->start = ioc3aux_start; |
164 | sa->stop = ioc3aux_stop; |
165 | snprintf(buf: sa->name, size: sizeof(sa->name), fmt: "IOC3 auxiliary %d" , pdev->id); |
166 | snprintf(buf: sa->phys, size: sizeof(sa->phys), fmt: "ioc3/serio%daux" , pdev->id); |
167 | sa->port_data = d; |
168 | sa->dev.parent = dev; |
169 | |
170 | d->regs = regs; |
171 | d->kbd = sk; |
172 | d->aux = sa; |
173 | d->irq = irq; |
174 | |
175 | platform_set_drvdata(pdev, data: d); |
176 | serio_register_port(d->kbd); |
177 | serio_register_port(d->aux); |
178 | |
179 | ret = request_irq(irq, handler: ioc3kbd_intr, IRQF_SHARED, name: "ioc3-kbd" , dev: d); |
180 | if (ret) { |
181 | dev_err(dev, "could not request IRQ %d\n" , irq); |
182 | serio_unregister_port(serio: d->kbd); |
183 | serio_unregister_port(serio: d->aux); |
184 | return ret; |
185 | } |
186 | |
187 | /* enable ports */ |
188 | writel(val: KM_CSR_K_CLAMP_3 | KM_CSR_M_CLAMP_3, addr: ®s->km_csr); |
189 | |
190 | return 0; |
191 | } |
192 | |
193 | static void ioc3kbd_remove(struct platform_device *pdev) |
194 | { |
195 | struct ioc3kbd_data *d = platform_get_drvdata(pdev); |
196 | |
197 | free_irq(d->irq, d); |
198 | |
199 | serio_unregister_port(serio: d->kbd); |
200 | serio_unregister_port(serio: d->aux); |
201 | } |
202 | |
203 | static struct platform_driver ioc3kbd_driver = { |
204 | .probe = ioc3kbd_probe, |
205 | .remove_new = ioc3kbd_remove, |
206 | .driver = { |
207 | .name = "ioc3-kbd" , |
208 | }, |
209 | }; |
210 | module_platform_driver(ioc3kbd_driver); |
211 | |
212 | MODULE_AUTHOR("Thomas Bogendoerfer <tbogendoerfer@suse.de>" ); |
213 | MODULE_DESCRIPTION("SGI IOC3 serio driver" ); |
214 | MODULE_LICENSE("GPL" ); |
215 | |