1 /* $NetBSD: cmu.c,v 1.13 2005/12/11 12:17:34 christos Exp $ */ 2 3 /*- 4 * Copyright (c) 1999 SASAKI Takesi 5 * Copyright (c) 1999, 2000, 2002 PocketBSD Project. All rights reserved. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. All advertising materials mentioning features or use of this software 17 * must display the following acknowledgement: 18 * This product includes software developed by the PocketBSD project 19 * and its contributors. 20 * 4. Neither the name of the project nor the names of its contributors 21 * may be used to endorse or promote products derived from this software 22 * without specific prior written permission. 23 * 24 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 27 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 30 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 31 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 33 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 34 * SUCH DAMAGE. 35 * 36 */ 37 38 #include <sys/cdefs.h> 39 __KERNEL_RCSID(0, "$NetBSD: cmu.c,v 1.13 2005/12/11 12:17:34 christos Exp $"); 40 41 #include <sys/param.h> 42 #include <sys/systm.h> 43 #include <sys/device.h> 44 45 #include <mips/cpuregs.h> 46 47 #include <machine/bus.h> 48 #include <machine/debug.h> 49 50 #include "opt_vr41xx.h" 51 #include <hpcmips/vr/vr.h> 52 #include <hpcmips/vr/vrcpudef.h> 53 #include <hpcmips/vr/vripif.h> 54 #include <hpcmips/vr/vripreg.h> 55 56 #include <hpcmips/vr/cmureg.h> 57 58 #include <machine/config_hook.h> 59 60 struct vrcmu_softc { 61 struct device sc_dev; 62 bus_space_tag_t sc_iot; 63 bus_space_handle_t sc_ioh; 64 config_hook_tag sc_hardpower; 65 int sc_save; 66 struct vrcmu_chipset_tag sc_chipset; 67 }; 68 69 int vrcmu_match(struct device *, struct cfdata *, void *); 70 void vrcmu_attach(struct device *, struct device *, void *); 71 int vrcmu_supply(vrcmu_chipset_tag_t, u_int16_t, int); 72 int vrcmu_hardpower(void *, int, long, void *); 73 74 CFATTACH_DECL(vrcmu, sizeof(struct vrcmu_softc), 75 vrcmu_match, vrcmu_attach, NULL, NULL); 76 77 int 78 vrcmu_match(struct device *parent, struct cfdata *cf, void *aux) 79 { 80 81 return (2); /* 1st attach group of vrip */ 82 } 83 84 void 85 vrcmu_attach(struct device *parent, struct device *self, void *aux) 86 { 87 struct vrip_attach_args *va = aux; 88 struct vrcmu_softc *sc = (void *)self; 89 90 sc->sc_iot = va->va_iot; 91 sc->sc_chipset.cc_sc = sc; 92 sc->sc_chipset.cc_clock = vrcmu_supply; 93 if (bus_space_map(sc->sc_iot, va->va_addr, va->va_size, 94 0 /* no flags */, &sc->sc_ioh)) { 95 printf(": can't map i/o space\n"); 96 return; 97 } 98 printf ("\n"); 99 100 vrip_register_cmu(va->va_vc, &sc->sc_chipset); 101 sc->sc_hardpower = config_hook(CONFIG_HOOK_PMEVENT, 102 CONFIG_HOOK_PMEVENT_HARDPOWER, 103 CONFIG_HOOK_SHARE, 104 vrcmu_hardpower, sc); 105 } 106 107 int 108 vrcmu_supply(vrcmu_chipset_tag_t cc, u_int16_t mask, int onoff) 109 { 110 struct vrcmu_softc *sc = cc->cc_sc; 111 u_int16_t reg; 112 113 reg = bus_space_read_2(sc->sc_iot, sc->sc_ioh, 0); 114 #ifdef VRCMU_VERBOSE 115 printf("cmu register(enter):"); 116 dbg_bit_print(reg); 117 #endif 118 if (onoff) 119 reg |= mask; 120 else 121 reg &= ~mask; 122 bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0, reg); 123 #ifdef VRCMU_VERBOSE 124 printf("cmu register(exit) :"); 125 dbg_bit_print(reg); 126 #endif 127 return (0); 128 } 129 130 int 131 vrcmu_hardpower(void *ctx, int type, long id, void *msg) 132 { 133 struct vrcmu_softc *sc = ctx; 134 int why = (int)msg; 135 136 switch (why) { 137 case PWR_STANDBY: 138 case PWR_SUSPEND: 139 sc->sc_save = bus_space_read_2(sc->sc_iot, sc->sc_ioh, 0); 140 bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0, 0); 141 break; 142 case PWR_RESUME: 143 bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0, sc->sc_save); 144 break; 145 } 146 return (0); 147 } 148