123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242 |
- #include <sys/param.h>
- #include <sys/systm.h>
- #include <sys/conf.h>
- #include <sys/device.h>
- #include <sys/ioctl.h>
- #include <sys/kernel.h>
- #include <sys/proc.h>
- #include <sys/time.h>
- #include <sys/timeout.h>
- #include <dev/wscons/wsconsio.h>
- #include <dev/wscons/wsmousevar.h>
- #include <dev/sun/sunmsvar.h>
- void
- sunms_attach(struct sunms_softc *sc, const struct wsmouse_accessops *ao)
- {
- struct wsmousedev_attach_args a;
- printf("\n");
-
- sc->sc_state = STATE_PROBING;
- sc->sc_bps = INIT_SPEED;
- timeout_set(&sc->sc_abort_tmo, sunms_abort_input, sc);
-
- getmicrotime(&sc->sc_lastbpschange);
- a.accessops = ao;
- a.accesscookie = sc;
- sc->sc_wsmousedev = config_found(&sc->sc_dev, &a, wsmousedevprint);
- }
- int
- sunms_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
- {
- #if 0
- struct sunms_softc *sc = v;
- #endif
- switch (cmd) {
- case WSMOUSEIO_GTYPE:
- *(u_int *)data = WSMOUSE_TYPE_SUN;
- break;
- default:
- return -1;
- }
- return 0;
- }
- void
- sunms_speed_change(struct sunms_softc *sc)
- {
- uint bps;
- switch (sc->sc_bps) {
- default:
- case 9600:
- bps = 4800;
- break;
- case 4800:
- bps = 1200;
- break;
- case 1200:
- bps = 9600;
- break;
- }
- #ifdef DEBUG
- printf("%s: %d bps\n", sc->sc_dev.dv_xname, bps);
- #endif
- microtime(&sc->sc_lastbpschange);
- (*sc->sc_speed_change)(sc, bps);
- sc->sc_state = STATE_PROBING;
- sc->sc_bps = bps;
- sc->sc_brk = 0;
- timeout_del(&sc->sc_abort_tmo);
- }
- void
- sunms_input(struct sunms_softc *sc, int c)
- {
- struct timeval curtime;
- if (sc->sc_wsmousedev == NULL)
- return;
- if (sc->sc_state == STATE_RATE_CHANGE)
- return;
-
- if (sc->sc_state == STATE_PROBING) {
- microtime(&curtime);
- timersub(&curtime, &sc->sc_lastbpschange, &curtime);
- if (curtime.tv_sec != 0 ||
- curtime.tv_usec >= 200 * 1000) {
- sc->sc_state = STATE_DECODING;
- sc->sc_byteno = -1;
- } else
- return;
- }
-
- if (sc->sc_byteno < 0) {
- if (ISSET(c, 0x80) && !ISSET(c, 0x30))
- sc->sc_byteno = 0;
- else
- return;
- }
- switch (sc->sc_byteno) {
- case 0:
-
- sc->sc_pktlen = ISSET(c, 0x08) ? 3 : 5;
- sc->sc_mb = 0;
- if (!ISSET(c, 1 << 2))
- sc->sc_mb |= 1 << 0;
- if (!ISSET(c, 1 << 1))
- sc->sc_mb |= 1 << 1;
- if (!ISSET(c, 1 << 0))
- sc->sc_mb |= 1 << 2;
- sc->sc_byteno++;
-
- timeout_add_msec(&sc->sc_abort_tmo, 100);
- break;
- case 1:
- case 3:
-
- sc->sc_dx += (int8_t)c;
- sc->sc_byteno++;
- break;
- case 2:
- case 4:
- sc->sc_dy += (int8_t)c;
- sc->sc_byteno++;
- break;
- }
- if (sc->sc_byteno == sc->sc_pktlen) {
- timeout_del(&sc->sc_abort_tmo);
- sc->sc_byteno = -1;
- wsmouse_input(sc->sc_wsmousedev, sc->sc_mb,
- sc->sc_dx, sc->sc_dy, 0, 0, WSMOUSE_INPUT_DELTA);
- sc->sc_dx = sc->sc_dy = 0;
- }
- }
- void
- sunms_abort_input(void *v)
- {
- struct sunms_softc *sc = v;
- int s;
- #ifdef DEBUG
- printf("aborting incomplete packet\n");
- #endif
- s = spltty();
- sc->sc_byteno = -1;
- splx(s);
- }
|