ms_ap.c revision 1.8 
1/*	$NetBSD: ms_ap.c,v 1.8 2006/11/12 19:00:43 plunky Exp $	*/
2
3/*-
4 * Copyright (c) 2000 Tsubai Masanari.  All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 *    notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 *    notice, this list of conditions and the following disclaimer in the
13 *    documentation and/or other materials provided with the distribution.
14 * 3. The name of the author may not be used to endorse or promote products
15 *    derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29#include <sys/cdefs.h>
30__KERNEL_RCSID(0, "$NetBSD: ms_ap.c,v 1.8 2006/11/12 19:00:43 plunky Exp $");
31
32#include <sys/param.h>
33#include <sys/device.h>
34#include <sys/systm.h>
35
36#include <dev/wscons/wsconsio.h>
37#include <dev/wscons/wsmousevar.h>
38
39#include <machine/adrsmap.h>
40#include <newsmips/apbus/apbusvar.h>
41
42struct msreg {
43	u_int ms_data;
44	u_int ms_stat;
45	u_int ms_intr_en;
46	u_int ms_reset;
47	u_int ms_speed;
48};
49
50struct ms_ap_softc {
51	struct device sc_dev;
52	volatile struct msreg *sc_reg;
53	struct device *sc_wsmousedev;
54	int sc_ndata;
55	u_char sc_buf[3];
56};
57
58int ms_ap_match(struct device *, struct cfdata *, void *);
59void ms_ap_attach(struct device *, struct device *, void *);
60int ms_ap_intr(void *);
61
62int ms_ap_enable(void *);
63int ms_ap_ioctl(void *, u_long, caddr_t, int, struct lwp *);
64void ms_ap_disable(void *);
65
66CFATTACH_DECL(ms_ap, sizeof(struct ms_ap_softc),
67    ms_ap_match, ms_ap_attach, NULL, NULL);
68
69struct wsmouse_accessops ms_ap_accessops = {
70	ms_ap_enable,
71	ms_ap_ioctl,
72	ms_ap_disable
73};
74
75int
76ms_ap_match(struct device *parent, struct cfdata *cf, void *aux)
77{
78	struct apbus_attach_args *apa = aux;
79
80	if (strcmp(apa->apa_name, "ms") == 0)
81		return 1;
82
83	return 0;
84}
85
86void
87ms_ap_attach(struct device *parent, struct device *self, void *aux)
88{
89	struct ms_ap_softc *sc = (void *)self;
90	struct apbus_attach_args *apa = aux;
91	volatile struct msreg *reg = (void *)apa->apa_hwbase;
92	struct wsmousedev_attach_args aa;
93
94	printf(" slot%d addr 0x%lx\n", apa->apa_slotno, apa->apa_hwbase);
95
96	sc->sc_reg = reg;
97
98	reg->ms_reset = 0x03;
99	reg->ms_speed = 0x01;
100	reg->ms_intr_en = 0;
101
102	apbus_intr_establish(1, NEWS5000_INT1_KBD, 0, ms_ap_intr, sc,
103	    "", apa->apa_ctlnum);
104
105	aa.accessops = &ms_ap_accessops;
106	aa.accesscookie = sc;
107	sc->sc_wsmousedev = config_found(self, &aa, wsmousedevprint);
108}
109
110int
111ms_ap_intr(void *v)
112{
113	struct ms_ap_softc *sc = v;
114	volatile struct msreg *reg = sc->sc_reg;
115	int code, index, byte0, byte1, byte2;
116	int button, dx, dy;
117	int rv = 0;
118
119	reg->ms_intr_en = 0;
120
121	while (reg->ms_stat & RX_MSRDY) {
122		rv = 1;
123		code = reg->ms_data;
124		index = sc->sc_ndata;
125
126		if (sc->sc_wsmousedev == NULL)
127			continue;
128
129		if (code & 0x80) {
130			sc->sc_buf[0] = code;
131			sc->sc_ndata = 1;
132			continue;
133		}
134
135		if (index == 1) {
136			sc->sc_buf[1] = code;
137			sc->sc_ndata++;
138			continue;
139		}
140
141		if (index == 2) {
142			sc->sc_buf[2] = code;
143			sc->sc_ndata++;
144
145			byte0 = sc->sc_buf[0];
146			byte1 = sc->sc_buf[1];
147			byte2 = sc->sc_buf[2];
148
149			button = 0;
150			if (byte0 & 0x01)
151				button |= 1;
152			if (byte0 & 0x04)
153				button |= 2;
154			if (byte0 & 0x02)
155				button |= 4;
156
157			if (byte0 & 0x08)
158				dx = byte1 - 0x80;
159			else
160				dx = byte1;
161			if (byte0 & 0x10)
162				dy = byte2 - 0x80;
163			else
164				dy = byte2;
165
166			wsmouse_input(sc->sc_wsmousedev,
167					button,
168					dx, -dy, 0, 0,
169					WSMOUSE_INPUT_DELTA);
170		}
171	}
172
173	reg->ms_intr_en = 1;
174	return rv;
175}
176
177int
178ms_ap_enable(void *v)
179{
180	struct ms_ap_softc *sc = v;
181	volatile struct msreg *reg = sc->sc_reg;
182
183	reg->ms_intr_en = 1;
184	return 0;
185}
186
187void
188ms_ap_disable(void *v)
189{
190	struct ms_ap_softc *sc = v;
191	volatile struct msreg *reg = sc->sc_reg;
192
193	reg->ms_intr_en = 0;
194}
195
196int
197ms_ap_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct lwp *l)
198{
199
200	return EPASSTHROUGH;
201}
202