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