Home | History | Annotate | Line # | Download | only in vr
vrdsu.c revision 1.6 
      1 /*	$NetBSD: vrdsu.c,v 1.6 2002/10/02 05:26:55 thorpej Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 1999 Shin Takemura All rights reserved.
      5  * Copyright (c) 1999 PocketBSD Project. All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  * SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/param.h>
     30 #include <sys/systm.h>
     31 #include <sys/device.h>
     32 
     33 #include <machine/bus.h>
     34 
     35 #include <hpcmips/vr/vripif.h>
     36 #include <hpcmips/vr/dsureg.h>
     37 #include <hpcmips/vr/vrdsuvar.h>
     38 
     39 struct vrdsu_softc {
     40 	struct device sc_dev;
     41 	bus_space_tag_t sc_iot;
     42 	bus_space_handle_t sc_ioh;
     43 };
     44 
     45 static int vrdsumatch(struct device *, struct cfdata *, void *);
     46 static void vrdsuattach(struct device *, struct device *, void *);
     47 
     48 static void vrdsu_write(struct vrdsu_softc *, int, unsigned short);
     49 static unsigned short vrdsu_read(struct vrdsu_softc *, int);
     50 
     51 CFATTACH_DECL(vrdsu, sizeof(struct vrdsu_softc),
     52     vrdsumatch, vrdsuattach, NULL, NULL);
     53 
     54 struct vrdsu_softc *the_dsu_sc = NULL;
     55 
     56 static inline void
     57 vrdsu_write(struct vrdsu_softc *sc, int port, unsigned short val)
     58 {
     59 
     60 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val);
     61 }
     62 
     63 static inline unsigned short
     64 vrdsu_read(struct vrdsu_softc *sc, int port)
     65 {
     66 
     67 	return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, port));
     68 }
     69 
     70 static int
     71 vrdsumatch(struct device *parent, struct cfdata *cf, void *aux)
     72 {
     73 
     74 	return (1);
     75 }
     76 
     77 static void
     78 vrdsuattach(struct device *parent, struct device *self, void *aux)
     79 {
     80 	struct vrdsu_softc *sc = (struct vrdsu_softc *)self;
     81 	struct vrip_attach_args *va = aux;
     82 
     83 	sc->sc_iot = va->va_iot;
     84 	if (bus_space_map(va->va_iot, va->va_addr, va->va_size,
     85 	    0, &sc->sc_ioh)) {
     86 		printf(": can't map bus space\n");
     87 		return;
     88 	}
     89 	printf("\n");
     90 	the_dsu_sc = sc;
     91 }
     92 
     93 void
     94 vrdsu_reset()
     95 {
     96 
     97 	if (the_dsu_sc) {
     98 		splhigh();
     99 		vrdsu_write(the_dsu_sc, DSUSET_REG_W, 1); /* 1 sec */
    100 		vrdsu_write(the_dsu_sc, DSUCNT_REG_W, DSUCNT_DSWEN);
    101 		while (1);
    102 	} else {
    103 		printf("%s(%d): There is no DSU.", __FILE__, __LINE__);
    104 	}
    105 }
    106