Home | History | Annotate | Line # | Download | only in vr
vrdsu.c revision 1.4 
      1 /*	$NetBSD: vrdsu.c,v 1.4 2002/01/27 14:18:12 takemura 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 struct cfattach vrdsu_ca = {
     52 	sizeof(struct vrdsu_softc), vrdsumatch, vrdsuattach
     53 };
     54 
     55 struct vrdsu_softc *the_dsu_sc = NULL;
     56 
     57 static inline void
     58 vrdsu_write(struct vrdsu_softc *sc, int port, unsigned short val)
     59 {
     60 
     61 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val);
     62 }
     63 
     64 static inline unsigned short
     65 vrdsu_read(struct vrdsu_softc *sc, int port)
     66 {
     67 
     68 	return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, port));
     69 }
     70 
     71 static int
     72 vrdsumatch(struct device *parent, struct cfdata *cf, void *aux)
     73 {
     74 
     75 	return (1);
     76 }
     77 
     78 static void
     79 vrdsuattach(struct device *parent, struct device *self, void *aux)
     80 {
     81 	struct vrdsu_softc *sc = (struct vrdsu_softc *)self;
     82 	struct vrip_attach_args *va = aux;
     83 
     84 	sc->sc_iot = va->va_iot;
     85 	if (bus_space_map(va->va_iot, va->va_addr, va->va_size,
     86 	    0, &sc->sc_ioh)) {
     87 		printf(": can't map bus space\n");
     88 		return;
     89 	}
     90 	printf("\n");
     91 	the_dsu_sc = sc;
     92 }
     93 
     94 void
     95 vrdsu_reset()
     96 {
     97 
     98 	if (the_dsu_sc) {
     99 		splhigh();
    100 		vrdsu_write(the_dsu_sc, DSUSET_REG_W, 1); /* 1 sec */
    101 		vrdsu_write(the_dsu_sc, DSUCNT_REG_W, DSUCNT_DSWEN);
    102 		while (1);
    103 	} else {
    104 		printf("%s(%d): There is no DSU.", __FILE__, __LINE__);
    105 	}
    106 }
    107