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