pfckbd.c revision 1.28 1 1.28 dyoung /* $NetBSD: pfckbd.c,v 1.28 2011/07/19 15:30:51 dyoung Exp $ */
2 1.1 uch
3 1.1 uch /*-
4 1.4 uch * Copyright (c) 2001, 2002 The NetBSD Foundation, Inc.
5 1.1 uch * All rights reserved.
6 1.1 uch *
7 1.1 uch * This code is derived from software contributed to The NetBSD Foundation
8 1.1 uch * by UCHIYAMA Yasushi.
9 1.1 uch *
10 1.1 uch * Redistribution and use in source and binary forms, with or without
11 1.1 uch * modification, are permitted provided that the following conditions
12 1.1 uch * are met:
13 1.1 uch * 1. Redistributions of source code must retain the above copyright
14 1.1 uch * notice, this list of conditions and the following disclaimer.
15 1.1 uch * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 uch * notice, this list of conditions and the following disclaimer in the
17 1.1 uch * documentation and/or other materials provided with the distribution.
18 1.1 uch *
19 1.1 uch * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 uch * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 uch * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 uch * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 uch * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 uch * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 uch * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 uch * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 uch * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 uch * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 uch * POSSIBILITY OF SUCH DAMAGE.
30 1.1 uch */
31 1.11 lukem
32 1.19 uwe /*
33 1.19 uwe * Matrix scan keyboard connected to SH7709, SH7709A PFC module.
34 1.19 uwe * currently, HP Jornada 680/690, HITACHI PERSONA HPW-50PAD only.
35 1.19 uwe */
36 1.11 lukem #include <sys/cdefs.h>
37 1.28 dyoung __KERNEL_RCSID(0, "$NetBSD: pfckbd.c,v 1.28 2011/07/19 15:30:51 dyoung Exp $");
38 1.4 uch
39 1.4 uch #include "debug_hpcsh.h"
40 1.1 uch
41 1.1 uch #include <sys/param.h>
42 1.1 uch #include <sys/systm.h>
43 1.1 uch #include <sys/device.h>
44 1.1 uch #include <sys/callout.h>
45 1.28 dyoung #include <sys/bus.h>
46 1.1 uch
47 1.3 uch #include <machine/platid.h>
48 1.3 uch #include <machine/platid_mask.h>
49 1.3 uch
50 1.1 uch #include <dev/hpc/hpckbdvar.h>
51 1.1 uch
52 1.1 uch #include <sh3/pfcreg.h>
53 1.1 uch
54 1.1 uch #include <hpcsh/dev/pfckbdvar.h>
55 1.1 uch
56 1.4 uch #ifdef PFCKBD_DEBUG
57 1.4 uch #define DPRINTF_ENABLE
58 1.4 uch #define DPRINTF_DEBUG pfckbd_debug
59 1.1 uch #endif
60 1.5 uch #include <machine/debug.h>
61 1.1 uch
62 1.19 uwe static struct pfckbd_core {
63 1.1 uch int pc_attached;
64 1.1 uch int pc_enabled;
65 1.1 uch struct callout pc_soft_ch;
66 1.1 uch struct hpckbd_ic_if pc_if;
67 1.1 uch struct hpckbd_if *pc_hpckbd;
68 1.14 uwe uint16_t pc_column[8];
69 1.3 uch void (*pc_callout)(void *);
70 1.1 uch } pfckbd_core;
71 1.1 uch
72 1.24 uwe static int pfckbd_match(device_t, cfdata_t, void *);
73 1.24 uwe static void pfckbd_attach(device_t, device_t, void *);
74 1.20 uwe
75 1.24 uwe CFATTACH_DECL_NEW(pfckbd, 0,
76 1.20 uwe pfckbd_match, pfckbd_attach, NULL, NULL);
77 1.20 uwe
78 1.20 uwe static void pfckbd_ifsetup(struct pfckbd_core *);
79 1.20 uwe
80 1.20 uwe /* callbacks for hpckbd */
81 1.20 uwe static int pfckbd_input_establish(void *, struct hpckbd_if *);
82 1.20 uwe static int pfckbd_poll(void *);
83 1.20 uwe
84 1.20 uwe static void pfckbd_input(struct pfckbd_core *, int, uint16_t);
85 1.20 uwe
86 1.20 uwe static void (*pfckbd_callout_lookup(void))(void *);
87 1.20 uwe static void pfckbd_callout_unknown(void *);
88 1.20 uwe static void pfckbd_callout_hp(void *);
89 1.20 uwe static void pfckbd_callout_hitachi(void *);
90 1.22 kiyohara void pfckbd_poll_hitachi_power(void);
91 1.22 kiyohara
92 1.20 uwe
93 1.3 uch /* callout function table. this function is platfrom specific. */
94 1.19 uwe static const struct {
95 1.3 uch platid_mask_t *platform;
96 1.3 uch void (*func)(void *);
97 1.3 uch } pfckbd_calloutfunc_table[] = {
98 1.3 uch { &platid_mask_MACH_HP , pfckbd_callout_hp },
99 1.3 uch { &platid_mask_MACH_HITACHI , pfckbd_callout_hitachi }
100 1.1 uch };
101 1.1 uch
102 1.1 uch
103 1.1 uch void
104 1.26 cegger pfckbd_cnattach(void)
105 1.1 uch {
106 1.1 uch struct pfckbd_core *pc = &pfckbd_core;
107 1.20 uwe
108 1.20 uwe if ((cpu_product != CPU_PRODUCT_7709)
109 1.20 uwe && (cpu_product != CPU_PRODUCT_7709A))
110 1.7 uch return;
111 1.7 uch
112 1.1 uch /* initialize interface */
113 1.1 uch pfckbd_ifsetup(pc);
114 1.3 uch
115 1.20 uwe /* attach descendants */
116 1.1 uch hpckbd_cnattach(&pc->pc_if);
117 1.1 uch }
118 1.1 uch
119 1.19 uwe static int
120 1.24 uwe pfckbd_match(device_t parent, cfdata_t cf, void *aux)
121 1.1 uch {
122 1.1 uch
123 1.20 uwe if ((cpu_product != CPU_PRODUCT_7709)
124 1.20 uwe && (cpu_product != CPU_PRODUCT_7709A))
125 1.20 uwe return 0;
126 1.7 uch
127 1.20 uwe return !pfckbd_core.pc_attached; /* attach only once */
128 1.1 uch }
129 1.1 uch
130 1.19 uwe static void
131 1.24 uwe pfckbd_attach(device_t parent, device_t self, void *aux)
132 1.1 uch {
133 1.1 uch struct hpckbd_attach_args haa;
134 1.20 uwe
135 1.24 uwe aprint_naive("\n");
136 1.24 uwe aprint_normal("\n");
137 1.1 uch
138 1.1 uch pfckbd_core.pc_attached = 1;
139 1.20 uwe
140 1.1 uch pfckbd_ifsetup(&pfckbd_core);
141 1.1 uch
142 1.1 uch /* attach hpckbd */
143 1.20 uwe haa.haa_ic = &pfckbd_core.pc_if; /* tell hpckbd our interface */
144 1.1 uch config_found(self, &haa, hpckbd_print);
145 1.1 uch
146 1.1 uch /* install callout handler */
147 1.21 ad callout_init(&pfckbd_core.pc_soft_ch, 0);
148 1.20 uwe callout_reset(&pfckbd_core.pc_soft_ch, 1,
149 1.20 uwe pfckbd_core.pc_callout, &pfckbd_core);
150 1.27 uwe
151 1.27 uwe if (!pmf_device_register(self, NULL, NULL))
152 1.27 uwe aprint_error_dev(self, "unable to establish power handler\n");
153 1.1 uch }
154 1.1 uch
155 1.20 uwe static void
156 1.20 uwe pfckbd_ifsetup(struct pfckbd_core *pc)
157 1.20 uwe {
158 1.20 uwe int i;
159 1.20 uwe
160 1.20 uwe pc->pc_if.hii_ctx = pc;
161 1.20 uwe pc->pc_if.hii_establish = pfckbd_input_establish;
162 1.20 uwe pc->pc_if.hii_poll = pfckbd_poll;
163 1.20 uwe
164 1.20 uwe for (i = 0; i < 8; i++)
165 1.20 uwe pc->pc_column[i] = 0xdfff;
166 1.20 uwe
167 1.20 uwe /* select PFC access method */
168 1.20 uwe pc->pc_callout = pfckbd_callout_lookup();
169 1.20 uwe }
170 1.20 uwe
171 1.20 uwe
172 1.20 uwe /*
173 1.20 uwe * Callback for hpckbd_initif
174 1.20 uwe */
175 1.19 uwe static int
176 1.1 uch pfckbd_input_establish(void *ic, struct hpckbd_if *kbdif)
177 1.1 uch {
178 1.1 uch struct pfckbd_core *pc = ic;
179 1.1 uch
180 1.20 uwe pc->pc_hpckbd = kbdif; /* save hpckbd interface */
181 1.20 uwe pc->pc_enabled = 1; /* ok to talk to hpckbd */
182 1.1 uch
183 1.1 uch return 0;
184 1.1 uch }
185 1.1 uch
186 1.20 uwe /*
187 1.20 uwe * Callback for hpckbd_cngetc
188 1.20 uwe */
189 1.19 uwe static int
190 1.20 uwe pfckbd_poll(void *ic)
191 1.1 uch {
192 1.20 uwe struct pfckbd_core *pc = ic;
193 1.1 uch
194 1.1 uch if (pc->pc_enabled)
195 1.20 uwe (*pc->pc_callout)(pc);
196 1.1 uch
197 1.1 uch return 0;
198 1.1 uch }
199 1.1 uch
200 1.20 uwe /*
201 1.20 uwe * Called by platform specific scan routines to report key events to hpckbd
202 1.20 uwe */
203 1.19 uwe static void
204 1.20 uwe pfckbd_input(struct pfckbd_core *pc, int column, uint16_t data)
205 1.3 uch {
206 1.3 uch int row, type, val;
207 1.18 uwe unsigned int edge, mask;
208 1.3 uch
209 1.20 uwe edge = data ^ pc->pc_column[column];
210 1.20 uwe if (edge == 0)
211 1.20 uwe return; /* no changes in this column */
212 1.20 uwe
213 1.20 uwe pc->pc_column[column] = data;
214 1.20 uwe
215 1.20 uwe for (row = 0, mask = 1; row < 16; ++row, mask <<= 1) {
216 1.20 uwe if (mask & edge) {
217 1.20 uwe type = mask & data ? /* up */ 0 : /* down */ 1;
218 1.20 uwe DPRINTF("(%2d, %2d) %d \n", row, column, type);
219 1.20 uwe
220 1.20 uwe val = row * 8 + column;
221 1.20 uwe hpckbd_input(pc->pc_hpckbd, type, val);
222 1.3 uch }
223 1.3 uch }
224 1.1 uch }
225 1.1 uch
226 1.20 uwe
227 1.3 uch /*
228 1.20 uwe * Platform dependent scan routines.
229 1.3 uch */
230 1.3 uch
231 1.3 uch /* Look up appropriate callback handler */
232 1.19 uwe static void
233 1.19 uwe (*pfckbd_callout_lookup())(void *)
234 1.3 uch {
235 1.20 uwe int i, n;
236 1.20 uwe
237 1.20 uwe n = sizeof(pfckbd_calloutfunc_table)
238 1.20 uwe / sizeof(pfckbd_calloutfunc_table[0]);
239 1.20 uwe
240 1.3 uch for (i = 0; i < n; i++)
241 1.3 uch if (platid_match(&platid,
242 1.20 uwe pfckbd_calloutfunc_table[i].platform))
243 1.20 uwe return pfckbd_calloutfunc_table[i].func;
244 1.3 uch
245 1.20 uwe return pfckbd_callout_unknown;
246 1.3 uch }
247 1.3 uch
248 1.3 uch /* Placeholder for unknown platform */
249 1.19 uwe static void
250 1.3 uch pfckbd_callout_unknown(void *arg)
251 1.3 uch {
252 1.3 uch
253 1.17 uwe printf("%s: unknown keyboard switch\n", __func__);
254 1.3 uch }
255 1.3 uch
256 1.20 uwe /*
257 1.20 uwe * HP Jornada680/690, HP620LX
258 1.20 uwe */
259 1.19 uwe static void
260 1.3 uch pfckbd_callout_hp(void *arg)
261 1.1 uch {
262 1.10 uwe #define PFCKBD_HP_PDCR_MASK 0xcc0c
263 1.10 uwe #define PFCKBD_HP_PECR_MASK 0xf0cf
264 1.10 uwe
265 1.10 uwe /*
266 1.10 uwe * Disable output on all lines but the n'th line in D.
267 1.10 uwe * Pull the n'th scan line in D low.
268 1.10 uwe */
269 1.10 uwe #define PD(n) \
270 1.14 uwe { (uint16_t)(PFCKBD_HP_PDCR_MASK & (~(1 << (2*(n)+1)))), \
271 1.14 uwe (uint16_t)(PFCKBD_HP_PECR_MASK & 0xffff), \
272 1.14 uwe (uint8_t)~(1 << (n)), \
273 1.10 uwe 0xff }
274 1.10 uwe
275 1.10 uwe /* Ditto for E */
276 1.10 uwe #define PE(n) \
277 1.14 uwe { (uint16_t)(PFCKBD_HP_PDCR_MASK & 0xffff), \
278 1.14 uwe (uint16_t)(PFCKBD_HP_PECR_MASK & (~(1 << (2*(n)+1)))), \
279 1.10 uwe 0xff, \
280 1.14 uwe (uint8_t)~(1 << (n)) }
281 1.10 uwe
282 1.1 uch static const struct {
283 1.14 uwe uint16_t dc, ec; uint8_t d, e;
284 1.1 uch } scan[] = {
285 1.10 uwe PD(1), PD(5), PE(1), PE(6), PE(7), PE(3), PE(0), PD(7)
286 1.1 uch };
287 1.10 uwe
288 1.10 uwe #undef PD
289 1.10 uwe #undef PE
290 1.10 uwe
291 1.1 uch struct pfckbd_core *pc = arg;
292 1.14 uwe uint16_t dc, ec;
293 1.3 uch int column;
294 1.14 uwe uint16_t data;
295 1.1 uch
296 1.1 uch if (!pc->pc_enabled)
297 1.1 uch goto reinstall;
298 1.1 uch
299 1.10 uwe /* bits in D/E control regs we do not touch (XXX: can they change?) */
300 1.10 uwe dc = _reg_read_2(SH7709_PDCR) & ~PFCKBD_HP_PDCR_MASK;
301 1.10 uwe ec = _reg_read_2(SH7709_PECR) & ~PFCKBD_HP_PECR_MASK;
302 1.10 uwe
303 1.1 uch for (column = 0; column < 8; column++) {
304 1.10 uwe /* disable output to all lines except the one we scan */
305 1.10 uwe _reg_write_2(SH7709_PDCR, dc | scan[column].dc);
306 1.10 uwe _reg_write_2(SH7709_PECR, ec | scan[column].ec);
307 1.10 uwe delay(5);
308 1.10 uwe
309 1.10 uwe /* pull the scan line low */
310 1.7 uch _reg_write_1(SH7709_PDDR, scan[column].d);
311 1.7 uch _reg_write_1(SH7709_PEDR, scan[column].e);
312 1.1 uch delay(50);
313 1.10 uwe
314 1.10 uwe /* read sense */
315 1.20 uwe data = _reg_read_1(SH7709_PFDR)
316 1.20 uwe | (_reg_read_1(SH7709_PCDR) << 8);
317 1.2 uch
318 1.20 uwe pfckbd_input(pc, column, data);
319 1.3 uch }
320 1.3 uch
321 1.10 uwe /* scan no lines */
322 1.7 uch _reg_write_1(SH7709_PDDR, 0xff);
323 1.7 uch _reg_write_1(SH7709_PEDR, 0xff);
324 1.10 uwe
325 1.10 uwe /* enable all scan lines */
326 1.10 uwe _reg_write_2(SH7709_PDCR, dc | (0x5555 & PFCKBD_HP_PDCR_MASK));
327 1.10 uwe _reg_write_2(SH7709_PECR, ec | (0x5555 & PFCKBD_HP_PECR_MASK));
328 1.10 uwe
329 1.12 uwe #if 0
330 1.10 uwe /* (ignore) extra keys/events (recorder buttons, lid, cable &c) */
331 1.7 uch data = _reg_read_1(SH7709_PGDR) | (_reg_read_1(SH7709_PHDR) << 8);
332 1.12 uwe #endif
333 1.3 uch
334 1.3 uch reinstall:
335 1.12 uwe callout_schedule(&pc->pc_soft_ch, 1);
336 1.3 uch }
337 1.3 uch
338 1.20 uwe /*
339 1.20 uwe * HITACH PERSONA (HPW-50PAD)
340 1.20 uwe */
341 1.19 uwe static void
342 1.3 uch pfckbd_callout_hitachi(void *arg)
343 1.3 uch {
344 1.15 kiyohara #define PFCKBD_HITACHI_PCCR_MASK 0xfff3
345 1.13 uwe #define PFCKBD_HITACHI_PDCR_MASK 0x000c
346 1.13 uwe #define PFCKBD_HITACHI_PECR_MASK 0x30cf
347 1.13 uwe
348 1.15 kiyohara #define PFCKBD_HITACHI_PCDR_SCN_MASK 0xfd
349 1.22 kiyohara #define PFCKBD_HITACHI_PDDR_SCN_MASK 0x02
350 1.22 kiyohara #define PFCKBD_HITACHI_PEDR_SCN_MASK 0x4b
351 1.13 uwe
352 1.13 uwe #define PFCKBD_HITACHI_PCDR_SNS_MASK 0x01
353 1.13 uwe #define PFCKBD_HITACHI_PFDR_SNS_MASK 0xfe
354 1.13 uwe
355 1.13 uwe /*
356 1.13 uwe * Disable output on all lines but the n'th line in C.
357 1.13 uwe * Pull the n'th scan line in C low.
358 1.13 uwe */
359 1.13 uwe #define PC(n) \
360 1.14 uwe { (uint16_t)(PFCKBD_HITACHI_PCCR_MASK & (~(1 << (2*(n)+1)))), \
361 1.14 uwe (uint16_t)(PFCKBD_HITACHI_PDCR_MASK & 0xffff), \
362 1.14 uwe (uint16_t)(PFCKBD_HITACHI_PECR_MASK & 0xffff), \
363 1.14 uwe (uint8_t)(PFCKBD_HITACHI_PCDR_SCN_MASK & ~(1 << (n))), \
364 1.13 uwe PFCKBD_HITACHI_PDDR_SCN_MASK, \
365 1.13 uwe PFCKBD_HITACHI_PEDR_SCN_MASK }
366 1.13 uwe
367 1.13 uwe /* Ditto for D */
368 1.13 uwe #define PD(n) \
369 1.14 uwe { (uint16_t)(PFCKBD_HITACHI_PCCR_MASK & 0xffff), \
370 1.14 uwe (uint16_t)(PFCKBD_HITACHI_PDCR_MASK & (~(1 << (2*(n)+1)))), \
371 1.14 uwe (uint16_t)(PFCKBD_HITACHI_PECR_MASK & 0xffff), \
372 1.13 uwe PFCKBD_HITACHI_PCDR_SCN_MASK, \
373 1.14 uwe (uint8_t)(PFCKBD_HITACHI_PDDR_SCN_MASK & ~(1 << (n))), \
374 1.13 uwe PFCKBD_HITACHI_PEDR_SCN_MASK }
375 1.13 uwe
376 1.13 uwe /* Ditto for E */
377 1.13 uwe #define PE(n) \
378 1.14 uwe { (uint16_t)(PFCKBD_HITACHI_PCCR_MASK & 0xffff), \
379 1.14 uwe (uint16_t)(PFCKBD_HITACHI_PDCR_MASK & 0xffff), \
380 1.14 uwe (uint16_t)(PFCKBD_HITACHI_PECR_MASK & (~(1 << (2*(n)+1)))), \
381 1.13 uwe PFCKBD_HITACHI_PCDR_SCN_MASK, \
382 1.13 uwe PFCKBD_HITACHI_PDDR_SCN_MASK, \
383 1.14 uwe (uint8_t)(PFCKBD_HITACHI_PEDR_SCN_MASK & ~(1 << (n))) }
384 1.13 uwe
385 1.3 uch static const struct {
386 1.14 uwe uint16_t cc, dc, ec; uint8_t c, d, e;
387 1.3 uch } scan[] = {
388 1.13 uwe PE(6), PE(3), PE(1), PE(0), PC(7), PC(6), PC(5), PC(4),
389 1.15 kiyohara PC(3), PC(2), PD(1), PC(0)
390 1.3 uch };
391 1.13 uwe
392 1.3 uch struct pfckbd_core *pc = arg;
393 1.14 uwe uint16_t cc, dc, ec;
394 1.15 kiyohara uint8_t data[2], cd, dd, ed;
395 1.13 uwe int i;
396 1.3 uch
397 1.3 uch if (!pc->pc_enabled)
398 1.3 uch goto reinstall;
399 1.3 uch
400 1.13 uwe /* bits in C/D/E control regs we do not touch (XXX: can they change?) */
401 1.13 uwe cc = _reg_read_2(SH7709_PCCR) & ~PFCKBD_HITACHI_PCCR_MASK;
402 1.13 uwe dc = _reg_read_2(SH7709_PDCR) & ~PFCKBD_HITACHI_PDCR_MASK;
403 1.13 uwe ec = _reg_read_2(SH7709_PECR) & ~PFCKBD_HITACHI_PECR_MASK;
404 1.13 uwe
405 1.13 uwe for (i = 0; i < 12; i++) {
406 1.13 uwe /* disable output to all lines except the one we scan */
407 1.15 kiyohara _reg_write_2(SH7709_PCCR, cc | scan[i].cc);
408 1.13 uwe _reg_write_2(SH7709_PDCR, dc | scan[i].dc);
409 1.13 uwe _reg_write_2(SH7709_PECR, ec | scan[i].ec);
410 1.13 uwe delay(5);
411 1.13 uwe
412 1.22 kiyohara cd = _reg_read_1(SH7709_PCDR) & ~PFCKBD_HITACHI_PCDR_SCN_MASK;
413 1.22 kiyohara dd = _reg_read_1(SH7709_PDDR) & ~PFCKBD_HITACHI_PDDR_SCN_MASK;
414 1.22 kiyohara ed = _reg_read_1(SH7709_PEDR) & ~PFCKBD_HITACHI_PEDR_SCN_MASK;
415 1.22 kiyohara
416 1.13 uwe /* pull the scan line low */
417 1.22 kiyohara _reg_write_1(SH7709_PCDR, cd | scan[i].c);
418 1.22 kiyohara _reg_write_1(SH7709_PDDR, dd | scan[i].d);
419 1.22 kiyohara _reg_write_1(SH7709_PEDR, ed | scan[i].e);
420 1.3 uch delay(50);
421 1.1 uch
422 1.13 uwe /* read sense */
423 1.13 uwe data[i & 0x1] =
424 1.20 uwe (_reg_read_1(SH7709_PCDR) & PFCKBD_HITACHI_PCDR_SNS_MASK)
425 1.20 uwe | (_reg_read_1(SH7709_PFDR) & PFCKBD_HITACHI_PFDR_SNS_MASK);
426 1.13 uwe
427 1.13 uwe if (i & 0x1)
428 1.20 uwe pfckbd_input(pc, (i >> 1), (data[0] | (data[1] << 8)));
429 1.1 uch }
430 1.1 uch
431 1.13 uwe /* enable all scan lines */
432 1.13 uwe _reg_write_2(SH7709_PCCR, cc | (0x5555 & PFCKBD_HITACHI_PCCR_MASK));
433 1.13 uwe _reg_write_2(SH7709_PDCR, dc | (0x5555 & PFCKBD_HITACHI_PDCR_MASK));
434 1.13 uwe _reg_write_2(SH7709_PECR, ec | (0x5555 & PFCKBD_HITACHI_PECR_MASK));
435 1.1 uch
436 1.1 uch reinstall:
437 1.12 uwe callout_schedule(&pc->pc_soft_ch, 1);
438 1.1 uch }
439 1.22 kiyohara
440 1.22 kiyohara void
441 1.26 cegger pfckbd_poll_hitachi_power(void)
442 1.22 kiyohara {
443 1.22 kiyohara static const struct {
444 1.22 kiyohara uint16_t cc, dc, ec; uint8_t c, d, e;
445 1.22 kiyohara } poll = PD(1);
446 1.22 kiyohara
447 1.22 kiyohara #undef PC
448 1.22 kiyohara #undef PD
449 1.22 kiyohara #undef PE
450 1.22 kiyohara
451 1.22 kiyohara uint16_t cc, dc, ec;
452 1.22 kiyohara uint8_t cd, dd, ed;
453 1.22 kiyohara
454 1.22 kiyohara /* bits in C/D/E control regs we do not touch (XXX: can they change?) */
455 1.22 kiyohara cc = _reg_read_2(SH7709_PCCR) & ~PFCKBD_HITACHI_PCCR_MASK;
456 1.22 kiyohara dc = _reg_read_2(SH7709_PDCR) & ~PFCKBD_HITACHI_PDCR_MASK;
457 1.22 kiyohara ec = _reg_read_2(SH7709_PECR) & ~PFCKBD_HITACHI_PECR_MASK;
458 1.22 kiyohara
459 1.22 kiyohara /* disable output to all lines except the one we scan */
460 1.22 kiyohara _reg_write_2(SH7709_PCCR, cc | poll.cc);
461 1.22 kiyohara _reg_write_2(SH7709_PDCR, dc | poll.dc);
462 1.22 kiyohara _reg_write_2(SH7709_PECR, ec | poll.ec);
463 1.22 kiyohara delay(5);
464 1.22 kiyohara
465 1.22 kiyohara cd = _reg_read_1(SH7709_PCDR) & ~PFCKBD_HITACHI_PCDR_SCN_MASK;
466 1.22 kiyohara dd = _reg_read_1(SH7709_PDDR) & ~PFCKBD_HITACHI_PDDR_SCN_MASK;
467 1.22 kiyohara ed = _reg_read_1(SH7709_PEDR) & ~PFCKBD_HITACHI_PEDR_SCN_MASK;
468 1.22 kiyohara
469 1.22 kiyohara /* pull the scan line low */
470 1.22 kiyohara _reg_write_1(SH7709_PCDR, cd | poll.c);
471 1.22 kiyohara _reg_write_1(SH7709_PDDR, dd | poll.d);
472 1.22 kiyohara _reg_write_1(SH7709_PEDR, ed | poll.e);
473 1.22 kiyohara delay(50);
474 1.22 kiyohara
475 1.22 kiyohara /* poll POWER On */
476 1.22 kiyohara while (_reg_read_1(SH7709_PCDR) & PFCKBD_HITACHI_PCDR_SNS_MASK & 0x01);
477 1.22 kiyohara
478 1.22 kiyohara /* enable all scan lines */
479 1.22 kiyohara _reg_write_2(SH7709_PCCR, cc | (0x5555 & PFCKBD_HITACHI_PCCR_MASK));
480 1.22 kiyohara _reg_write_2(SH7709_PDCR, dc | (0x5555 & PFCKBD_HITACHI_PDCR_MASK));
481 1.22 kiyohara _reg_write_2(SH7709_PECR, ec | (0x5555 & PFCKBD_HITACHI_PECR_MASK));
482 1.22 kiyohara }
483