nvram_pnpbus.c revision 1.3.2.2
1 1.3.2.2 yamt /* $NetBSD: nvram_pnpbus.c,v 1.3.2.2 2006/06/21 14:55:19 yamt Exp $ */ 2 1.3.2.2 yamt 3 1.3.2.2 yamt /*- 4 1.3.2.2 yamt * Copyright (c) 2006 The NetBSD Foundation, Inc. 5 1.3.2.2 yamt * All rights reserved. 6 1.3.2.2 yamt * 7 1.3.2.2 yamt * This code is derived from software contributed to The NetBSD Foundation 8 1.3.2.2 yamt * by Tim Rightnour 9 1.3.2.2 yamt * 10 1.3.2.2 yamt * Redistribution and use in source and binary forms, with or without 11 1.3.2.2 yamt * modification, are permitted provided that the following conditions 12 1.3.2.2 yamt * are met: 13 1.3.2.2 yamt * 1. Redistributions of source code must retain the above copyright 14 1.3.2.2 yamt * notice, this list of conditions and the following disclaimer. 15 1.3.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 16 1.3.2.2 yamt * notice, this list of conditions and the following disclaimer in the 17 1.3.2.2 yamt * documentation and/or other materials provided with the distribution. 18 1.3.2.2 yamt * 3. All advertising materials mentioning features or use of this software 19 1.3.2.2 yamt * must display the following acknowledgement: 20 1.3.2.2 yamt * This product includes software developed by the NetBSD 21 1.3.2.2 yamt * Foundation, Inc. and its contributors. 22 1.3.2.2 yamt * 4. Neither the name of The NetBSD Foundation nor the names of its 23 1.3.2.2 yamt * contributors may be used to endorse or promote products derived 24 1.3.2.2 yamt * from this software without specific prior written permission. 25 1.3.2.2 yamt * 26 1.3.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 1.3.2.2 yamt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 1.3.2.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 1.3.2.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 1.3.2.2 yamt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 1.3.2.2 yamt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 1.3.2.2 yamt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 1.3.2.2 yamt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 1.3.2.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 1.3.2.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 1.3.2.2 yamt * POSSIBILITY OF SUCH DAMAGE. 37 1.3.2.2 yamt */ 38 1.3.2.2 yamt 39 1.3.2.2 yamt #include <sys/cdefs.h> 40 1.3.2.2 yamt __KERNEL_RCSID(0, "$NetBSD: nvram_pnpbus.c,v 1.3.2.2 2006/06/21 14:55:19 yamt Exp $"); 41 1.3.2.2 yamt 42 1.3.2.2 yamt #include <sys/types.h> 43 1.3.2.2 yamt #include <sys/param.h> 44 1.3.2.2 yamt #include <sys/systm.h> 45 1.3.2.2 yamt #include <sys/ioctl.h> 46 1.3.2.2 yamt #include <sys/conf.h> 47 1.3.2.2 yamt #include <sys/kthread.h> 48 1.3.2.2 yamt #include <sys/device.h> 49 1.3.2.2 yamt #include <sys/malloc.h> 50 1.3.2.2 yamt #include <sys/lock.h> 51 1.3.2.2 yamt 52 1.3.2.2 yamt #include <machine/bus.h> 53 1.3.2.2 yamt #include <machine/intr.h> 54 1.3.2.2 yamt #include <machine/isa_machdep.h> 55 1.3.2.2 yamt /* clock stuff for motorolla machines */ 56 1.3.2.2 yamt #include <dev/clock_subr.h> 57 1.3.2.2 yamt #include <dev/ic/mk48txxreg.h> 58 1.3.2.2 yamt 59 1.3.2.2 yamt #include <machine/nvram.h> 60 1.3.2.2 yamt 61 1.3.2.2 yamt #include <prep/pnpbus/pnpbusvar.h> 62 1.3.2.2 yamt 63 1.3.2.2 yamt #include "opt_nvram.h" 64 1.3.2.2 yamt 65 1.3.2.2 yamt static char *nvramData; 66 1.3.2.2 yamt static NVRAM_MAP *nvram; 67 1.3.2.2 yamt static char *nvramGEAp; /* pointer to the GE area */ 68 1.3.2.2 yamt static char *nvramCAp; /* pointer to the Config area */ 69 1.3.2.2 yamt static char *nvramOSAp; /* pointer to the OSArea */ 70 1.3.2.2 yamt struct simplelock nvram_slock; /* lock */ 71 1.3.2.2 yamt 72 1.3.2.2 yamt int prep_clock_mk48txx; 73 1.3.2.2 yamt 74 1.3.2.2 yamt extern char bootpath[256]; 75 1.3.2.2 yamt 76 1.3.2.2 yamt #define NVRAM_STD_DEV 0 77 1.3.2.2 yamt 78 1.3.2.2 yamt static int nvram_pnpbus_probe(struct device *, struct cfdata *, void *); 79 1.3.2.2 yamt static void nvram_pnpbus_attach(struct device *, struct device *, void *); 80 1.3.2.2 yamt uint8_t prep_nvram_read_val(int); 81 1.3.2.2 yamt char *prep_nvram_next_var(char *); 82 1.3.2.2 yamt char *prep_nvram_find_var(const char *); 83 1.3.2.2 yamt char *prep_nvram_get_var(const char *); 84 1.3.2.2 yamt int prep_nvram_get_var_len(const char *); 85 1.3.2.2 yamt int prep_nvram_count_vars(void); 86 1.3.2.2 yamt void prep_nvram_write_val(int, uint8_t); 87 1.3.2.2 yamt uint8_t mkclock_pnpbus_nvrd(struct mk48txx_softc *, int); 88 1.3.2.2 yamt void mkclock_pnpbus_nvwr(struct mk48txx_softc *, int, uint8_t); 89 1.3.2.2 yamt 90 1.3.2.2 yamt CFATTACH_DECL(nvram_pnpbus, sizeof(struct nvram_pnpbus_softc), 91 1.3.2.2 yamt nvram_pnpbus_probe, nvram_pnpbus_attach, NULL, NULL); 92 1.3.2.2 yamt 93 1.3.2.2 yamt dev_type_open(prep_nvramopen); 94 1.3.2.2 yamt dev_type_ioctl(prep_nvramioctl); 95 1.3.2.2 yamt dev_type_close(prep_nvramclose); 96 1.3.2.2 yamt 97 1.3.2.2 yamt const struct cdevsw prep_nvram_cdevsw = { 98 1.3.2.2 yamt prep_nvramopen, prep_nvramclose, noread, nowrite, prep_nvramioctl, 99 1.3.2.2 yamt nostop, notty, nopoll, nommap, nokqfilter, 100 1.3.2.2 yamt }; 101 1.3.2.2 yamt 102 1.3.2.2 yamt extern struct cfdriver nvram_cd; 103 1.3.2.2 yamt 104 1.3.2.2 yamt static int 105 1.3.2.2 yamt nvram_pnpbus_probe(struct device *parent, struct cfdata *match, void *aux) 106 1.3.2.2 yamt { 107 1.3.2.2 yamt struct pnpbus_dev_attach_args *pna = aux; 108 1.3.2.2 yamt int ret = 0; 109 1.3.2.2 yamt 110 1.3.2.2 yamt if (strcmp(pna->pna_devid, "IBM0008") == 0) 111 1.3.2.2 yamt ret = 1; 112 1.3.2.2 yamt 113 1.3.2.2 yamt if (ret) 114 1.3.2.2 yamt pnpbus_scan(pna, pna->pna_ppc_dev); 115 1.3.2.2 yamt 116 1.3.2.2 yamt return ret; 117 1.3.2.2 yamt } 118 1.3.2.2 yamt 119 1.3.2.2 yamt static void 120 1.3.2.2 yamt nvram_pnpbus_attach(struct device *parent, struct device *self, void *aux) 121 1.3.2.2 yamt { 122 1.3.2.2 yamt struct nvram_pnpbus_softc *sc = (void *)self; 123 1.3.2.2 yamt struct pnpbus_dev_attach_args *pna = aux; 124 1.3.2.2 yamt int as_iobase, as_len, data_iobase, data_len, i, nvlen, cur; 125 1.3.2.2 yamt uint8_t *p; 126 1.3.2.2 yamt HEADER prep_nvram_header; 127 1.3.2.2 yamt 128 1.3.2.2 yamt sc->sc_iot = pna->pna_iot; 129 1.3.2.2 yamt 130 1.3.2.2 yamt pnpbus_getioport(&pna->pna_res, 0, &as_iobase, &as_len); 131 1.3.2.2 yamt pnpbus_getioport(&pna->pna_res, 1, &data_iobase, &data_len); 132 1.3.2.2 yamt 133 1.3.2.2 yamt if (pnpbus_io_map(&pna->pna_res, 0, &sc->sc_as, &sc->sc_ash) || 134 1.3.2.2 yamt pnpbus_io_map(&pna->pna_res, 1, &sc->sc_data, &sc->sc_datah)) { 135 1.3.2.2 yamt aprint_error("nvram: couldn't map registers\n"); 136 1.3.2.2 yamt return; 137 1.3.2.2 yamt } 138 1.3.2.2 yamt 139 1.3.2.2 yamt simple_lock_init(&nvram_slock); 140 1.3.2.2 yamt 141 1.3.2.2 yamt /* Initialize the nvram header */ 142 1.3.2.2 yamt p = (uint8_t *) &prep_nvram_header; 143 1.3.2.2 yamt for (i = 0; i < sizeof(HEADER); i++) 144 1.3.2.2 yamt *p++ = prep_nvram_read_val(i); 145 1.3.2.2 yamt 146 1.3.2.2 yamt /* 147 1.3.2.2 yamt * now that we have the header, we know how big the NVRAM part on 148 1.3.2.2 yamt * this machine really is. Malloc space to save a copy. 149 1.3.2.2 yamt */ 150 1.3.2.2 yamt 151 1.3.2.2 yamt nvlen = 1024 * prep_nvram_header.Size; 152 1.3.2.2 yamt nvramData = malloc(nvlen, M_DEVBUF, M_NOWAIT); 153 1.3.2.2 yamt p = (uint8_t *) nvramData; 154 1.3.2.2 yamt 155 1.3.2.2 yamt /* 156 1.3.2.2 yamt * now read the whole nvram in, one chunk at a time, marking down 157 1.3.2.2 yamt * the main start points as we go. 158 1.3.2.2 yamt */ 159 1.3.2.2 yamt for (i = 0; i < sizeof(HEADER) && i < nvlen; i++) 160 1.3.2.2 yamt *p++ = prep_nvram_read_val(i); 161 1.3.2.2 yamt nvramGEAp = p; 162 1.3.2.2 yamt cur = i; 163 1.3.2.2 yamt for (; i < cur + prep_nvram_header.GELength && i < nvlen; i++) 164 1.3.2.2 yamt *p++ = prep_nvram_read_val(i); 165 1.3.2.2 yamt nvramOSAp = p; 166 1.3.2.2 yamt cur = i; 167 1.3.2.2 yamt for (; i < cur + prep_nvram_header.OSAreaLength && i < nvlen; i++) 168 1.3.2.2 yamt *p++ = prep_nvram_read_val(i); 169 1.3.2.2 yamt nvramCAp = p; 170 1.3.2.2 yamt cur = i; 171 1.3.2.2 yamt for (; i < cur + prep_nvram_header.ConfigLength && i < nvlen; i++) 172 1.3.2.2 yamt *p++ = prep_nvram_read_val(i); 173 1.3.2.2 yamt 174 1.3.2.2 yamt /* we should be done here. umm.. yay? */ 175 1.3.2.2 yamt nvram = (NVRAM_MAP *)&nvramData[0]; 176 1.3.2.2 yamt aprint_normal("\n"); 177 1.3.2.2 yamt aprint_verbose("%s: Read %d bytes from nvram of size %d\n", 178 1.3.2.2 yamt device_xname(self), i, nvlen); 179 1.3.2.2 yamt 180 1.3.2.2 yamt #if defined(NVRAM_DUMP) 181 1.3.2.2 yamt printf("Boot device: %s\n", prep_nvram_get_var("fw-boot-device")); 182 1.3.2.2 yamt printf("Dumping nvram\n"); 183 1.3.2.2 yamt for (cur=0; cur < i; cur++) { 184 1.3.2.2 yamt printf("%c", nvramData[cur]); 185 1.3.2.2 yamt if (cur % 70 == 0) 186 1.3.2.2 yamt printf("\n"); 187 1.3.2.2 yamt } 188 1.3.2.2 yamt #endif 189 1.3.2.2 yamt strncpy(bootpath, prep_nvram_get_var("fw-boot-device"), 256); 190 1.3.2.2 yamt 191 1.3.2.2 yamt 192 1.3.2.2 yamt if (prep_clock_mk48txx == 0) 193 1.3.2.2 yamt return; 194 1.3.2.2 yamt /* otherwise, we have a motorolla clock chip. Set it up. */ 195 1.3.2.2 yamt sc->sc_mksc.sc_model = "mk48t18"; 196 1.3.2.2 yamt sc->sc_mksc.sc_year0 = 1900; 197 1.3.2.2 yamt sc->sc_mksc.sc_nvrd = mkclock_pnpbus_nvrd; 198 1.3.2.2 yamt sc->sc_mksc.sc_nvwr = mkclock_pnpbus_nvwr; 199 1.3.2.2 yamt /* copy down the bus space tags */ 200 1.3.2.2 yamt sc->sc_mksc.sc_bst = sc->sc_as; 201 1.3.2.2 yamt sc->sc_mksc.sc_bsh = sc->sc_ash; 202 1.3.2.2 yamt sc->sc_mksc.sc_data = sc->sc_data; 203 1.3.2.2 yamt sc->sc_mksc.sc_datah = sc->sc_datah; 204 1.3.2.2 yamt 205 1.3.2.2 yamt aprint_normal("%s: attaching clock", device_xname(self)); 206 1.3.2.2 yamt mk48txx_attach((struct mk48txx_softc *)&sc->sc_mksc); 207 1.3.2.2 yamt todr_attach(&sc->sc_mksc.sc_handle); 208 1.3.2.2 yamt } 209 1.3.2.2 yamt 210 1.3.2.2 yamt /* 211 1.3.2.2 yamt * This function should be called at a high spl only, as it interfaces with 212 1.3.2.2 yamt * real hardware. 213 1.3.2.2 yamt */ 214 1.3.2.2 yamt 215 1.3.2.2 yamt uint8_t 216 1.3.2.2 yamt prep_nvram_read_val(int addr) 217 1.3.2.2 yamt { 218 1.3.2.2 yamt struct nvram_pnpbus_softc *sc; 219 1.3.2.2 yamt 220 1.3.2.2 yamt if (nvram_cd.cd_devs == NULL || nvram_cd.cd_ndevs == 0 221 1.3.2.2 yamt || nvram_cd.cd_devs[NVRAM_STD_DEV] == NULL) { 222 1.3.2.2 yamt return 0; 223 1.3.2.2 yamt } 224 1.3.2.2 yamt 225 1.3.2.2 yamt sc = (struct nvram_pnpbus_softc *) nvram_cd.cd_devs[NVRAM_STD_DEV]; 226 1.3.2.2 yamt 227 1.3.2.2 yamt /* tell the NVRAM what we want */ 228 1.3.2.2 yamt bus_space_write_1(sc->sc_as, sc->sc_ash, 0, addr); 229 1.3.2.2 yamt bus_space_write_1(sc->sc_as, sc->sc_ash, 1, addr>>8); 230 1.3.2.2 yamt 231 1.3.2.2 yamt return bus_space_read_1(sc->sc_data, sc->sc_datah, 0); 232 1.3.2.2 yamt } 233 1.3.2.2 yamt 234 1.3.2.2 yamt /* 235 1.3.2.2 yamt * This function should be called at a high spl only, as it interfaces with 236 1.3.2.2 yamt * real hardware. 237 1.3.2.2 yamt */ 238 1.3.2.2 yamt 239 1.3.2.2 yamt void 240 1.3.2.2 yamt prep_nvram_write_val(int addr, uint8_t val) 241 1.3.2.2 yamt { 242 1.3.2.2 yamt struct nvram_pnpbus_softc *sc; 243 1.3.2.2 yamt 244 1.3.2.2 yamt if (nvram_cd.cd_devs == NULL || nvram_cd.cd_ndevs == 0 245 1.3.2.2 yamt || nvram_cd.cd_devs[NVRAM_STD_DEV] == NULL) { 246 1.3.2.2 yamt return; 247 1.3.2.2 yamt } 248 1.3.2.2 yamt 249 1.3.2.2 yamt sc = (struct nvram_pnpbus_softc *) nvram_cd.cd_devs[NVRAM_STD_DEV]; 250 1.3.2.2 yamt 251 1.3.2.2 yamt /* tell the NVRAM what we want */ 252 1.3.2.2 yamt bus_space_write_1(sc->sc_as, sc->sc_ash, 0, addr); 253 1.3.2.2 yamt bus_space_write_1(sc->sc_as, sc->sc_ash, 1, addr>>8); 254 1.3.2.2 yamt 255 1.3.2.2 yamt bus_space_write_1(sc->sc_data, sc->sc_datah, 0, val); 256 1.3.2.2 yamt } 257 1.3.2.2 yamt 258 1.3.2.2 yamt /* the rest of these should all be called with the lock held */ 259 1.3.2.2 yamt 260 1.3.2.2 yamt char * 261 1.3.2.2 yamt prep_nvram_next_var(char *name) 262 1.3.2.2 yamt { 263 1.3.2.2 yamt char *cp; 264 1.3.2.2 yamt 265 1.3.2.2 yamt cp = name; 266 1.3.2.2 yamt /* skip forward to the first null char */ 267 1.3.2.2 yamt while ((cp - nvramGEAp) < nvram->Header.GELength && (*cp != '\0')) 268 1.3.2.2 yamt cp++; 269 1.3.2.2 yamt /* skip nulls */ 270 1.3.2.2 yamt while ((cp - nvramGEAp) < nvram->Header.GELength && (*cp == '\0')) 271 1.3.2.2 yamt cp++; 272 1.3.2.2 yamt if ((cp - nvramGEAp) < nvram->Header.GELength) 273 1.3.2.2 yamt return cp; 274 1.3.2.2 yamt else 275 1.3.2.2 yamt return NULL; 276 1.3.2.2 yamt } 277 1.3.2.2 yamt 278 1.3.2.2 yamt char * 279 1.3.2.2 yamt prep_nvram_find_var(const char *name) 280 1.3.2.2 yamt { 281 1.3.2.2 yamt char *cp = nvramGEAp; 282 1.3.2.2 yamt size_t len; 283 1.3.2.2 yamt 284 1.3.2.2 yamt len = strlen(name); 285 1.3.2.2 yamt while (cp != NULL) { 286 1.3.2.2 yamt if ((strncmp(name, cp, len) == 0) && (cp[len] == '=')) 287 1.3.2.2 yamt return cp; 288 1.3.2.2 yamt cp = prep_nvram_next_var(cp); 289 1.3.2.2 yamt } 290 1.3.2.2 yamt return NULL; 291 1.3.2.2 yamt } 292 1.3.2.2 yamt 293 1.3.2.2 yamt char * 294 1.3.2.2 yamt prep_nvram_get_var(const char *name) 295 1.3.2.2 yamt { 296 1.3.2.2 yamt char *cp = nvramGEAp; 297 1.3.2.2 yamt size_t len; 298 1.3.2.2 yamt 299 1.3.2.2 yamt len = strlen(name); 300 1.3.2.2 yamt while (cp != NULL) { 301 1.3.2.2 yamt if ((strncmp(name, cp, len) == 0) && (cp[len] == '=')) 302 1.3.2.2 yamt return cp+len+1; 303 1.3.2.2 yamt cp = prep_nvram_next_var(cp); 304 1.3.2.2 yamt } 305 1.3.2.2 yamt return NULL; 306 1.3.2.2 yamt } 307 1.3.2.2 yamt 308 1.3.2.2 yamt int 309 1.3.2.2 yamt prep_nvram_get_var_len(const char *name) 310 1.3.2.2 yamt { 311 1.3.2.2 yamt char *cp = nvramGEAp; 312 1.3.2.2 yamt char *ep; 313 1.3.2.2 yamt size_t len; 314 1.3.2.2 yamt 315 1.3.2.2 yamt len = strlen(name); 316 1.3.2.2 yamt while (cp != NULL) { 317 1.3.2.2 yamt if ((strncmp(name, cp, len) == 0) && (cp[len] == '=')) 318 1.3.2.2 yamt goto out; 319 1.3.2.2 yamt cp = prep_nvram_next_var(cp); 320 1.3.2.2 yamt } 321 1.3.2.2 yamt return -1; 322 1.3.2.2 yamt 323 1.3.2.2 yamt out: 324 1.3.2.2 yamt ep = cp; 325 1.3.2.2 yamt while (ep != NULL && *ep != '\0') 326 1.3.2.2 yamt ep++; 327 1.3.2.2 yamt return ep-cp; 328 1.3.2.2 yamt } 329 1.3.2.2 yamt 330 1.3.2.2 yamt int 331 1.3.2.2 yamt prep_nvram_count_vars(void) 332 1.3.2.2 yamt { 333 1.3.2.2 yamt char *cp = nvramGEAp; 334 1.3.2.2 yamt int i=0; 335 1.3.2.2 yamt 336 1.3.2.2 yamt while (cp != NULL) { 337 1.3.2.2 yamt i++; 338 1.3.2.2 yamt cp = prep_nvram_next_var(cp); 339 1.3.2.2 yamt } 340 1.3.2.2 yamt return i; 341 1.3.2.2 yamt } 342 1.3.2.2 yamt 343 1.3.2.2 yamt int 344 1.3.2.2 yamt prep_nvramioctl(dev_t dev, u_long cmd, caddr_t data, int flags, struct lwp *l) 345 1.3.2.2 yamt { 346 1.3.2.2 yamt int len, error; 347 1.3.2.2 yamt struct pnviocdesc *pnv; 348 1.3.2.2 yamt char *np, *cp; 349 1.3.2.2 yamt 350 1.3.2.2 yamt pnv = (struct pnviocdesc *)data; 351 1.3.2.2 yamt error = 0; 352 1.3.2.2 yamt 353 1.3.2.2 yamt switch (cmd) { 354 1.3.2.2 yamt case PNVIOCGET: 355 1.3.2.2 yamt if (pnv->pnv_name == NULL) 356 1.3.2.2 yamt return EINVAL; 357 1.3.2.2 yamt 358 1.3.2.2 yamt simple_lock(&nvram_slock); 359 1.3.2.2 yamt np = prep_nvram_get_var(pnv->pnv_name); 360 1.3.2.2 yamt simple_unlock(&nvram_slock); 361 1.3.2.2 yamt if (np == NULL) 362 1.3.2.2 yamt return EINVAL; 363 1.3.2.2 yamt simple_lock(&nvram_slock); 364 1.3.2.2 yamt len = prep_nvram_get_var_len(pnv->pnv_name); 365 1.3.2.2 yamt simple_unlock(&nvram_slock); 366 1.3.2.2 yamt 367 1.3.2.2 yamt if (len > pnv->pnv_buflen) { 368 1.3.2.2 yamt error = ENOMEM; 369 1.3.2.2 yamt break; 370 1.3.2.2 yamt } 371 1.3.2.2 yamt if (len <= 0) 372 1.3.2.2 yamt break; 373 1.3.2.2 yamt error = copyout(np, pnv->pnv_buf, len); 374 1.3.2.2 yamt pnv->pnv_buflen = len; 375 1.3.2.2 yamt break; 376 1.3.2.2 yamt 377 1.3.2.2 yamt case PNVIOCGETNEXTNAME: 378 1.3.2.2 yamt /* if the first one is null, we give them the first name */ 379 1.3.2.2 yamt simple_lock(&nvram_slock); 380 1.3.2.2 yamt if (pnv->pnv_name == NULL) { 381 1.3.2.2 yamt np = nvramGEAp; 382 1.3.2.2 yamt cp = prep_nvram_next_var(np); 383 1.3.2.2 yamt } else { 384 1.3.2.2 yamt np = prep_nvram_find_var(pnv->pnv_name); 385 1.3.2.2 yamt cp = prep_nvram_next_var(np); 386 1.3.2.2 yamt } 387 1.3.2.2 yamt simple_unlock(&nvram_slock); 388 1.3.2.2 yamt np = cp; 389 1.3.2.2 yamt while (*np != '=') 390 1.3.2.2 yamt np++; 391 1.3.2.2 yamt len = np-cp; 392 1.3.2.2 yamt if (len > pnv->pnv_buflen) { 393 1.3.2.2 yamt error = ENOMEM; 394 1.3.2.2 yamt break; 395 1.3.2.2 yamt } 396 1.3.2.2 yamt error = copyout(cp, pnv->pnv_buf, len); 397 1.3.2.2 yamt pnv->pnv_buflen = len; 398 1.3.2.2 yamt break; 399 1.3.2.2 yamt default: 400 1.3.2.2 yamt return (ENOTTY); 401 1.3.2.2 yamt } 402 1.3.2.2 yamt return (error); 403 1.3.2.2 yamt } 404 1.3.2.2 yamt 405 1.3.2.2 yamt int 406 1.3.2.2 yamt prep_nvramopen(dev_t dev, int flags, int mode, struct lwp *l) 407 1.3.2.2 yamt { 408 1.3.2.2 yamt struct nvram_pnpbus_softc *sc; 409 1.3.2.2 yamt 410 1.3.2.2 yamt sc = device_lookup(&nvram_cd, dev); 411 1.3.2.2 yamt if (sc == NULL) 412 1.3.2.2 yamt return ENODEV; 413 1.3.2.2 yamt 414 1.3.2.2 yamt if (sc->sc_open) 415 1.3.2.2 yamt return EBUSY; 416 1.3.2.2 yamt 417 1.3.2.2 yamt sc->sc_open = 1; 418 1.3.2.2 yamt 419 1.3.2.2 yamt return 0; 420 1.3.2.2 yamt } 421 1.3.2.2 yamt 422 1.3.2.2 yamt int 423 1.3.2.2 yamt prep_nvramclose(dev_t dev, int flags, int mode, struct lwp *l) 424 1.3.2.2 yamt { 425 1.3.2.2 yamt struct nvram_pnpbus_softc *sc; 426 1.3.2.2 yamt 427 1.3.2.2 yamt sc = device_lookup(&nvram_cd, dev); 428 1.3.2.2 yamt if (sc == NULL) 429 1.3.2.2 yamt return ENODEV; 430 1.3.2.2 yamt sc->sc_open = 0; 431 1.3.2.2 yamt return 0; 432 1.3.2.2 yamt } 433 1.3.2.2 yamt 434 1.3.2.2 yamt /* Motorola mk48txx clock routines */ 435 1.3.2.2 yamt uint8_t 436 1.3.2.2 yamt mkclock_pnpbus_nvrd(struct mk48txx_softc *osc, int off) 437 1.3.2.2 yamt { 438 1.3.2.2 yamt struct prep_mk48txx_softc *sc = (struct prep_mk48txx_softc *)osc; 439 1.3.2.2 yamt uint8_t datum; 440 1.3.2.2 yamt int s; 441 1.3.2.2 yamt 442 1.3.2.2 yamt #ifdef DEBUG 443 1.3.2.2 yamt printf("mkclock_pnpbus_nvrd(%d)", off); 444 1.3.2.2 yamt #endif 445 1.3.2.2 yamt s = splclock(); 446 1.3.2.2 yamt bus_space_write_1(sc->sc_bst, sc->sc_bsh, 0, off & 0xff); 447 1.3.2.2 yamt bus_space_write_1(sc->sc_bst, sc->sc_bsh, 1, off >> 8); 448 1.3.2.2 yamt datum = bus_space_read_1(sc->sc_data, sc->sc_datah, 0); 449 1.3.2.2 yamt splx(s); 450 1.3.2.2 yamt #ifdef DEBUG 451 1.3.2.2 yamt printf(" -> %02x\n", datum); 452 1.3.2.2 yamt #endif 453 1.3.2.2 yamt return datum; 454 1.3.2.2 yamt } 455 1.3.2.2 yamt 456 1.3.2.2 yamt void 457 1.3.2.2 yamt mkclock_pnpbus_nvwr(struct mk48txx_softc *osc, int off, uint8_t datum) 458 1.3.2.2 yamt { 459 1.3.2.2 yamt struct prep_mk48txx_softc *sc = (struct prep_mk48txx_softc *)osc; 460 1.3.2.2 yamt int s; 461 1.3.2.2 yamt 462 1.3.2.2 yamt #ifdef DEBUG 463 1.3.2.2 yamt printf("mkclock_isa_nvwr(%d, %02x)\n", off, datum); 464 1.3.2.2 yamt #endif 465 1.3.2.2 yamt s = splclock(); 466 1.3.2.2 yamt bus_space_write_1(sc->sc_bst, sc->sc_bsh, 0, off & 0xff); 467 1.3.2.2 yamt bus_space_write_1(sc->sc_bst, sc->sc_bsh, 1, off >> 8); 468 1.3.2.2 yamt bus_space_write_1(sc->sc_data, sc->sc_datah, 0, datum); 469 1.3.2.2 yamt splx(s); 470 1.3.2.2 yamt } 471
Indexes created Sun Nov 02 07:10:05 GMT 2025